LCD Driver for Linux2.6.xx+ARM9

/**

  *   LCD driver

  *   reference:    fbmem.c     s3c2410fb.c   skeletonfb.c   atmel_lcdfb.c

  */

----------------------------------------------------------driver---------------------------------------------------------------

#include <linux/kernel.h>

#include <linux/platform_device.h>

#include <linux/dma-mapping.h>

#include <linux/interrupt.h>

#include <linux/clk.h>

#include <linux/fb.h>

#include <linux/init.h>

#include <linux/delay.h>

//#include <asm/arch/board.h>

//#include <asm/arch/cpu.h>

#include <asm/arch/gpio.h>

#include <asm/arch/regs-lcd.h>

//#define S3C24XX_PA_LCD    (0x4D000000)

//#define SZ_1M               0x00100000

//#define S3C24XX_SZ_LCD    SZ_1M

//#define IRQ_LCD  7

//typedef u32 dma_addr_t;

//static dma_addr_t map_dma; /* physical */

dma_addr_t map_dma; /* physical */

//typedef unsigned char u_char;

//static u_char *  map_cpu; /* virtual */

u_char * map_cpu;   /* virtual */

//typedef unsigned int u_int;

//static u_int map_size;

u_int  map_size;

struct s3c2410fb_hw {

 unsigned long lcdcon1;

 unsigned long lcdcon2;

 unsigned long lcdcon3;

 unsigned long lcdcon4;

 unsigned long lcdcon5;

 unsigned long lcdsaddr1;

 unsigned long lcdsaddr2;

 unsigned long lcdsaddr3;

};

static volatile struct s3c2410fb_hw *pczs3c2410fb_hw;

static struct fb_info *pczfb_info;

/*10^-12 = 1 * 10( -12)*/

/* pixclk is in picoseoncds, our clock is in Hz

 *

 * Hz -> picoseconds is / 10^-12

 */

/*HCLK=100MHz,PCLK=??MHz,*/

/* 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 czlcdfb_setcolreg(unsigned int regno, unsigned int red,

        unsigned int green, unsigned int blue,

        unsigned int transp, struct fb_info *info)

{

 unsigned int val;

 //u32 *pal;

 u32 *pal = pczfb_info->pseudo_palette;

 

 switch (pczfb_info->fix.visual) {

 case FB_VISUAL_TRUECOLOR:

   //there be error if this code is here,why??????????

   //u32 *pal = pczfb_info->pseudo_palette;

   val  = chan_to_field(red,   &pczfb_info->var.red);

   val |= chan_to_field(green, &pczfb_info->var.green);

   val |= chan_to_field(blue,  &pczfb_info->var.blue);

   pal[regno] = val;

  break;

  

 default:

  return 1;   /* unknown type */

 }

 return 0;

}

static struct fb_ops czlcdfb_ops = {

 .owner  = THIS_MODULE,

 .fb_setcolreg = czlcdfb_setcolreg,

 .fb_fillrect = cfb_fillrect,

 .fb_copyarea = cfb_copyarea,

 .fb_imageblit = cfb_imageblit,

};

static u32 pseudo_pal[16];

//static u32 palette_buffer[256];

static volatile unsigned long *gpccon = NULL;

//volatile unsigned long *gpcdat = NULL;

static volatile unsigned long *gpdcon = NULL;

//volatile unsigned long *gpddat = NULL;

static volatile unsigned long *gpgcon = NULL;

//static volatile unsigned long *gpgdat = NULL;

static int __init czlcdfb_init(void)

