global: Migrate CONFIG_STACKBASE to CFG
[platform/kernel/u-boot.git] / drivers / video / console_rotate.c
index 71a5c5e..36c8d06 100644 (file)
@@ -15,45 +15,47 @@ static int console_set_row_1(struct udevice *dev, uint row, int clr)
 {
        struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
        int pbytes = VNBYTES(vid_priv->bpix);
-       void *line;
+       void *start, *line;
        int i, j;
+       int ret;
 
-       line = vid_priv->fb + vid_priv->line_length -
+       start = vid_priv->fb + vid_priv->line_length -
                (row + 1) * VIDEO_FONT_HEIGHT * pbytes;
+       line = start;
        for (j = 0; j < vid_priv->ysize; j++) {
                switch (vid_priv->bpix) {
-#ifdef CONFIG_VIDEO_BPP8
-               case VIDEO_BPP8: {
-                       uint8_t *dst = line;
+               case VIDEO_BPP8:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP8)) {
+                               uint8_t *dst = line;
 
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
-                               *dst++ = clr;
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP16
-               case VIDEO_BPP16: {
-                       uint16_t *dst = line;
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+                                       *dst++ = clr;
+                               break;
+                       }
+               case VIDEO_BPP16:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP16)) {
+                               uint16_t *dst = line;
 
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
-                               *dst++ = clr;
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP32
-               case VIDEO_BPP32: {
-                       uint32_t *dst = line;
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+                                       *dst++ = clr;
+                               break;
+                       }
+               case VIDEO_BPP32:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP32)) {
+                               uint32_t *dst = line;
 
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
-                               *dst++ = clr;
-                       break;
-               }
-#endif
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+                                       *dst++ = clr;
+                               break;
+                       }
                default:
                        return -ENOSYS;
                }
                line += vid_priv->line_length;
        }
+       ret = vidconsole_sync_copy(dev, start, line);
+       if (ret)
+               return ret;
 
        return 0;
 }
