63 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			63 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * 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();
 | 
						|
#if LCD_BPP == LCD_COLOR16
 | 
						|
	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);
 | 
						|
}
 |