{

 int ret;

 int i = 0;

 unsigned long saddr1, saddr2, saddr3;

 struct fb_fix_screeninfo *czfix;//still forbit,why????

 struct fb_var_screeninfo *czvar;

 

 gpccon = (volatile unsigned long *)ioremap(0x56000020,4);

 //gpcdat = gpccon +1;

 gpdcon = (volatile unsigned long *)ioremap(0x56000030,4);

 //gpddat = gpdcon +1;

 gpgcon = (volatile unsigned long *)ioremap(0x56000060,4);

 //gpgdat = gpgcon +1;

 

 *gpccon  = 0xaaaaaaaa;

 *gpdcon  = 0xaaaaaaaa;

 *gpgcon  |= (0x3<<(4*2));

 

 //pczfb_info = framebuffer_alloc(sizeof(struct fb_info),NULL);

 pczfb_info = framebuffer_alloc(0,NULL);

 printk("framebuffer_alloc successed\n");

 czfix = &pczfb_info->fix;

 czvar = &pczfb_info->var;

 

 //tips:about -> and . 's difference!error: request for member `id' in something not a structure or union

 strcpy(czfix->id, "czlcdfb");

 printk("strcpy successed\n");

//fix

 czfix->type   = FB_TYPE_PACKED_PIXELS;//see FB_TYPE_

 czfix->type_aux  = 0;     //Interleave for interleaved Planes

 czfix->xpanstep  = 0;     //zero if no hardware panning

 czfix->ypanstep  = 0;     //zero if no hardware panning

 czfix->ywrapstep  = 0;    //zero if no hardware ywrap

 czfix->accel   = FB_ACCEL_NONE; //Indicate to driver which

 

 czfix->smem_len  = 320*240*16/8;       //Length of frame buffer mem in bytes

 czfix->line_length = 320*16/8;

 czfix->visual   = FB_VISUAL_TRUECOLOR; /* TFT */

 pczfb_info->screen_size   = 320*240*16/8;

 

 map_size = czfix->smem_len;

 

//if (!request_mem_region(czfix.smem_start,czfix.smem_len, "s3c2410-lcd"))ret = -EBUSY;

//fb_info->screen_base = ioremap(czfix.smem_start, czfix.smem_len);

//fb_info->screen_base = dma_alloc_writecombine(info->device, info->fix.smem_len,

     //(dma_addr_t *)&info->fix.smem_start, GFP_KERNEL);

 

 map_cpu = dma_alloc_writecombine(NULL, czfix->smem_len, &map_dma, GFP_KERNEL);

 if (!map_cpu)

    return -ENOMEM;

 printk("dma_alloc_writecombine successed\n");

    pczfb_info->screen_base =   map_cpu; 

 czfix->smem_start =   map_dma;

 

//var

 czvar->xres   = 320;     //visible resolution

 czvar->xres_virtual = 320;     //virtual resolution

 czvar->yres   = 240;

 czvar->yres_virtual = 240;

 

 czvar->red.offset = 11;

 czvar->green.offset = 5;

 czvar->blue.offset  = 0;

 czvar->transp.offset = 0;

 czvar->red.length = 5;

 czvar->green.length = 6;

 czvar->blue.length  = 5;

 czvar->transp.length = 0; 

 czvar->activate  = FB_ACTIVATE_NOW;  //set values immediately (or vbl)

 czvar->accel_flags  = 0;     //(OBSOLETE) see fb_info.flags

 czvar->bits_per_pixel = 16;

 czvar->nonstd  = 0;

 //fbinfo->var.height  = mach_info->height;

 //fbinfo->var.width  = mach_info->width;

 czvar->vmode  = FB_VMODE_NONINTERLACED;

 printk("FB_VMODE_NONINTERLACED successed\n");

//there will be oops for the code below,why?????????

#if 0

 czvar->upper_margin = S3C2410_LCDCON2_GET_VBPD(pczs3c2410fb_hw->lcdcon2) + 1;

 czvar->lower_margin = S3C2410_LCDCON2_GET_VFPD(pczs3c2410fb_hw->lcdcon2) + 1;

 czvar->vsync_len  = S3C2410_LCDCON2_GET_VSPW(pczs3c2410fb_hw->lcdcon2) + 1;

 czvar->left_margin  = S3C2410_LCDCON3_GET_HFPD(pczs3c2410fb_hw->lcdcon3) + 1;

 czvar->right_margin = S3C2410_LCDCON3_GET_HBPD(pczs3c2410fb_hw->lcdcon3) + 1;

 czvar->hsync_len  = S3C2410_LCDCON4_GET_HSPW(pczs3c2410fb_hw->lcdcon4) + 1;

#endif 

//pczfb_info 

 pczfb_info->fbops    = &czlcdfb_ops;

 pczfb_info->flags    = FBINFO_FLAG_DEFAULT;//?

 pczfb_info->pseudo_palette  = pseudo_pal;

 printk("pseudo_palette successed\n");

/*

//entry is clear/invalid

#define PALETTE_BUFF_CLEAR (0x80000000) 

// error: 'for' loop initial declaration used outside C99 mode

 for ( i = 0; i < 256; i++){

  palette_buffer[i] = PALETTE_BUFF_CLEAR;}

 printk("palette_buffer successed\n");

*/ 

/* 

//irq

 ret = request_irq(IRQ_LCD, s3c2410fb_irq, IRQF_DISABLED, "s3c2410-lcd", "unique_ID for free irq");

 if (ret) {

  printk("cannot get irq %d - err %d\n", irq, ret);

  return -EBUSY;

 }*/

 //error: syntax error before ')' token

 //pczs3c2410fb_hw =((*pczs3c2410fb_hw) *)ioremap(S3C24XX_PA_LCD, S3C24XX_SZ_LCD);

    //error: `s3c2410fb_hw' undeclared (first use in this function)

 //pczs3c2410fb_hw =(s3c2410fb_hw *)ioremap(S3C24XX_PA_LCD, S3C24XX_SZ_LCD);

 

 //pczs3c2410fb_hw =(volatile unsigned long *)ioremap(S3C24XX_PA_LCD, S3C24XX_SZ_LCD);

 pczs3c2410fb_hw =(volatile unsigned long *)ioremap(S3C24XX_PA_LCD, sizeof(struct s3c2410fb_hw));

 printk("pczs3c2410fb_hw successed\n");

 pczs3c2410fb_hw->lcdcon1 = (4<<8)|(3<<5)|(12<<1)|(0<<0);

 pczs3c2410fb_hw->lcdcon2 = (2<<24)|(239<<14)|(6<<6)|(12<<0);

 pczs3c2410fb_hw->lcdcon3 = (24<<19)|(319<<8)|(28<<0);

 pczs3c2410fb_hw->lcdcon4 = (42<<0);

 pczs3c2410fb_hw->lcdcon5 = (1<<11)|(0<<10)|(1<<9)|(1<<8)|(0<<7)|(0<<6)|(0<<5)|(0<<3)|(0<<1)|(1<<0);

 //saddr1 = czfix->smem_start >> 1&0x3fffffff;

 saddr1 = (czfix->smem_start >> 1);

 printk("saddr1 successed\n");

 //saddr2 =( czfix->smem_start+czfix->smem_len)>>1&0xfffff;

 saddr2 = czfix->smem_start;

 saddr2 += (czvar->xres * czvar->yres * czvar->bits_per_pixel)/8;

 saddr2>>= 1;

 printk("saddr2 successed\n");

 //saddr3 = S3C2410_OFFSIZE(0) | S3C2410_PAGEWIDTH((czvar->xres * czvar->bits_per_pixel / 16) & 0x7ff);

 saddr3 =  S3C2410_OFFSIZE(0) | S3C2410_PAGEWIDTH(czvar->xres * czvar->bits_per_pixel / 16);

 printk("saddr3 successed\n");

 pczs3c2410fb_hw->lcdsaddr1 = saddr1;

 pczs3c2410fb_hw->lcdsaddr2 = saddr2;

 pczs3c2410fb_hw->lcdsaddr3 = saddr3;

 printk("pczs3c2410fb_hw->lcdsaddr3 = saddr3 successed\n");

#if 0 

 //tips:Unable to handle kernel paging request at virtual address 000b00da, why????????

 writel(saddr1, pczs3c2410fb_hw->lcdsaddr1);

 printk("writel saddr1 successed\n");

 writel(saddr2, pczs3c2410fb_hw->lcdsaddr2);

 printk("writel saddr2 successed\n");

 writel(saddr3, pczs3c2410fb_hw->lcdsaddr3);

 printk("writel saddr3 successed\n");

#endif

 ret = register_framebuffer(pczfb_info);

 if (ret < 0)

  printk("failed to register framebuffer device: %d\n", ret);

 printk("register_framebuffer successed\n");

 pczs3c2410fb_hw->lcdcon5 = pczs3c2410fb_hw->lcdcon5|(1<<3);

 printk("pczs3c2410fb_hw->lcdcon5|(1<<3) successed\n");

 pczs3c2410fb_hw->lcdcon1 = pczs3c2410fb_hw->lcdcon1|(1<<0);

 printk("pczs3c2410fb_hw->lcdcon1|(1<<7) successed\n");

 //*gpgdat  |= 1<<4; //this way is wrong!remember!

 

 return 0;

}