@@ -62,10 +64,10 @@ static int console_move_rows_1(struct udevice *dev, uint rowdst, uint rowsrc,
                               uint count)
 {
        struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
+       int pbytes = VNBYTES(vid_priv->bpix);
        void *dst;
        void *src;
-       int pbytes = VNBYTES(vid_priv->bpix);
-       int j;
+       int j, ret;
 
        dst = vid_priv->fb + vid_priv->line_length -
                (rowdst + count) * VIDEO_FONT_HEIGHT * pbytes;
@@ -73,7 +75,10 @@ static int console_move_rows_1(struct udevice *dev, uint rowdst, uint rowsrc,
                (rowsrc + count) * VIDEO_FONT_HEIGHT * pbytes;
 
        for (j = 0; j < vid_priv->ysize; j++) {
-               memmove(dst, src, VIDEO_FONT_HEIGHT * pbytes * count);
+               ret = vidconsole_memmove(dev, dst, src,
+                                        VIDEO_FONT_HEIGHT * pbytes * count);
+               if (ret)
+                       return ret;
                src += vid_priv->line_length;
                dst += vid_priv->line_length;
        }
@@ -86,58 +91,64 @@ static int console_putc_xy_1(struct udevice *dev, uint x_frac, uint y, char ch)
        struct vidconsole_priv *vc_priv = dev_get_uclass_priv(dev);
        struct udevice *vid = dev->parent;
        struct video_priv *vid_priv = dev_get_uclass_priv(vid);
+       uchar *pfont = video_fontdata + (u8)ch * VIDEO_FONT_HEIGHT;
        int pbytes = VNBYTES(vid_priv->bpix);
-       int i, col;
+       int i, col, x, linenum, ret;
        int mask = 0x80;
-       void *line;
-       uchar *pfont = video_fontdata + (u8)ch * VIDEO_FONT_HEIGHT;
+       void *start, *line;
 
-       line = vid_priv->fb + (VID_TO_PIXEL(x_frac) + 1) *
-                       vid_priv->line_length - (y + 1) * pbytes;
+       linenum = VID_TO_PIXEL(x_frac) + 1;
+       x = y + 1;
+       start = vid_priv->fb + linenum * vid_priv->line_length - x * pbytes;
+       line = start;
        if (x_frac + VID_TO_POS(vc_priv->x_charsize) > vc_priv->xsize_frac)
                return -EAGAIN;
 
        for (col = 0; col < VIDEO_FONT_HEIGHT; col++) {
                switch (vid_priv->bpix) {
-#ifdef CONFIG_VIDEO_BPP8
-               case VIDEO_BPP8: {
-                       uint8_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
-                               *dst-- = (pfont[i] & mask) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
+               case VIDEO_BPP8:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP8)) {
+                               uint8_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
+                                       *dst-- = (pfont[i] & mask) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP16
-               case VIDEO_BPP16: {
-                       uint16_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
-                               *dst-- = (pfont[i] & mask) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
+               case VIDEO_BPP16:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP16)) {
+                               uint16_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
+                                       *dst-- = (pfont[i] & mask) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP32
-               case VIDEO_BPP32: {
-                       uint32_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
-                               *dst-- = (pfont[i] & mask) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
+               case VIDEO_BPP32:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP32)) {
+                               uint32_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
+                                       *dst-- = (pfont[i] & mask) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
                default:
                        return -ENOSYS;
                }
                line += vid_priv->line_length;
                mask >>= 1;
        }
+       /* We draw backwards from 'start, so account for the first line */
+       ret = vidconsole_sync_copy(dev, start - vid_priv->line_length, line);
+       if (ret)
+               return ret;
 
        return VID_TO_POS(VIDEO_FONT_WIDTH);
 }
@@ -146,43 +157,47 @@ static int console_putc_xy_1(struct udevice *dev, uint x_frac, uint y, char ch)
 static int console_set_row_2(struct udevice *dev, uint row, int clr)
 {
        struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
-       void *line;
+       void *start, *line, *end;
        int pixels = VIDEO_FONT_HEIGHT * vid_priv->xsize;
-       int i;
+       int i, ret;
 
-       line = vid_priv->fb + vid_priv->ysize * vid_priv->line_length -
+       start = vid_priv->fb + vid_priv->ysize * vid_priv->line_length -
                (row + 1) * VIDEO_FONT_HEIGHT * vid_priv->line_length;
+       line = start;
        switch (vid_priv->bpix) {
-#ifdef CONFIG_VIDEO_BPP8
-       case VIDEO_BPP8: {
-               uint8_t *dst = line;
+       case VIDEO_BPP8:
+               if (IS_ENABLED(CONFIG_VIDEO_BPP8)) {
+                       uint8_t *dst = line;
 
-               for (i = 0; i < pixels; i++)
-                       *dst++ = clr;
-               break;
-       }
-#endif
-#ifdef CONFIG_VIDEO_BPP16
-       case VIDEO_BPP16: {
-               uint16_t *dst = line;
-
-               for (i = 0; i < pixels; i++)
-                       *dst++ = clr;
-               break;
-       }
-#endif
-#ifdef CONFIG_VIDEO_BPP32
-       case VIDEO_BPP32: {
-               uint32_t *dst = line;
-
-               for (i = 0; i < pixels; i++)
-                       *dst++ = clr;
-               break;
-       }
-#endif
+                       for (i = 0; i < pixels; i++)
+                               *dst++ = clr;
+                       end = dst;
+                       break;
+               }
+       case VIDEO_BPP16:
+               if (IS_ENABLED(CONFIG_VIDEO_BPP16)) {
+                       uint16_t *dst = line;
+
+                       for (i = 0; i < pixels; i++)
+                               *dst++ = clr;
+                       end = dst;
+                       break;
+               }
+       case VIDEO_BPP32:
+               if (IS_ENABLED(CONFIG_VIDEO_BPP32)) {
+                       uint32_t *dst = line;
+
+                       for (i = 0; i < pixels; i++)
+                               *dst++ = clr;
+                       end = dst;
+                       break;
+               }
        default:
                return -ENOSYS;
        }
+       ret = vidconsole_sync_copy(dev, start, end);
+       if (ret)
+               return ret;
 
        return 0;
 }
@@ -200,7 +215,8 @@ static int console_move_rows_2(struct udevice *dev, uint rowdst, uint rowsrc,
                vid_priv->line_length;
        src = end - (rowsrc + count) * VIDEO_FONT_HEIGHT *
                vid_priv->line_length;
-       memmove(dst, src, VIDEO_FONT_HEIGHT * vid_priv->line_length * count);
+       vidconsole_memmove(dev, dst, src,
+                          VIDEO_FONT_HEIGHT * vid_priv->line_length * count);
 
        return 0;
 }
@@ -210,63 +226,67 @@ static int console_putc_xy_2(struct udevice *dev, uint x_frac, uint y, char ch)
        struct vidconsole_priv *vc_priv = dev_get_uclass_priv(dev);
        struct udevice *vid = dev->parent;
        struct video_priv *vid_priv = dev_get_uclass_priv(vid);
-       int i, row;
-       void *line;
+       int pbytes = VNBYTES(vid_priv->bpix);
+       int i, row, x, linenum, ret;
+       void *start, *line;
 
        if (x_frac + VID_TO_POS(vc_priv->x_charsize) > vc_priv->xsize_frac)
                return -EAGAIN;
-
-       line = vid_priv->fb + (vid_priv->ysize - y - 1) *
-                       vid_priv->line_length +
-                       (vid_priv->xsize - VID_TO_PIXEL(x_frac) -
-                       VIDEO_FONT_WIDTH - 1) * VNBYTES(vid_priv->bpix);
+       linenum = vid_priv->ysize - y - 1;
+       x = vid_priv->xsize - VID_TO_PIXEL(x_frac) - 1;
+       start = vid_priv->fb + linenum * vid_priv->line_length + x * pbytes;
+       line = start;
 
        for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
                unsigned int idx = (u8)ch * VIDEO_FONT_HEIGHT + row;
                uchar bits = video_fontdata[idx];
 
                switch (vid_priv->bpix) {
-#ifdef CONFIG_VIDEO_BPP8
-               case VIDEO_BPP8: {
-                       uint8_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
-                               *dst-- = (bits & 0x80) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
-                               bits <<= 1;
+               case VIDEO_BPP8:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP8)) {
+                               uint8_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
+                                       *dst-- = (bits & 0x80) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                                       bits <<= 1;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP16
-               case VIDEO_BPP16: {
-                       uint16_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
-                               *dst-- = (bits & 0x80) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
-                               bits <<= 1;
+               case VIDEO_BPP16:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP16)) {
+                               uint16_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
+                                       *dst-- = (bits & 0x80) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                                       bits <<= 1;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP32
-               case VIDEO_BPP32: {
-                       uint32_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
-                               *dst-- = (bits & 0x80) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
-                               bits <<= 1;
+               case VIDEO_BPP32:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP32)) {
+                               uint32_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
+                                       *dst-- = (bits & 0x80) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                                       bits <<= 1;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
                default:
                        return -ENOSYS;
                }
                line -= vid_priv->line_length;
        }
