Skip to content
Snippets Groups Projects
lcd_simplefb.c 1.36 KiB
Newer Older
  • Learn to ignore specific revisions
  • /*
     * Simplefb device tree support
     *
     * (C) Copyright 2015
     * Stephen Warren <swarren@wwwdotorg.org>
     *
     * SPDX-License-Identifier:	GPL-2.0+
     */
    
    #include <common.h>
    #include <lcd.h>
    #include <fdt_support.h>
    #include <libfdt.h>
    
    DECLARE_GLOBAL_DATA_PTR;
    
    static int lcd_dt_simplefb_configure_node(void *blob, int off)
    {
    	int vl_col = lcd_get_pixel_width();
    	int vl_row = lcd_get_pixel_height();
    
    	return fdt_setup_simplefb_node(blob, off, gd->fb_base, vl_col, vl_row,
    				       vl_col * 2, "r5g6b5");
    
    #elif LCD_BPP == LCD_COLOR32
    	return fdt_setup_simplefb_node(blob, off, gd->fb_base, vl_col, vl_row,
    				       vl_col * 4, "a8r8g8b8");
    
    #else
    	return -1;
    #endif
    }
    
    int lcd_dt_simplefb_add_node(void *blob)
    {
    	static const char compat[] = "simple-framebuffer";
    	static const char disabled[] = "disabled";
    	int off, ret;
    
    	off = fdt_add_subnode(blob, 0, "framebuffer");
    	if (off < 0)
    		return -1;
    
    	ret = fdt_setprop(blob, off, "status", disabled, sizeof(disabled));
    	if (ret < 0)
    		return -1;
    
    	ret = fdt_setprop(blob, off, "compatible", compat, sizeof(compat));
    	if (ret < 0)
    		return -1;
    
    	return lcd_dt_simplefb_configure_node(blob, off);
    }
    
    int lcd_dt_simplefb_enable_existing_node(void *blob)
    {
    	int off;
    
    	off = fdt_node_offset_by_compatible(blob, -1, "simple-framebuffer");
    	if (off < 0)
    		return -1;
    
    	return lcd_dt_simplefb_configure_node(blob, off);
    }