1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2017 Rob Clark
4 */
5
6 #include <common.h>
7 #include <dm.h>
8 #include <fdtdec.h>
9 #include <fdt_support.h>
10 #include <log.h>
11 #include <video.h>
12 #include <asm/global_data.h>
13
simple_video_probe(struct udevice * dev)14 static int simple_video_probe(struct udevice *dev)
15 {
16 struct video_uc_plat *plat = dev_get_uclass_plat(dev);
17 struct video_priv *uc_priv = dev_get_uclass_priv(dev);
18 const void *blob = gd->fdt_blob;
19 const int node = dev_of_offset(dev);
20 const char *format;
21 fdt_addr_t base;
22 fdt_size_t size;
23
24 base = fdtdec_get_addr_size_auto_parent(blob, dev_of_offset(dev->parent),
25 node, "reg", 0, &size, false);
26 if (base == FDT_ADDR_T_NONE) {
27 debug("%s: Failed to decode memory region\n", __func__);
28 return -EINVAL;
29 }
30
31 debug("%s: base=%llx, size=%llu\n", __func__, base, size);
32
33 /*
34 * TODO is there some way to reserve the framebuffer
35 * region so it isn't clobbered?
36 */
37 plat->base = base;
38 plat->size = size;
39
40 video_set_flush_dcache(dev, true);
41
42 debug("%s: Query resolution...\n", __func__);
43
44 uc_priv->xsize = fdtdec_get_uint(blob, node, "width", 0);
45 uc_priv->ysize = fdtdec_get_uint(blob, node, "height", 0);
46 uc_priv->rot = 0;
47
48 format = fdt_getprop(blob, node, "format", NULL);
49 debug("%s: %dx%d@%s\n", __func__, uc_priv->xsize, uc_priv->ysize, format);
50
51 if (strcmp(format, "r5g6b5") == 0) {
52 uc_priv->bpix = VIDEO_BPP16;
53 } else if (strcmp(format, "a8b8g8r8") == 0) {
54 uc_priv->bpix = VIDEO_BPP32;
55 } else {
56 printf("%s: invalid format: %s\n", __func__, format);
57 return -EINVAL;
58 }
59
60 return 0;
61 }
62
63 static const struct udevice_id simple_video_ids[] = {
64 { .compatible = "simple-framebuffer" },
65 { }
66 };
67
68 U_BOOT_DRIVER(simple_video) = {
69 .name = "simple_video",
70 .id = UCLASS_VIDEO,
71 .of_match = simple_video_ids,
72 .probe = simple_video_probe,
73 };
74