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