+       /* Add 4 bytes to allow for the first pixel writen */
+       ret = vidconsole_sync_copy(dev, start + 4, line);
+       if (ret)
+               return ret;
 
        return VID_TO_POS(VIDEO_FONT_WIDTH);
 }
@@ -275,44 +295,45 @@ static int console_set_row_3(struct udevice *dev, uint row, int clr)
 {
        struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
        int pbytes = VNBYTES(vid_priv->bpix);
-       void *line;
-       int i, j;
+       void *start, *line;
+       int i, j, ret;
 
-       line = vid_priv->fb + row * VIDEO_FONT_HEIGHT * pbytes;
+       start = vid_priv->fb + row * VIDEO_FONT_HEIGHT * pbytes;
+       line = start;
        for (j = 0; j < vid_priv->ysize; j++) {
                switch (vid_priv->bpix) {
-#ifdef CONFIG_VIDEO_BPP8
-               case VIDEO_BPP8: {
-                       uint8_t *dst = line;
+               case VIDEO_BPP8:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP8)) {
+                               uint8_t *dst = line;
 
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
-                               *dst++ = clr;
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP16
-               case VIDEO_BPP16: {
-                       uint16_t *dst = line;
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+                                       *dst++ = clr;
+                               break;
+                       }
+               case VIDEO_BPP16:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP16)) {
+                               uint16_t *dst = line;
 
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
-                               *dst++ = clr;
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP32
-               case VIDEO_BPP32: {
-                       uint32_t *dst = line;
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+                                       *dst++ = clr;
+                               break;
+                       }
+               case VIDEO_BPP32:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP32)) {
+                               uint32_t *dst = line;
 
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
-                               *dst++ = clr;
-                       break;
-               }
-#endif
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++)
+                                       *dst++ = clr;
+                               break;
+                       }
                default:
                        return -ENOSYS;
                }
                line += vid_priv->line_length;
        }
