common/lcd_simplefb.c

   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
  17 static int lcd_dt_simplefb_configure_node(void *blob, int off)
  18 {
  19         int vl_col = lcd_get_pixel_width();
  20         int vl_row = lcd_get_pixel_height();
  21 #if LCD_BPP == LCD_COLOR16
  22         return fdt_setup_simplefb_node(blob, off, gd->fb_base, vl_col, vl_row,
  23                                        vl_col * 2, "r5g6b5");
  24 #elif LCD_BPP == LCD_COLOR32
  25         return fdt_setup_simplefb_node(blob, off, gd->fb_base, vl_col, vl_row,
  26                                        vl_col * 4, "a8r8g8b8");
  27 #else
  28         return -1;
  29 #endif
  30 }
  31
  32 int lcd_dt_simplefb_add_node(void *blob)
  33 {
  34         static const char compat[] = "simple-framebuffer";
  35         static const char disabled[] = "disabled";
  36         int off, ret;
  37
  38         off = fdt_add_subnode(blob, 0, "framebuffer");
  39         if (off < 0)
  40                 return -1;
  41
  42         ret = fdt_setprop(blob, off, "status", disabled, sizeof(disabled));
  43         if (ret < 0)
  44                 return -1;
  45
  46         ret = fdt_setprop(blob, off, "compatible", compat, sizeof(compat));
  47         if (ret < 0)
  48                 return -1;
  49
  50         return lcd_dt_simplefb_configure_node(blob, off);
  51 }
  52
  53 int lcd_dt_simplefb_enable_existing_node(void *blob)
  54 {
  55         int off;
  56
  57         off = fdt_node_offset_by_compatible(blob, -1, "simple-framebuffer");
  58         if (off < 0)
  59                 return -1;
  60
  61         return lcd_dt_simplefb_configure_node(blob, off);
  62 }