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
14static 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	ofnode node = dev_ofnode(dev);
19	const char *format;
20	int ret;
21	fdt_addr_t base;
22	fdt_size_t size;
23	u32 width, height, rot;
24
25	base = dev_read_addr_size(dev, &size);
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	ret = ofnode_read_u32(node, "width", &width);
45	ret = ret ?: ofnode_read_u32(node, "height", &height);
46	if (ret || !width || !height) {
47		log_err("%s: invalid width or height: %d\n", __func__, ret);
48		return ret ?: -EINVAL;
49	}
50	ofnode_read_u32(node, "rot", &rot);
51	uc_priv->rot = rot;
52	uc_priv->xsize = width;
53	uc_priv->ysize = height;
54
55	format = ofnode_read_string(node, "format");
56	debug("%s: %dx%d@%s\n", __func__, uc_priv->xsize, uc_priv->ysize, format);
57
58	if (!format) {
59		log_err("%s: please add required property \"format\"\n", __func__);
60		return -EINVAL;
61	}
62
63	if (strcmp(format, "r5g6b5") == 0) {
64		uc_priv->bpix = VIDEO_BPP16;
65	} else if (strcmp(format, "a8b8g8r8") == 0 ||
66		   strcmp(format, "x8b8g8r8") == 0) {
67		uc_priv->bpix = VIDEO_BPP32;
68		uc_priv->format = VIDEO_X8B8G8R8;
69	} else if (strcmp(format, "a8r8g8b8") == 0 ||
70		   strcmp(format, "x8r8g8b8") == 0) {
71		uc_priv->bpix = VIDEO_BPP32;
72		uc_priv->format = VIDEO_X8R8G8B8;
73	} else if (strcmp(format, "a2r10g10b10") == 0 ||
74		   strcmp(format, "x2r10g10b10") == 0) {
75		uc_priv->bpix = VIDEO_BPP32;
76		uc_priv->format = VIDEO_X2R10G10B10;
77	} else {
78		log_err("%s: invalid format: %s\n", __func__, format);
79		return -EINVAL;
80	}
81
82	return 0;
83}
84
85static const struct udevice_id simple_video_ids[] = {
86	{ .compatible = "simple-framebuffer" },
87	{ }
88};
89
90U_BOOT_DRIVER(simple_video) = {
91	.name	= "simple_video",
92	.id	= UCLASS_VIDEO,
93	.of_match = simple_video_ids,
94	.probe	= simple_video_probe,
95};
96