+       ret = vidconsole_sync_copy(dev, start, line);
+       if (ret)
+               return ret;
 
        return 0;
 }
@@ -321,16 +342,19 @@ static int console_move_rows_3(struct udevice *dev, uint rowdst, uint rowsrc,
                               uint count)
 {
        struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
+       int pbytes = VNBYTES(vid_priv->bpix);
        void *dst;
        void *src;
-       int pbytes = VNBYTES(vid_priv->bpix);
-       int j;
+       int j, ret;
 
        dst = vid_priv->fb + rowdst * VIDEO_FONT_HEIGHT * pbytes;
        src = vid_priv->fb + rowsrc * VIDEO_FONT_HEIGHT * pbytes;
 
        for (j = 0; j < vid_priv->ysize; j++) {
-               memmove(dst, src, VIDEO_FONT_HEIGHT * pbytes * count);
+               ret = vidconsole_memmove(dev, dst, src,
+                                        VIDEO_FONT_HEIGHT * pbytes * count);
+               if (ret)
+                       return ret;
                src += vid_priv->line_length;
                dst += vid_priv->line_length;
        }
@@ -343,58 +367,62 @@ static int console_putc_xy_3(struct udevice *dev, uint x_frac, uint y, char ch)
        struct vidconsole_priv *vc_priv = dev_get_uclass_priv(dev);
        struct udevice *vid = dev->parent;
        struct video_priv *vid_priv = dev_get_uclass_priv(vid);
+       uchar *pfont = video_fontdata + (u8)ch * VIDEO_FONT_HEIGHT;
        int pbytes = VNBYTES(vid_priv->bpix);
-       int i, col;
+       int i, col, x, ret;
        int mask = 0x80;
-       void *line = vid_priv->fb +
-               (vid_priv->ysize - VID_TO_PIXEL(x_frac) - 1) *
-               vid_priv->line_length + y * pbytes;
-       uchar *pfont = video_fontdata + (u8)ch * VIDEO_FONT_HEIGHT;
+       void *start, *line;
 
        if (x_frac + VID_TO_POS(vc_priv->x_charsize) > vc_priv->xsize_frac)
                return -EAGAIN;
-
+       x = vid_priv->ysize - VID_TO_PIXEL(x_frac) - 1;
+       start = vid_priv->fb + x * vid_priv->line_length + y * pbytes;
+       line = start;
        for (col = 0; col < VIDEO_FONT_HEIGHT; col++) {
                switch (vid_priv->bpix) {
-#ifdef CONFIG_VIDEO_BPP8
-               case VIDEO_BPP8: {
-                       uint8_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
-                               *dst++ = (pfont[i] & mask) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
+               case VIDEO_BPP8:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP8)) {
+                               uint8_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
+                                       *dst++ = (pfont[i] & mask) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP16
-               case VIDEO_BPP16: {
-                       uint16_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
-                               *dst++ = (pfont[i] & mask) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
+               case VIDEO_BPP16:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP16)) {
+                               uint16_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
+                                       *dst++ = (pfont[i] & mask) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
-#ifdef CONFIG_VIDEO_BPP32
-               case VIDEO_BPP32: {
-                       uint32_t *dst = line;
-
-                       for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
-                               *dst++ = (pfont[i] & mask) ? vid_priv->colour_fg
-                                       : vid_priv->colour_bg;
+               case VIDEO_BPP32:
+                       if (IS_ENABLED(CONFIG_VIDEO_BPP32)) {
+                               uint32_t *dst = line;
+
+                               for (i = 0; i < VIDEO_FONT_HEIGHT; i++) {
+                                       *dst++ = (pfont[i] & mask) ?
+                                               vid_priv->colour_fg :
+                                               vid_priv->colour_bg;
+                               }
+                               break;
                        }
-                       break;
-               }
-#endif
                default:
                        return -ENOSYS;
                }
                line -= vid_priv->line_length;
                mask >>= 1;
        }
+       /* Add a line to allow for the first pixels writen */
+       ret = vidconsole_sync_copy(dev, start + vid_priv->line_length, line);
+       if (ret)
+               return ret;
 
        return VID_TO_POS(VIDEO_FONT_WIDTH);
 }