static void __exit czlcdfb_exit(void)

{

  unregister_framebuffer(pczfb_info);

 dma_free_writecombine(NULL, map_size, map_cpu, map_dma);

 iounmap(pczs3c2410fb_hw);

 framebuffer_release(pczfb_info);

 

 iounmap(gpccon);

 iounmap(gpdcon);

 iounmap(gpgcon);

 //pczs3c2410fb_hw->lcdcon1 = (pczs3c2410fb_hw->lcdcon1|(0<<0));

 //pczs3c2410fb_hw->lcdcon5 = (pczs3c2410fb_hw->lcdcon5|(0<<3));

 

 return;

}

module_init(czlcdfb_init);

module_exit(czlcdfb_exit);

MODULE_AUTHOR("chaozang(cz) <zangchao.cn@gmail.com>, copy frm teacher:weidongshan,thanks so much!");

MODULE_DESCRIPTION("LCD Controller framebuffer driver");

MODULE_LICENSE("GPL");

----------------------------------------------------test commands----------------------------------------------------------

# insmod cfbcopyarea.ko

#insmod cfbfillrect.ko

#insmod cfbimgblt.ko

#echo test >/dev/tty1

#echo xxx.ko >/dev/fb0

-----------------------------------------------------------------------------

Contact: zangchao.cn@gmail.com