1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) 2015 Google, Inc
4 * (C) Copyright 2001-2015
5 * DENX Software Engineering -- wd@denx.de
6 * Compulab Ltd - http://compulab.co.il/
7 * Bernecker & Rainer Industrieelektronik GmbH - http://www.br-automation.com
8 */
9
10 #include <common.h>
11 #include <dm.h>
12 #include <video.h>
13 #include <video_console.h>
14 #include <video_font.h> /* Get font data, width and height */
15
console_normal_set_row(struct udevice * dev,uint row,int clr)16 static int console_normal_set_row(struct udevice *dev, uint row, int clr)
17 {
18 struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
19 void *line;
20 int pixels = VIDEO_FONT_HEIGHT * vid_priv->xsize;
21 int i;
22
23 line = vid_priv->fb + row * VIDEO_FONT_HEIGHT * vid_priv->line_length;
24 switch (vid_priv->bpix) {
25 #ifdef CONFIG_VIDEO_BPP8
26 case VIDEO_BPP8: {
27 uint8_t *dst = line;
28
29 for (i = 0; i < pixels; i++)
30 *dst++ = clr;
31 break;
32 }
33 #endif
34 #ifdef CONFIG_VIDEO_BPP16
35 case VIDEO_BPP16: {
36 uint16_t *dst = line;
37
38 for (i = 0; i < pixels; i++)
39 *dst++ = clr;
40 break;
41 }
42 #endif
43 #ifdef CONFIG_VIDEO_BPP32
44 case VIDEO_BPP32: {
45 uint32_t *dst = line;
46
47 for (i = 0; i < pixels; i++)
48 *dst++ = clr;
49 break;
50 }
51 #endif
52 default:
53 return -ENOSYS;
54 }
55
56 return 0;
57 }
58
console_normal_move_rows(struct udevice * dev,uint rowdst,uint rowsrc,uint count)59 static int console_normal_move_rows(struct udevice *dev, uint rowdst,
60 uint rowsrc, uint count)
61 {
62 struct video_priv *vid_priv = dev_get_uclass_priv(dev->parent);
63 void *dst;
64 void *src;
65
66 dst = vid_priv->fb + rowdst * VIDEO_FONT_HEIGHT * vid_priv->line_length;
67 src = vid_priv->fb + rowsrc * VIDEO_FONT_HEIGHT * vid_priv->line_length;
68 memmove(dst, src, VIDEO_FONT_HEIGHT * vid_priv->line_length * count);
69
70 return 0;
71 }
72
console_normal_putc_xy(struct udevice * dev,uint x_frac,uint y,char ch)73 static int console_normal_putc_xy(struct udevice *dev, uint x_frac, uint y,
74 char ch)
75 {
76 struct vidconsole_priv *vc_priv = dev_get_uclass_priv(dev);
77 struct udevice *vid = dev->parent;
78 struct video_priv *vid_priv = dev_get_uclass_priv(vid);
79 int i, row;
80 void *line = vid_priv->fb + y * vid_priv->line_length +
81 VID_TO_PIXEL(x_frac) * VNBYTES(vid_priv->bpix);
82
83 if (x_frac + VID_TO_POS(vc_priv->x_charsize) > vc_priv->xsize_frac)
84 return -EAGAIN;
85
86 for (row = 0; row < VIDEO_FONT_HEIGHT; row++) {
87 uchar bits = video_fontdata[ch * VIDEO_FONT_HEIGHT + row];
88
89 switch (vid_priv->bpix) {
90 #ifdef CONFIG_VIDEO_BPP8
91 case VIDEO_BPP8: {
92 uint8_t *dst = line;
93
94 for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
95 *dst++ = (bits & 0x80) ? vid_priv->colour_fg
96 : vid_priv->colour_bg;
97 bits <<= 1;
98 }
99 break;
100 }
101 #endif
102 #ifdef CONFIG_VIDEO_BPP16
103 case VIDEO_BPP16: {
104 uint16_t *dst = line;
105
106 for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
107 *dst++ = (bits & 0x80) ? vid_priv->colour_fg
108 : vid_priv->colour_bg;
109 bits <<= 1;
110 }
111 break;
112 }
113 #endif
114 #ifdef CONFIG_VIDEO_BPP32
115 case VIDEO_BPP32: {
116 uint32_t *dst = line;
117
118 for (i = 0; i < VIDEO_FONT_WIDTH; i++) {
119 *dst++ = (bits & 0x80) ? vid_priv->colour_fg
120 : vid_priv->colour_bg;
121 bits <<= 1;
122 }
123 break;
124 }
125 #endif
126 default:
127 return -ENOSYS;
128 }
129 line += vid_priv->line_length;
130 }
131
132 return VID_TO_POS(VIDEO_FONT_WIDTH);
133 }
134
console_normal_probe(struct udevice * dev)135 static int console_normal_probe(struct udevice *dev)
136 {
137 struct vidconsole_priv *vc_priv = dev_get_uclass_priv(dev);
138 struct udevice *vid_dev = dev->parent;
139 struct video_priv *vid_priv = dev_get_uclass_priv(vid_dev);
140
141 vc_priv->x_charsize = VIDEO_FONT_WIDTH;
142 vc_priv->y_charsize = VIDEO_FONT_HEIGHT;
143 vc_priv->cols = vid_priv->xsize / VIDEO_FONT_WIDTH;
144 vc_priv->rows = vid_priv->ysize / VIDEO_FONT_HEIGHT;
145
146 return 0;
147 }
148
149 struct vidconsole_ops console_normal_ops = {
150 .putc_xy = console_normal_putc_xy,
151 .move_rows = console_normal_move_rows,
152 .set_row = console_normal_set_row,
153 };
154
155 U_BOOT_DRIVER(vidconsole_normal) = {
156 .name = "vidconsole0",
157 .id = UCLASS_VIDEO_CONSOLE,
158 .ops = &console_normal_ops,
159 .probe = console_normal_probe,
160 };
161