120 lines
		
	
	
	
		
			2.7 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			120 lines
		
	
	
	
		
			2.7 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  *	linux/arch/arm/mach-nspire/clcd.c | ||
|  |  * | ||
|  |  *	Copyright (C) 2013 Daniel Tang <tangrs@tangrs.id.au> | ||
|  |  * | ||
|  |  * This program is free software; you can redistribute it and/or modify | ||
|  |  * it under the terms of the GNU General Public License version 2, as | ||
|  |  * published by the Free Software Foundation. | ||
|  |  * | ||
|  |  */ | ||
|  | 
 | ||
|  | #include <linux/init.h>
 | ||
|  | #include <linux/of.h>
 | ||
|  | #include <linux/amba/bus.h>
 | ||
|  | #include <linux/amba/clcd.h>
 | ||
|  | #include <linux/dma-mapping.h>
 | ||
|  | 
 | ||
|  | static struct clcd_panel nspire_cx_lcd_panel = { | ||
|  | 	.mode		= { | ||
|  | 		.name		= "Color LCD", | ||
|  | 		.refresh	= 60, | ||
|  | 		.xres		= 320, | ||
|  | 		.yres		= 240, | ||
|  | 		.sync		= 0, | ||
|  | 		.vmode		= FB_VMODE_NONINTERLACED, | ||
|  | 		.pixclock	= 1, | ||
|  | 		.hsync_len	= 6, | ||
|  | 		.vsync_len	= 1, | ||
|  | 		.right_margin	= 50, | ||
|  | 		.left_margin	= 38, | ||
|  | 		.lower_margin	= 3, | ||
|  | 		.upper_margin	= 17, | ||
|  | 	}, | ||
|  | 	.width		= 65, /* ~6.50 cm */ | ||
|  | 	.height		= 49, /* ~4.87 cm */ | ||
|  | 	.tim2		= TIM2_IPC, | ||
|  | 	.cntl		= CNTL_LCDTFT | CNTL_LCDVCOMP(1), | ||
|  | 	.bpp		= 16, | ||
|  | 	.caps		= CLCD_CAP_565, | ||
|  | }; | ||
|  | 
 | ||
|  | static struct clcd_panel nspire_classic_lcd_panel = { | ||
|  | 	.mode		= { | ||
|  | 		.name		= "Grayscale LCD", | ||
|  | 		.refresh	= 60, | ||
|  | 		.xres		= 320, | ||
|  | 		.yres		= 240, | ||
|  | 		.sync		= FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, | ||
|  | 		.vmode		= FB_VMODE_NONINTERLACED, | ||
|  | 		.pixclock	= 1, | ||
|  | 		.hsync_len	= 6, | ||
|  | 		.vsync_len	= 1, | ||
|  | 		.right_margin	= 6, | ||
|  | 		.left_margin	= 6, | ||
|  | 	}, | ||
|  | 	.width		= 71, /* 7.11cm */ | ||
|  | 	.height		= 53, /* 5.33cm */ | ||
|  | 	.tim2		= 0x80007d0, | ||
|  | 	.cntl		= CNTL_LCDMONO8, | ||
|  | 	.bpp		= 8, | ||
|  | 	.grayscale	= 1, | ||
|  | 	.caps		= CLCD_CAP_5551, | ||
|  | }; | ||
|  | 
 | ||
|  | int nspire_clcd_setup(struct clcd_fb *fb) | ||
|  | { | ||
|  | 	struct clcd_panel *panel; | ||
|  | 	size_t panel_size; | ||
|  | 	const char *type; | ||
|  | 	dma_addr_t dma; | ||
|  | 	int err; | ||
|  | 
 | ||
|  | 	BUG_ON(!fb->dev->dev.of_node); | ||
|  | 
 | ||
|  | 	err = of_property_read_string(fb->dev->dev.of_node, "lcd-type", &type); | ||
|  | 	if (err) { | ||
|  | 		pr_err("CLCD: Could not find lcd-type property\n"); | ||
|  | 		return err; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	if (!strcmp(type, "cx")) { | ||
|  | 		panel = &nspire_cx_lcd_panel; | ||
|  | 	} else if (!strcmp(type, "classic")) { | ||
|  | 		panel = &nspire_classic_lcd_panel; | ||
|  | 	} else { | ||
|  | 		pr_err("CLCD: Unknown lcd-type %s\n", type); | ||
|  | 		return -EINVAL; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	panel_size = ((panel->mode.xres * panel->mode.yres) * panel->bpp) / 8; | ||
|  | 	panel_size = ALIGN(panel_size, PAGE_SIZE); | ||
|  | 
 | ||
|  | 	fb->fb.screen_base = dma_alloc_writecombine(&fb->dev->dev, | ||
|  | 		panel_size, &dma, GFP_KERNEL); | ||
|  | 
 | ||
|  | 	if (!fb->fb.screen_base) { | ||
|  | 		pr_err("CLCD: unable to map framebuffer\n"); | ||
|  | 		return -ENOMEM; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	fb->fb.fix.smem_start = dma; | ||
|  | 	fb->fb.fix.smem_len = panel_size; | ||
|  | 	fb->panel = panel; | ||
|  | 
 | ||
|  | 	return 0; | ||
|  | } | ||
|  | 
 | ||
|  | int nspire_clcd_mmap(struct clcd_fb *fb, struct vm_area_struct *vma) | ||
|  | { | ||
|  | 	return dma_mmap_writecombine(&fb->dev->dev, vma, | ||
|  | 		fb->fb.screen_base, fb->fb.fix.smem_start, | ||
|  | 		fb->fb.fix.smem_len); | ||
|  | } | ||
|  | 
 | ||
|  | void nspire_clcd_remove(struct clcd_fb *fb) | ||
|  | { | ||
|  | 	dma_free_writecombine(&fb->dev->dev, fb->fb.fix.smem_len, | ||
|  | 		fb->fb.screen_base, fb->fb.fix.smem_start); | ||
|  | } |