drivers/video/video-uclass.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (c) 2015 Google, Inc
   4  */
   5
   6 #include <common.h>
   7 #include <cpu_func.h>
   8 #include <dm.h>
   9 #include <mapmem.h>
  10 #include <stdio_dev.h>
  11 #include <video.h>
  12 #include <video_console.h>
  13 #include <dm/lists.h>
  14 #include <dm/device-internal.h>
  15 #include <dm/uclass-internal.h>
  16 #ifdef CONFIG_SANDBOX
  17 #include <asm/sdl.h>
  18 #endif
  19
  20 /*
  21  * Theory of operation:
  22  *
  23  * Before relocation each device is bound. The driver for each device must
  24  * set the @align and @size values in struct video_uc_platdata. This
  25  * information represents the requires size and alignment of the frame buffer
  26  * for the device. The values can be an over-estimate but cannot be too
  27  * small. The actual values will be suppled (in the same manner) by the bind()
  28  * method after relocation.
  29  *
  30  * This information is then picked up by video_reserve() which works out how
  31  * much memory is needed for all devices. This is allocated between
  32  * gd->video_bottom and gd->video_top.
  33  *
  34  * After relocation the same process occurs. The driver supplies the same
  35  * @size and @align information and this time video_post_bind() checks that
  36  * the drivers does not overflow the allocated memory.
  37  *
  38  * The frame buffer address is actually set (to plat->base) in
  39  * video_post_probe(). This function also clears the frame buffer and
  40  * allocates a suitable text console device. This can then be used to write
  41  * text to the video device.
  42  */
  43 DECLARE_GLOBAL_DATA_PTR;
  44
  45 void video_set_flush_dcache(struct udevice *dev, bool flush)
  46 {
  47         struct video_priv *priv = dev_get_uclass_priv(dev);
  48
  49         priv->flush_dcache = flush;
  50 }
  51
  52 static ulong alloc_fb(struct udevice *dev, ulong *addrp)
  53 {
  54         struct video_uc_platdata *plat = dev_get_uclass_platdata(dev);
  55         ulong base, align, size;
  56
  57         if (!plat->size)
  58                 return 0;
  59
  60         align = plat->align ? plat->align : 1 << 20;
  61         base = *addrp - plat->size;
  62         base &= ~(align - 1);
  63         plat->base = base;
  64         size = *addrp - base;
  65         *addrp = base;
  66
  67         return size;
  68 }
  69
  70 int video_reserve(ulong *addrp)
  71 {
  72         struct udevice *dev;
  73         ulong size;
  74
  75         gd->video_top = *addrp;
  76         for (uclass_find_first_device(UCLASS_VIDEO, &dev);
  77              dev;
  78              uclass_find_next_device(&dev)) {
  79                 size = alloc_fb(dev, addrp);
  80                 debug("%s: Reserving %lx bytes at %lx for video device '%s'\n",
  81                       __func__, size, *addrp, dev->name);
  82         }
  83         gd->video_bottom = *addrp;
  84         debug("Video frame buffers from %lx to %lx\n", gd->video_bottom,
  85               gd->video_top);
  86
  87         return 0;
  88 }
  89
  90 int video_clear(struct udevice *dev)
  91 {
  92         struct video_priv *priv = dev_get_uclass_priv(dev);
  93
  94         switch (priv->bpix) {
  95 #ifdef CONFIG_VIDEO_BPP16
  96         case VIDEO_BPP16: {
  97                 u16 *ppix = priv->fb;
  98                 u16 *end = priv->fb + priv->fb_size;
  99
 100                 while (ppix < end)
 101                         *ppix++ = priv->colour_bg;
 102                 break;
 103         }
 104 #endif
 105 #ifdef CONFIG_VIDEO_BPP32
 106         case VIDEO_BPP32: {
 107                 u32 *ppix = priv->fb;
 108                 u32 *end = priv->fb + priv->fb_size;
 109
 110                 while (ppix < end)
 111                         *ppix++ = priv->colour_bg;
 112                 break;
 113         }
 114 #endif
 115         default:
 116                 memset(priv->fb, priv->colour_bg, priv->fb_size);
 117                 break;
 118         }
 119
 120         return 0;
 121 }
 122
 123 void video_set_default_colors(struct udevice *dev, bool invert)
 124 {
 125         struct video_priv *priv = dev_get_uclass_priv(dev);
 126         int fore, back;
 127
 128 #ifdef CONFIG_SYS_WHITE_ON_BLACK
 129         /* White is used when switching to bold, use light gray here */
 130         fore = VID_LIGHT_GRAY;
 131         back = VID_BLACK;
 132 #else
 133         fore = VID_BLACK;
 134         back = VID_WHITE;
 135 #endif
 136         if (invert) {
 137                 int temp;
 138
 139                 temp = fore;
 140                 fore = back;
 141                 back = temp;
 142         }
 143         priv->fg_col_idx = fore;
 144         priv->bg_col_idx = back;
 145         priv->colour_fg = vid_console_color(priv, fore);
 146         priv->colour_bg = vid_console_color(priv, back);
 147 }
 148
 149 /* Flush video activity to the caches */
 150 void video_sync(struct udevice *vid, bool force)
 151 {
 152         /*
 153          * flush_dcache_range() is declared in common.h but it seems that some
 154          * architectures do not actually implement it. Is there a way to find
 155          * out whether it exists? For now, ARM is safe.
 156          */
 157 #if defined(CONFIG_ARM) && !CONFIG_IS_ENABLED(SYS_DCACHE_OFF)
 158         struct video_priv *priv = dev_get_uclass_priv(vid);
 159
 160         if (priv->flush_dcache) {
 161                 flush_dcache_range((ulong)priv->fb,
 162                                    ALIGN((ulong)priv->fb + priv->fb_size,
 163                                          CONFIG_SYS_CACHELINE_SIZE));
 164         }
 165 #elif defined(CONFIG_VIDEO_SANDBOX_SDL)
 166         struct video_priv *priv = dev_get_uclass_priv(vid);
 167         static ulong last_sync;
 168
 169         if (force || get_timer(last_sync) > 10) {
 170                 sandbox_sdl_sync(priv->fb);
 171                 last_sync = get_timer(0);
 172         }
 173 #endif
 174 }
 175
 176 void video_sync_all(void)
 177 {
 178         struct udevice *dev;
 179
 180         for (uclass_find_first_device(UCLASS_VIDEO, &dev);
 181              dev;
 182              uclass_find_next_device(&dev)) {
 183                 if (device_active(dev))
 184                         video_sync(dev, true);
 185         }
 186 }
 187
 188 int video_get_xsize(struct udevice *dev)
 189 {
 190         struct video_priv *priv = dev_get_uclass_priv(dev);
 191
 192         return priv->xsize;
 193 }
 194
 195 int video_get_ysize(struct udevice *dev)
 196 {
 197         struct video_priv *priv = dev_get_uclass_priv(dev);
 198
 199         return priv->ysize;
 200 }
 201
 202 /* Set up the colour map */
 203 static int video_pre_probe(struct udevice *dev)
 204 {
 205         struct video_priv *priv = dev_get_uclass_priv(dev);
 206
 207         priv->cmap = calloc(256, sizeof(ushort));
 208         if (!priv->cmap)
 209                 return -ENOMEM;
 210
 211         return 0;
 212 }
 213
 214 static int video_pre_remove(struct udevice *dev)
 215 {
 216         struct video_priv *priv = dev_get_uclass_priv(dev);
 217
 218         free(priv->cmap);
 219
 220         return 0;
 221 }
 222
 223 /* Set up the display ready for use */
 224 static int video_post_probe(struct udevice *dev)
 225 {
 226         struct video_uc_platdata *plat = dev_get_uclass_platdata(dev);
 227         struct video_priv *priv = dev_get_uclass_priv(dev);
 228         char name[30], drv[15], *str;
 229         const char *drv_name = drv;
 230         struct udevice *cons;
 231         int ret;
 232
 233         /* Set up the line and display size */
 234         priv->fb = map_sysmem(plat->base, plat->size);
 235         if (!priv->line_length)
 236                 priv->line_length = priv->xsize * VNBYTES(priv->bpix);
 237
 238         priv->fb_size = priv->line_length * priv->ysize;
 239
 240         /* Set up colors  */
 241         video_set_default_colors(dev, false);
 242
 243         if (!CONFIG_IS_ENABLED(NO_FB_CLEAR))
 244                 video_clear(dev);
 245
 246         /*
 247          * Create a text console device. For now we always do this, although
 248          * it might be useful to support only bitmap drawing on the device
 249          * for boards that don't need to display text. We create a TrueType
 250          * console if enabled, a rotated console if the video driver requests
 251          * it, otherwise a normal console.
 252          *
 253          * The console can be override by setting vidconsole_drv_name before
 254          * probing this video driver, or in the probe() method.
 255          *
 256          * TrueType does not support rotation at present so fall back to the
 257          * rotated console in that case.
 258          */
 259         if (!priv->rot && IS_ENABLED(CONFIG_CONSOLE_TRUETYPE)) {
 260                 snprintf(name, sizeof(name), "%s.vidconsole_tt", dev->name);
 261                 strcpy(drv, "vidconsole_tt");
 262         } else {
 263                 snprintf(name, sizeof(name), "%s.vidconsole%d", dev->name,
 264                          priv->rot);
 265                 snprintf(drv, sizeof(drv), "vidconsole%d", priv->rot);
 266         }
 267
 268         str = strdup(name);
 269         if (!str)
 270                 return -ENOMEM;
 271         if (priv->vidconsole_drv_name)
 272                 drv_name = priv->vidconsole_drv_name;
 273         ret = device_bind_driver(dev, drv_name, str, &cons);
 274         if (ret) {
 275                 debug("%s: Cannot bind console driver\n", __func__);
 276                 return ret;
 277         }
 278
 279         ret = device_probe(cons);
 280         if (ret) {
 281                 debug("%s: Cannot probe console driver\n", __func__);
 282                 return ret;
 283         }
 284
 285         return 0;
 286 };
 287
 288 /* Post-relocation, allocate memory for the frame buffer */
 289 static int video_post_bind(struct udevice *dev)
 290 {
 291         ulong addr = gd->video_top;
 292         ulong size;
 293
 294         /* Before relocation there is nothing to do here */
 295         if (!(gd->flags & GD_FLG_RELOC))
 296                 return 0;
 297         size = alloc_fb(dev, &addr);
 298         if (addr < gd->video_bottom) {
 299                 /* Device tree node may need the 'u-boot,dm-pre-reloc' or
 300                  * 'u-boot,dm-pre-proper' tag
 301                  */
 302                 printf("Video device '%s' cannot allocate frame buffer memory -ensure the device is set up before relocation\n",
 303                        dev->name);
 304                 return -ENOSPC;
 305         }
 306         debug("%s: Claiming %lx bytes at %lx for video device '%s'\n",
 307               __func__, size, addr, dev->name);
 308         gd->video_bottom = addr;
 309
 310         return 0;
 311 }
 312
 313 UCLASS_DRIVER(video) = {
 314         .id             = UCLASS_VIDEO,
 315         .name           = "video",
 316         .flags          = DM_UC_FLAG_SEQ_ALIAS,
 317         .post_bind      = video_post_bind,
 318         .pre_probe      = video_pre_probe,
 319         .post_probe     = video_post_probe,
 320         .pre_remove     = video_pre_remove,
 321         .per_device_auto_alloc_size     = sizeof(struct video_priv),
 322         .per_device_platdata_auto_alloc_size = sizeof(struct video_uc_platdata),
 323 };