1 /*
2 * Simplefb device tree support
3 *
4 * (C) Copyright 2015
5 * Stephen Warren <swarren@wwwdotorg.org>
6 *
7 * SPDX-License-Identifier: GPL-2.0+
8 */
9
10 #include <common.h>
11 #include <lcd.h>
12 #include <fdt_support.h>
13 #include <libfdt.h>
14
15 DECLARE_GLOBAL_DATA_PTR;
16
lcd_dt_simplefb_configure_node(void * blob,int off)17 static int lcd_dt_simplefb_configure_node(void *blob, int off)
18 {
19 #if LCD_BPP == LCD_COLOR16
20 int vl_col = lcd_get_pixel_width();
21 int vl_row = lcd_get_pixel_height();
22 return fdt_setup_simplefb_node(blob, off, gd->fb_base, vl_col, vl_row,
23 vl_col * 2, "r5g6b5");
24 #else
25 return -1;
26 #endif
27 }
28
lcd_dt_simplefb_add_node(void * blob)29 int lcd_dt_simplefb_add_node(void *blob)
30 {
31 static const char compat[] = "simple-framebuffer";
32 static const char disabled[] = "disabled";
33 int off, ret;
34
35 off = fdt_add_subnode(blob, 0, "framebuffer");
36 if (off < 0)
37 return -1;
38
39 ret = fdt_setprop(blob, off, "status", disabled, sizeof(disabled));
40 if (ret < 0)
41 return -1;
42
43 ret = fdt_setprop(blob, off, "compatible", compat, sizeof(compat));
44 if (ret < 0)
45 return -1;
46
47 return lcd_dt_simplefb_configure_node(blob, off);
48 }
49
lcd_dt_simplefb_enable_existing_node(void * blob)50 int lcd_dt_simplefb_enable_existing_node(void *blob)
51 {
52 int off;
53
54 off = fdt_node_offset_by_compatible(blob, -1, "simple-framebuffer");
55 if (off < 0)
56 return -1;
57
58 return lcd_dt_simplefb_configure_node(blob, off);
59 }
60