1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Simplefb device tree support
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * (C) Copyright 2015
5*4882a593Smuzhiyun * Stephen Warren <swarren@wwwdotorg.org>
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
8*4882a593Smuzhiyun */
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #include <common.h>
11*4882a593Smuzhiyun #include <dm.h>
12*4882a593Smuzhiyun #include <lcd.h>
13*4882a593Smuzhiyun #include <fdt_support.h>
14*4882a593Smuzhiyun #include <linux/libfdt.h>
15*4882a593Smuzhiyun #include <video.h>
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun DECLARE_GLOBAL_DATA_PTR;
18*4882a593Smuzhiyun
lcd_dt_simplefb_configure_node(void * blob,int off)19*4882a593Smuzhiyun static int lcd_dt_simplefb_configure_node(void *blob, int off)
20*4882a593Smuzhiyun {
21*4882a593Smuzhiyun int xsize, ysize;
22*4882a593Smuzhiyun int bpix; /* log2 of bits per pixel */
23*4882a593Smuzhiyun const char *name;
24*4882a593Smuzhiyun ulong fb_base;
25*4882a593Smuzhiyun #ifdef CONFIG_DM_VIDEO
26*4882a593Smuzhiyun struct video_uc_platdata *plat;
27*4882a593Smuzhiyun struct video_priv *uc_priv;
28*4882a593Smuzhiyun struct udevice *dev;
29*4882a593Smuzhiyun int ret;
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun ret = uclass_first_device_err(UCLASS_VIDEO, &dev);
32*4882a593Smuzhiyun if (ret)
33*4882a593Smuzhiyun return ret;
34*4882a593Smuzhiyun uc_priv = dev_get_uclass_priv(dev);
35*4882a593Smuzhiyun plat = dev_get_uclass_platdata(dev);
36*4882a593Smuzhiyun xsize = uc_priv->xsize;
37*4882a593Smuzhiyun ysize = uc_priv->ysize;
38*4882a593Smuzhiyun bpix = uc_priv->bpix;
39*4882a593Smuzhiyun fb_base = plat->base;
40*4882a593Smuzhiyun #else
41*4882a593Smuzhiyun xsize = lcd_get_pixel_width();
42*4882a593Smuzhiyun ysize = lcd_get_pixel_height();
43*4882a593Smuzhiyun bpix = LCD_BPP;
44*4882a593Smuzhiyun fb_base = gd->fb_base;
45*4882a593Smuzhiyun #endif
46*4882a593Smuzhiyun switch (bpix) {
47*4882a593Smuzhiyun case 4: /* VIDEO_BPP16 */
48*4882a593Smuzhiyun name = "r5g6b5";
49*4882a593Smuzhiyun break;
50*4882a593Smuzhiyun case 5: /* VIDEO_BPP32 */
51*4882a593Smuzhiyun name = "a8r8g8b8";
52*4882a593Smuzhiyun break;
53*4882a593Smuzhiyun default:
54*4882a593Smuzhiyun return -EINVAL;
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun
57*4882a593Smuzhiyun return fdt_setup_simplefb_node(blob, off, fb_base, xsize, ysize,
58*4882a593Smuzhiyun xsize * (1 << bpix) / 8, name);
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun
lcd_dt_simplefb_add_node(void * blob)61*4882a593Smuzhiyun int lcd_dt_simplefb_add_node(void *blob)
62*4882a593Smuzhiyun {
63*4882a593Smuzhiyun static const char compat[] = "simple-framebuffer";
64*4882a593Smuzhiyun static const char disabled[] = "disabled";
65*4882a593Smuzhiyun int off, ret;
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun off = fdt_add_subnode(blob, 0, "framebuffer");
68*4882a593Smuzhiyun if (off < 0)
69*4882a593Smuzhiyun return -1;
70*4882a593Smuzhiyun
71*4882a593Smuzhiyun ret = fdt_setprop(blob, off, "status", disabled, sizeof(disabled));
72*4882a593Smuzhiyun if (ret < 0)
73*4882a593Smuzhiyun return -1;
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun ret = fdt_setprop(blob, off, "compatible", compat, sizeof(compat));
76*4882a593Smuzhiyun if (ret < 0)
77*4882a593Smuzhiyun return -1;
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun return lcd_dt_simplefb_configure_node(blob, off);
80*4882a593Smuzhiyun }
81*4882a593Smuzhiyun
lcd_dt_simplefb_enable_existing_node(void * blob)82*4882a593Smuzhiyun int lcd_dt_simplefb_enable_existing_node(void *blob)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun int off;
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun off = fdt_node_offset_by_compatible(blob, -1, "simple-framebuffer");
87*4882a593Smuzhiyun if (off < 0)
88*4882a593Smuzhiyun return -1;
89*4882a593Smuzhiyun
90*4882a593Smuzhiyun return lcd_dt_simplefb_configure_node(blob, off);
91*4882a593Smuzhiyun }
92