#include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include static int s3c_lcdfb_setcolreg(unsigned int regno, unsigned int red, unsigned int green, unsigned int blue, unsigned int transp, struct fb_info *info);struct lcd_regs {unsigned long lcdcon1;unsigned long lcdcon2;unsigned long lcdcon3;unsigned long lcdcon4;unsigned long lcdcon5; unsigned long lcdsaddr1; unsigned long lcdsaddr2; unsigned long lcdsaddr3; unsigned long redlut; unsigned long greenlut; unsigned long bluelut; unsigned long reserved[9]; unsigned long dithmode; unsigned long tpal; unsigned long lcdintpnd; unsigned long lcdsrcpnd; unsigned long lcdintmsk; unsigned long lpcsel;};static struct fb_ops s3c_lcdfb_ops = {.owner = THIS_MODULE,.fb_setcolreg = s3c_lcdfb_setcolreg,.fb_fillrect = cfb_fillrect,.fb_copyarea = cfb_copyarea,.fb_imageblit = cfb_imageblit,};static struct fb_info *s3c_lcd;static volatile unsigned long *gpbcon;static volatile unsigned long *gpbdat;static volatile unsigned long *gpccon;static volatile unsigned long *gpdcon;static volatile unsigned long *gpgcon;static volatile struct lcd_regs* lcd_regs;static u32 pseudo_palette[16];/* from pxafb.c */static inline unsigned int chan_to_field(unsigned int chan, struct fb_bitfield *bf){chan &= 0xffff;chan >>= 16 - bf->length;return chan << bf->offset;}static int s3c_lcdfb_setcolreg(unsigned int regno, unsigned int red, unsigned int green, unsigned int blue, unsigned int transp, struct fb_info *info){unsigned int val;if (regno > 16)return 1;/* 用red,green,blue三原色構造出val */val = chan_to_field(red, &info->var.red);val |= chan_to_field(green, &info->var.green);val |= chan_to_field(blue, &info->var.blue);//((u32 *)(info->pseudo_palette))[regno] = val;pseudo_palette[regno] = val;return 0;}static int lcd_init(void){/* 1. 分配一個fb_info */s3c_lcd = framebuffer_alloc(0, NULL);/* 2. 設定 *//* 2.1 設定固定的引數 */strcpy(s3c_lcd->fix.id, "mylcd");s3c_lcd->fix.smem_len = 240*320*16/8;s3c_lcd->fix.type = FB_TYPE_PACKED_PIXELS;s3c_lcd->fix.visual = FB_VISUAL_TRUECOLOR; /* TFT */s3c_lcd->fix.line_length = 240*2;/* 2.2 設定可變的引數 */s3c_lcd->var.xres = 240;s3c_lcd->var.yres = 320;s3c_lcd->var.xres_virtual = 240;s3c_lcd->var.yres_virtual = 320;s3c_lcd->var.bits_per_pixel = 16;/* RGB:565 */s3c_lcd->var.red.offset = 11;s3c_lcd->var.red.length = 5;s3c_lcd->var.green.offset = 5;s3c_lcd->var.green.length = 6;s3c_lcd->var.blue.offset = 0;s3c_lcd->var.blue.length = 5;s3c_lcd->var.activate = FB_ACTIVATE_NOW;/* 2.3 設定操作函式 */s3c_lcd->fbops = &s3c_lcdfb_ops;/* 2.4 其他的設定 */s3c_lcd->pseudo_palette = pseudo_palette;//s3c_lcd->screen_base = ; /* 視訊記憶體的虛擬地址 */ s3c_lcd->screen_size = 240*324*16/8;/* 3. 硬體相關的操作 *//* 3.1 配置GPIO用於LCD */gpbcon = ioremap(0x56000010, 8);gpbdat = gpbcon+1;gpccon = ioremap(0x56000020, 4);gpdcon = ioremap(0x56000030, 4);gpgcon = ioremap(0x56000060, 4); *gpccon = 0xaaaaaaaa; /* GPIO管腳用於VD[7:0],LCDVF[2:0],VM,VFRAME,VLINE,VCLK,LEND */*gpdcon = 0xaaaaaaaa; /* GPIO管腳用於VD[23:8] */*gpbcon &= ~(3); /* GPB0設定為輸出引腳 */*gpbcon |= 1;*gpbdat &= ~1; /* 輸出低電平 */*gpgcon |= (3<<8 gpg4="" lcd_pwren="" 3="" 2="" lcd="" lcd="" vclk="" lcd_regs="ioremap(0x4D000000," sizeof="" struct="" lcd_regs="" bit="" 17:8="" :="" vclk="HCLK" clkval="" 1="" x="" 2="" lcd="" p14="" 10mhz="" 100ns="" 100mhz="" clkval="" 1="" x="" 2="" clkval="4" bit="" 6:5="" :="" 0b11="" tft="" lcd="" bit="" 4:1="" :="" 0b1100="" 16="" bpp="" for="" tft="" bit="" 0="" :="" 0="Disable" the="" video="" output="" and="" the="" lcd="" control="" signal="" lcd_regs-="">lcdcon1 = (4<<8) | (3<<5) | (0x0c<<1 if="" 1="" bit="" 31:24="" :="" vbpd="" vsync="" 1="" lcd="" t0-t2-t1="4" vbpd="3" bit="" 23:14="" :="" 320="" lineval="320-1=319" bit="" 13:6="" :="" vfpd="" vsync="" lcd="" t2-t5="322-320=2," vfpd="2-1=1" bit="" 5:0="" :="" vspw="" vsync="" lcd="" t1="1," vspw="1-1=0" lcd_regs-="">lcdcon2 = (3<<24) | (319<<14) | (1<<6) | (0<<0 bit="" 25:19="" :="" hbpd="" vsync="" 1="" lcd="" t6-t7-t8="17" hbpd="16" bit="" 18:8="" :="" 240="" hozval="240-1=239" bit="" 7:0="" :="" hfpd="" hsync="" lcd="" t8-t11="251-240=11," hfpd="11-1=10" lcd_regs-="">lcdcon3 = (16<<19) | (239<<8) | (10<<0 bit="" 7:0="" :="" hspw="" hsync="" lcd="" t7="5," hspw="5-1=4" lcd_regs-="">lcdcon4 = 4;#elselcd_regs->lcdcon2 = S3C2410_LCDCON2_VBPD(5) | \S3C2410_LCDCON2_LINEVAL(319) | \S3C2410_LCDCON2_VFPD(3) | \S3C2410_LCDCON2_VSPW(1);lcd_regs->lcdcon3 = S3C2410_LCDCON3_HBPD(10) | \S3C2410_LCDCON3_HOZVAL(239) | \S3C2410_LCDCON3_HFPD(1);lcd_regs->lcdcon4 = S3C2410_LCDCON4_MVAL(13) | \S3C2410_LCDCON4_HSPW(0);#endif/* 訊號的極性 * bit[11]: 1=565 format * bit[10]: 0 = The video data is fetched at VCLK falling edge * bit[9] : 1 = HSYNC訊號要反轉,即低電平有效 * bit[8] : 1 = VSYNC訊號要反轉,即低電平有效 * bit[6] : 0 = VDEN不用反轉 * bit[3] : 0 = PWREN輸出0 * bit[1] : 0 = BSWP * bit[0] : 1 = HWSWP 2440手冊P413 */lcd_regs->lcdcon5 = (1<<11) | (0<<10) | (1<<9) | (1<<8) | (1<<0 3="" 3="" framebuffer="" lcd="" s3c_lcd-="">screen_base = dma_alloc_writecombine(NULL, s3c_lcd->fix.smem_len, &s3c_lcd->fix.smem_start, GFP_KERNEL);lcd_regs->lcdsaddr1 = (s3c_lcd->fix.smem_start >> 1) & ~(3<<30 lcd_regs-="">lcdsaddr2 = ((s3c_lcd->fix.smem_start + s3c_lcd->fix.smem_len) >> 1) & 0x1fffff;lcd_regs->lcdsaddr3 = (240*16/16); /* 一行的長度(單位: 2位元組) *///s3c_lcd->fix.smem_start = xxx; /* 視訊記憶體的實體地址 *//* 啟動LCD */lcd_regs->lcdcon1 |= (1<<0 lcd="" lcd_regs-="">lcdcon5 |= (1<<3 lcd="" gpbdat="" 1="" 4="" register_framebuffer="" s3c_lcd="" return="" 0="" static="" void="" lcd_exit="" void="" unregister_framebuffer="" s3c_lcd="" lcd_regs-="">lcdcon1 &= ~(1<<0 lcd="" gpbdat="" 1="" dma_free_writecombine="" null="" s3c_lcd-="">fix.smem_len, s3c_lcd->screen_base, s3c_lcd->fix.smem_start);iounmap(lcd_regs);iounmap(gpbcon);iounmap(gpccon);iounmap(gpdcon);iounmap(gpgcon);framebuffer_release(s3c_lcd);}module_init(lcd_init);module_exit(lcd_exit);MODULE_LICENSE("GPL");