1
2
3
4
5
6
7#include <common.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
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43DECLARE_GLOBAL_DATA_PTR;
44
45void 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
52static 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
70int 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
90static int video_clear(struct udevice *dev)
91{
92 struct video_priv *priv = dev_get_uclass_priv(dev);
93
94 if (priv->bpix == VIDEO_BPP32) {
95 u32 *ppix = priv->fb;
96 u32 *end = priv->fb + priv->fb_size;
97
98 while (ppix < end)
99 *ppix++ = priv->colour_bg;
100 } else {
101 memset(priv->fb, priv->colour_bg, priv->fb_size);
102 }
103
104 return 0;
105}
106
107
108void video_sync(struct udevice *vid)
109{
110
111
112
113
114
115#if defined(CONFIG_ARM) && !defined(CONFIG_SYS_DCACHE_OFF)
116 struct video_priv *priv = dev_get_uclass_priv(vid);
117
118 if (priv->flush_dcache) {
119 flush_dcache_range((ulong)priv->fb,
120 ALIGN((ulong)priv->fb + priv->fb_size,
121 CONFIG_SYS_CACHELINE_SIZE));
122 }
123#elif defined(CONFIG_VIDEO_SANDBOX_SDL)
124 struct video_priv *priv = dev_get_uclass_priv(vid);
125 static ulong last_sync;
126
127 if (get_timer(last_sync) > 10) {
128 sandbox_sdl_sync(priv->fb);
129 last_sync = get_timer(0);
130 }
131#endif
132}
133
134void video_sync_all(void)
135{
136 struct udevice *dev;
137
138 for (uclass_find_first_device(UCLASS_VIDEO, &dev);
139 dev;
140 uclass_find_next_device(&dev)) {
141 if (device_active(dev))
142 video_sync(dev);
143 }
144}
145
146int video_get_xsize(struct udevice *dev)
147{
148 struct video_priv *priv = dev_get_uclass_priv(dev);
149
150 return priv->xsize;
151}
152
153int video_get_ysize(struct udevice *dev)
154{
155 struct video_priv *priv = dev_get_uclass_priv(dev);
156
157 return priv->ysize;
158}
159
160
161static int video_pre_probe(struct udevice *dev)
162{
163 struct video_priv *priv = dev_get_uclass_priv(dev);
164
165 priv->cmap = calloc(256, sizeof(ushort));
166 if (!priv->cmap)
167 return -ENOMEM;
168
169 return 0;
170}
171
172static int video_pre_remove(struct udevice *dev)
173{
174 struct video_priv *priv = dev_get_uclass_priv(dev);
175
176 free(priv->cmap);
177
178 return 0;
179}
180
181
182static int video_post_probe(struct udevice *dev)
183{
184 struct video_uc_platdata *plat = dev_get_uclass_platdata(dev);
185 struct video_priv *priv = dev_get_uclass_priv(dev);
186 char name[30], drv[15], *str;
187 const char *drv_name = drv;
188 struct udevice *cons;
189 int ret;
190
191
192 priv->fb = map_sysmem(plat->base, plat->size);
193 priv->line_length = priv->xsize * VNBYTES(priv->bpix);
194 priv->fb_size = priv->line_length * priv->ysize;
195
196
197#ifdef CONFIG_SYS_WHITE_ON_BLACK
198 priv->colour_fg = 0xffffff;
199#else
200 priv->colour_bg = 0xffffff;
201#endif
202 video_clear(dev);
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217 if (!priv->rot && IS_ENABLED(CONFIG_CONSOLE_TRUETYPE)) {
218 snprintf(name, sizeof(name), "%s.vidconsole_tt", dev->name);
219 strcpy(drv, "vidconsole_tt");
220 } else {
221 snprintf(name, sizeof(name), "%s.vidconsole%d", dev->name,
222 priv->rot);
223 snprintf(drv, sizeof(drv), "vidconsole%d", priv->rot);
224 }
225
226 str = strdup(name);
227 if (!str)
228 return -ENOMEM;
229 if (priv->vidconsole_drv_name)
230 drv_name = priv->vidconsole_drv_name;
231 ret = device_bind_driver(dev, drv_name, str, &cons);
232 if (ret) {
233 debug("%s: Cannot bind console driver\n", __func__);
234 return ret;
235 }
236
237 ret = device_probe(cons);
238 if (ret) {
239 debug("%s: Cannot probe console driver\n", __func__);
240 return ret;
241 }
242
243 return 0;
244};
245
246
247static int video_post_bind(struct udevice *dev)
248{
249 ulong addr = gd->video_top;
250 ulong size;
251
252
253 if ((!gd->flags & GD_FLG_RELOC))
254 return 0;
255 size = alloc_fb(dev, &addr);
256 if (addr < gd->video_bottom) {
257
258 printf("Video device '%s' cannot allocate frame buffer memory -ensure the device is set up before relocation\n",
259 dev->name);
260 return -ENOSPC;
261 }
262 debug("%s: Claiming %lx bytes at %lx for video device '%s'\n",
263 __func__, size, addr, dev->name);
264 gd->video_bottom = addr;
265
266 return 0;
267}
268
269UCLASS_DRIVER(video) = {
270 .id = UCLASS_VIDEO,
271 .name = "video",
272 .flags = DM_UC_FLAG_SEQ_ALIAS,
273 .post_bind = video_post_bind,
274 .pre_probe = video_pre_probe,
275 .post_probe = video_post_probe,
276 .pre_remove = video_pre_remove,
277 .per_device_auto_alloc_size = sizeof(struct video_priv),
278 .per_device_platdata_auto_alloc_size = sizeof(struct video_uc_platdata),
279};
280