S3C2440上LCD驱动 (FrameBuffer)实例开发讲解

VSYNC/VFRAME /STV：
垂直同步信号(TFT)/帧同步信号(STN)/SEC TFT信号；

HSYNC/VLINE/CPV： 水平同步信号(TFT)/行同步脉冲信号(STN)/SEC TFT信号；

VCLK/LCD_HCLK： 象素时钟信号(TFT/STN)/SEC TFT信号；

VD[23:0]： LCD 像素数据输出端口(TFT/STN/SEC TFT)；

VDEN/VM/TP： 数据使能信号(TFT)/LCD驱动交流偏置信号(STN)/SEC TFT 信号；

LEND/STH： 行结束信号(TFT)/SEC TFT信号；

LCD_LPCOE： SEC TFT OE信号；

LCD_LPCREV： SEC TFT REV信号；

LCD_LPCREVB： SEC TFT REVB信号。

A：
显示指针从矩形左上角的第一行第一个点开始，一个点一个点的在LCD上显示，在上面的时序图上用时间线表示就为VCLK，我们称之为像素时钟信号；

B： 当显示指针一直显示到矩形的右边就结束这一行，那么这一行的动作在上面的时序图中就称之为1 Line；

C： 接下来显示指针又回到矩形的左边从第二行开始显示，注意，显示指针在从第一行的右边回到第二行的左边是需要一定的时间的，我们称之为行切换；

D： 如此类推，显示指针就这样一行一行的显示至矩形的右下角才把一副图显示完成。因此，这一行一行的显示在时间线上看，就是时序图上的HSYNC；

E： 然而，LCD的显示并不是对一副图像快速的显示一下，为了持续和稳定的在LCD上显示，就需要切换到另一幅图上(另一幅图可以和上一副图一样或者不一样，目的只是为了将图像持续的显示在LCD上)。那么这一副一副的图像就称之为帧，在时序图上就表示为1 Frame，因此从时序图上可以看出1 Line只是1 Frame中的一行；

F： 同样的，在帧与帧切换之间也是需要一定的时间的，我们称之为帧切换，那么LCD整个显示的过程在时间线上看，就可表示为时序图上的VSYNC。

VBPD(vertical back porch)：
表示在一帧图像开始时，垂直同步信号以后的无效的行数，对应驱动中的 upper_margin；

VFBD(vertical front porch)： 表示在一帧图像结束后，垂直同步信号以前的无效的行数，对应驱动中的lower_margin；

VSPW(vertical sync pulse width)： 
表示垂直同步脉冲的宽度，用行数计算，对应驱动中的vsync_len；

HBPD(horizontal back porch)： 
表示从水平同步信号开始到一行的有效数据开始之间的VCLK的个数，对应驱动中的 left_margin；

HFPD(horizontal front porth)： 
表示一行的有效数据结束到下一个水平同步信号开始之间的VCLK的个数，对应驱动中的 right_margin；

HSPW(horizontal sync pulse width)： 
表示水平同步信号的宽度，用VCLK计算，对应驱动中的hsync_len；

LCDCON1：17 - 8位CLKVAL

          6 - 5位扫描模式(对于STN屏:4位单/双扫、8位单扫) 

          4 - 1位色位模式(1BPP、8BPP、16BPP等)

LCDCON2：31 - 24位VBPD 

         23 - 14位LINEVAL 

         13 - 6位VFPD 

          5 - 0位VSPW

LCDCON3：25 - 19位HBPD 

         18 - 8位HOZVAL 

          7 - 0位HFPD

LCDCON4： 7 - 0位HSPW

LCDCON5：

struct fb_info
{ 

    int node;

    int flags;

    struct fb_var_screeninfo var;
/*LCD可变参数结构体*/ 

    struct fb_fix_screeninfo fix;
/*LCD固定参数结构体*/ 

    struct fb_monspecs monspecs;  /*LCD显示器标准*/

    struct work_struct 
queue ;     /*帧缓冲事件队列*/

    struct fb_pixmap pixmap;     
/*图像硬件mapper* / 

    struct fb_pixmap sprite;     
/*光标硬件mapper*/ 

    struct fb_cmap cmap;         
/*当前的颜色表*/ 

    struct fb_videomode 
* mode;    /*当前的显示模式*/

# ifdef CONFIG_FB_BACKLIGHT

     struct backlight_device
* bl_dev;/*对应的背光设备
*/ 

    struct mutex bl_curve_mutex;

    u8 bl_curve[ FB_BACKLIGHT_LEVELS]
;/*背光调整 
*/ 

# endif 

# ifdef CONFIG_FB_DEFERRED_IO

    struct delayed_work deferred_work;

    struct fb_deferred_io 
* fbdefio; 

# endif 

    struct fb_ops 
* fbops; /* 对底层硬件操作的函数指针*/

    struct device 
* device; 

    struct device 
* dev;    /*fb设备*/

    int class_flag;     

# ifdef CONFIG_FB_TILEBLITTING

    struct fb_tile_ops 
* tileops; 
/*图块Blitting* / 

# endif 

    char __iomem * screen_base;    /*虚拟基地址*/

    unsigned long screen_size;    /*LCD IO映射的虚拟内存大小*/

    void * pseudo_palette;         /*伪16色颜色表*/

# define FBINFO_STATE_RUNNING    0

# define FBINFO_STATE_SUSPENDED  1

    u32 state;   /*LCD的挂起或恢复状态*/

    void * fbcon_par;

    void * par;     

} ;

struct fb_var_screeninfo
{ 

    __u32 xres;                 /*可见屏幕一行有多少个像素点*/

    __u32 yres;                 /*可见屏幕一列有多少个像素点*/

    __u32 xres_virtual;         /*虚拟屏幕一行有多少个像素点*/         

    __u32 yres_virtual;         /*虚拟屏幕一列有多少个像素点*/

    __u32 xoffset;              /*虚拟到可见屏幕之间的行偏移*/

    __u32 yoffset;              /*虚拟到可见屏幕之间的列偏移*/

    __u32 bits_per_pixel;       /*每个像素的位数即BPP*/

    __u32 grayscale;            /*非0时，指的是灰度*/

    struct fb_bitfield red;     /*fb缓存的R位域*/

    struct fb_bitfield green;   /*fb缓存的G位域*/

    struct fb_bitfield blue;    /*fb缓存的B位域*/

    struct fb_bitfield transp;  /*透明度*/     

    __u32 nonstd;               /* != 0 非标准像素格式*/

    __u32 activate;                 

    __u32 height;               /*高度*/

    __u32 width;                /*宽度*/

    __u32 accel_flags;     

    /*定时：除了pixclock本身外，其他的都以像素时钟为单位*/ 

    __u32 pixclock;             /*像素时钟(皮秒)*/

    __u32 left_margin;          /*行切换，从同步到绘图之间的延迟*/

    __u32 right_margin;         /*行切换，从绘图到同步之间的延迟*/

    __u32 upper_margin;         /*帧切换，从同步到绘图之间的延迟*/

    __u32 lower_margin;         /*帧切换，从绘图到同步之间的延迟*/

    __u32 hsync_len;            /*水平同步的长度*/

    __u32 vsync_len;            /*垂直同步的长度*/

    __u32 sync; 

    __u32 vmode; 

    __u32 rotate ;

    __u32 reserved[ 5]
;          /*保留*/

} ;

struct fb_fix_screeninfo
{ 

    char id[ 16]
;                 /*字符串形式的标示符 */

    unsigned long smem_start;    /*fb缓存的开始位置 */

    __u32 smem_len;              /*fb缓存的长度 */

    __u32 type;                  /*看FB_TYPE_* */

    __u32 type_aux;              /*分界*/

    __u32 visual;                /*看FB_VISUAL_* */

    __u16 xpanstep;              /*如果没有硬件panning就赋值为0 */

    __u16 ypanstep;              /*如果没有硬件panning就赋值为0 */

    __u16 ywrapstep;             /*如果没有硬件ywrap就赋值为0 */

    __u32 line_length;           /*一行的字节数 */

    unsigned long mmio_start;    /*内存映射IO的开始位置*/

    __u32 mmio_len;              /*内存映射IO的长度*/

    __u32 accel; 

    __u16 reserved[ 3]
;           /*保留*/

} ;

struct fb_ops
{ 

    struct module 
* owner; 

     //检查可变参数并进行设置

    int ( 
* fb_check_var) 
( struct fb_var_screeninfo 
* var, struct fb_info
* info) 
; 

     //根据设置的值进行更新，使之有效

    int ( 
* fb_set_par) 
( struct fb_info 
* info) ;

     //设置颜色寄存器

    int ( 
* fb_setcolreg) 
( unsigned regno,
unsigned red,
unsigned green,

             unsigned blue,
unsigned transp,
struct fb_info * info)
; 

     //显示空白

    int ( 
* fb_blank) 
( int blank,
struct fb_info * info)
; 

     //矩形填充

    void ( 
* fb_fillrect) 
( struct fb_info 
* info, const
struct fb_fillrect 
* rect) ;

     //复制数据

    void ( 
* fb_copyarea) 
( struct fb_info 
* info, const
struct fb_copyarea 
* region) ;

     //图形填充

    void ( 
* fb_imageblit) 
( struct fb_info 
* info, const
struct fb_image * image)
; 

} ;

/* LCD Controller */

//LCD控制器的资源信息

static struct resource s3c_lcd_resource[
] = 
{ 

    [ 0] 
= { 

        . start = S3C24XX_PA_LCD
, //控制器IO端口开始地址

        . end
= S3C24XX_PA_LCD + S3C24XX_SZ_LCD
- 1 ,
//控制器IO端口结束地址

        . flags
= IORESOURCE_MEM 
, //标识为 LCD控制器IO端口，在驱动中引用这个就表示引用IO端口

    } 
, 

    [ 1] 
= { 

        . start = IRQ_LCD
, 
//LCD中断 

        . end
= IRQ_LCD, 

        . flags = IORESOURCE_IRQ
, 
//标识为LCD中断 

    } 

} ; 

static u64 s3c_device_lcd_dmamask 
= 0xffffffffUL; 

struct platform_device s3c_device_lcd 
= { 

    . name         
= "s3c2410-lcd" ,
//作为平台设备的LCD设备名

    . id        
= - 1,

    . num_resources = ARRAY_SIZE( s3c_lcd_resource)
, 
//资源数量 

    . resource    
= s3c_lcd_resource 
, //引用上面定义的资源

    . dev 
= { 

        . dma_mask =
& s3c_device_lcd_dmamask,

        . coherent_dma_mask = 0xffffffffUL

    } 

} ; 

EXPORT_SYMBOL( s3c_device_lcd)
; 
//导出定义的LCD平台设备，好在mach-smdk2440.c的 smdk2440_devices[]中添加到平台设备列表中

/* LCD driver info */

//LCD硬件的配置信息，注意这里我使用的LCD是NEC 3.5寸TFT屏，这些参数要根据具体的LCD屏进行设置

static struct s3c2410fb_display smdk2440_lcd_cfg __initdata
= {

//这个地方的设置是配置LCD寄存器5，这些宏定义在regs-lcd.h中，计算后二进制为：111111111111，然后对照数据手册上LCDCON5的各位来看，注意是从右边开始

    . lcdcon5 = S3C2410_LCDCON5_FRM565
| 

               S3C2410_LCDCON5_INVVLINE | 

               S3C2410_LCDCON5_INVVFRAME | 

               S3C2410_LCDCON5_PWREN | 

               S3C2410_LCDCON5_HWSWP, 

    . type    = S3C2410_LCDCON1_TFT
, 
//TFT 类型 

    /* NEC 3.5'' */

    . width        
= 240 ,
//屏幕宽度

    . height      
= 320 ,
//屏幕高度

//以下一些参数在上面的时序图分析中讲到过,各参数的值请跟据具体的LCD屏数据手册结合上面时序分析来设定

    . pixclock    
= 100000 ,
//像素时钟

    . xres        
= 240 ,
//水平可见的有效像素

    . yres        
= 320 ,
//垂直可见的有效像素

    . bpp         
= 16 ,
//色位模式

    . left_margin  = 19
, 
//行切换，从同步到绘图之间的延迟

    . right_margin = 36
, 
//行切换，从绘图到同步之间的延迟

    . hsync_len    = 5
, 
//水平同步的长度 

    . upper_margin = 1
, 
//帧切换，从同步到绘图之间的延迟

    . lower_margin = 5
, 
//帧切换，从绘图到同步之间的延迟

    . vsync_len    = 1
, 
//垂直同步的长度 

} 
; 

static struct s3c2410fb_mach_info smdk2440_fb_info __initdata
= { 

    . displays        
= & smdk2440_lcd_cfg 
, //应用上面定义的配置信息

    . num_displays    = 1,

    . default_display 
= 0, 

    .
gpccon          =
0xaaaa555a,//将GPC0、GPC1配置成LEND和VCLK，将GPC8-15配置成VD0-7,其他配置成普通输出IO口

    .
gpccon_mask     =
0xffffffff,

    .
gpcup           =
0x0000ffff,//禁止GPIOC的上拉功能

    .
gpcup_mask      =
0xffffffff,

    .
gpdcon          =
0xaaaaaaaa,//将GPD0-15配置成VD8-23

    .
gpdcon_mask     =
0xffffffff,

    .
gpdup           =
0x0000ffff,//禁止GPIOD的上拉功能

    .
gpdup_mask      =
0xffffffff,

    . lpcsel         
=
0x0,//这个是三星TFT屏的参数，这里不用

} ;

//S3C2440初始化函数

static void __init smdk2440_machine_init(
void ) 

{

//调用该函数将上面定义的LCD硬件信息保存到平台数据中

    s3c24xx_fb_set_platdata(
& smdk2440_fb_info)
; 

    

    s3c_i2c0_set_platdata( 
NULL )
; 

    platform_add_devices( smdk2440_devices, ARRAY_SIZE( smdk2440_devices)
) ; 

    smdk_machine_init( 
) ; 

}

void __init s3c24xx_fb_set_platdata(
struct s3c2410fb_mach_info 
* pd) 

{ 

    struct s3c2410fb_mach_info 
* npd; 

    npd = kmalloc(
sizeof ( 
* npd) , GFP_KERNEL)
; 

    if ( npd)
{ 

        memcpy 
( npd, pd,
sizeof ( 
* npd) )
;

//这里就是将内核中定义的s3c2410fb_mach_info结构体数据保存到LCD平台数据中，所以在写驱动的时候就可以直接在平台数据中获取 s3c2410fb_mach_info结构体的数据(即LCD各种参数信息)进行操作

        s3c_device_lcd. dev. platform_data
= npd; 

    } else 
{ 

        printk( KERN_ERR 
"no memory for LCD platform data/n" ) 
; 

    } 

}

#
include < linux/ kernel. h>

# include 
< linux/ module. h>

# include 
< linux/ errno
. h> 

# include 
< linux/ init. h>

# include 
< linux/ platform_device. h>

# include 
< linux/ dma- mapping. h>

# include 
< linux/ fb. h>

# include 
< linux/ clk. h>

# include 
< linux/ interrupt. h>

# include 
< linux/ mm. h>

#
include < linux/slab
. h> 

# include 
< linux/ delay
. h> 

# include 
< asm / irq. h>

# include 
< asm / io. h>

# include 
< asm / div64. h>

# include 
< mach/ regs- lcd. h>

# include 
< mach/ regs- gpio. h>

# include 
< mach/ fb. h>

# include 
< linux/ pm. h>

/*LCD FrameBuffer设备探测的实现，注意这里使用一个__devinit宏，到lcd_fb_remove接口函数实现的地方讲解*/

static int __devinit lcd_fb_probe(
struct platform_device 
* pdev) 

{ 

    int i; 

    int ret;

    struct resource * res;   /*用来保存从LCD平台设备中获取的LCD资源*/

    struct fb_info  * fbinfo;  /*FrameBuffer驱动所对应的fb_info结构体*/

    struct s3c2410fb_mach_info * mach_info;  /*保存从内核中获取的平台设备数据*/

    struct my2440fb_var * fbvar;  /*上面定义的驱动程序全局变量结构体*/

    struct s3c2410fb_display * display;  /*LCD屏的配置信息结构体，该结构体定义在mach-s3c2410 /include/mach/fb.h中*/

     /*获取LCD硬件相关信息数据，在前面讲过内核使用 s3c24xx_fb_set_platdata函数将LCD的硬件相关信息保存到

     了LCD平台数据中，所以这里我们就从平台数据中取出来在驱动中使用*/ 

    mach_info = pdev-
> dev. platform_data;

    if ( mach_info
= = 
NULL ) 

    { 

        /*判断获取数据是否成功*/ 

        dev_err( & pdev-
> dev, 
"no platform data for lcd/n" ) 
; 

        return - EINVAL;

    } 

    /*获得在内核中定义的FrameBuffer平台设备的LCD配置信息结构体数据*/ 

    display = mach_info-
> displays + mach_info-
> default_display;

/*给fb_info分配空间，大小为my2440fb_var结构的内存，framebuffer_alloc定义在fb.h中在fbsysfs.c中实现*/

    fbinfo = framebuffer_alloc(
sizeof ( 
struct my2440fb_var) 
, & pdev-
> dev) 
; 

    if ( 
! fbinfo) 

    { 

        dev_err( & pdev-
> dev, 
"framebuffer alloc of registers failed/n" )
; 

        ret = -
ENOMEM ; 

        goto err_noirq;

    } 

    platform_set_drvdata( pdev, fbinfo)
; /*重新将LCD平台设备数据设置为fbinfo，好在后面的一些函数中来使用*/

     /*这里的用途其实就是将fb_info的成员 par(注意是一个void类型的指针)指向这里的私有变量结构体fbvar，

     目的是到其他接口函数中再取出fb_info的成员par，从而能继续使用这里的私有变量*/ 

    fbvar = fbinfo-
> par; 

    fbvar- > dev
= & pdev-
> dev; 

    /* 在系统定义的LCD平台设备资源中获取LCD中断号,platform_get_irq定义在platform_device.h中*/

    fbvar- > lcd_irq_no
= platform_get_irq( pdev, 0)
; 

    if ( fbvar-
> lcd_irq_no < 0)

    { 

        /*判断获取中断号是否成功*/ 

        dev_err( & pdev-
> dev, 
"no lcd irq for platform/n" ) 
; 

        return - ENOENT;

    } 

    /*获取LCD平台设备所使用的IO端口资源，注意这个IORESOURCE_MEM标志和LCD平台设备定义中的一致*/

    res = platform_get_resource( pdev, IORESOURCE_MEM, 0)
; 

    if ( res
= = 
NULL ) 

    { 

        /*判断获取资源是否成功*/ 

        dev_err( & pdev-
> dev, 
"failed to get memory region resource/n" )
; 

        return - ENOENT;

    } 

    /*申请LCD IO端口所占用的IO空间(注意理解IO空间和内存空间的区别),request_mem_region定义在ioport.h中*/

    fbvar- > lcd_mem
= request_mem_region( res-
> start, res-
> end - res-
> start + 1, pdev-
> name) 
; 

    if ( fbvar-
> lcd_mem =
= NULL 
) 

    { 

        /*判断申请IO空间是否成功*/ 

        dev_err( & pdev-
> dev, 
"failed to reserve memory region/n" ) 
; 

        return - ENOENT;

    } 

     /*将LCD的IO端口占用的这段IO空间映射到内存的虚拟地址，ioremap定义在io.h中

     注意：IO空间要映射后才能使用，以后对虚拟地址的操作就是对IO空间的操作*/ 

    fbvar- > lcd_base
= ioremap( res-
> start, res-
> end - res-
> start + 1)
; 

    if ( fbvar-
> lcd_base =
= NULL 
) 

    { 

        /*判断映射虚拟地址是否成功*/ 

        dev_err( & pdev-
> dev, 
"ioremap() of registers failed/n" ) 
; 

        ret = - EINVAL;

        goto err_nomem;

    } 

     /*从平台时钟队列中获取LCD的时钟，这里为什么要取得这个时钟，从LCD屏的时序图上看，各种控制信号的延迟

     都跟LCD的时钟有关。系统的一些时钟定义在arch/arm/plat-s3c24xx/s3c2410-clock.c中*/ 

    fbvar- > lcd_clock
= clk_get( 
NULL , "lcd"
) ; 

    if ( 
! fbvar- > lcd_clock)

    { 

        /*判断获取时钟是否成功*/ 

        dev_err( & pdev-
> dev, 
"failed to find lcd clock source/n" ) 
; 

        ret = - ENOENT;

        goto err_nomap;

    } 

    /*时钟获取后要使能后才可以使用，clk_enable定义在arch/arm /plat-s3c/clock.c中*/

    clk_enable( fbvar-
> lcd_clock)
; 

     /*申请LCD中断服务，上面获取的中断号 lcd_fb_irq，使用快速中断方式:IRQF_DISABLED

     中断服务程序为:lcd_fb_irq，将LCD平台设备pdev做参数传递过去了*/ 

    ret = request_irq( fbvar-
> lcd_irq_no, lcd_fb_irq, IRQF_DISABLED, pdev-
> name, fbvar)
; 

    if ( ret)

    { 

        /*判断申请中断服务是否成功*/ 

        dev_err( & pdev-
> dev, 
"IRQ%d error %d/n" , fbvar-
> lcd_irq_no, ret)
; 

        ret = - EBUSY;

        goto err_noclk;

    }

/*好了，以上是对要使用的资源进行了获取和设置。下面就开始初始化填充 fb_info结构体*/

    /* 首先初始化fb_info中代表LCD固定参数的结构体fb_fix_screeninfo*/

     /*像素值与显示内存的映射关系有5种，定义在 fb.h中。现在采用FB_TYPE_PACKED_PIXELS方式，在该方式下，

    像素值与内存直接对应，比如在显示内存某单元写入一个"1"时，该单元对应的像素值也将是"1"，这使得应用层

    把显示内存映射到用户空间变得非常方便。Linux中当LCD为TFT屏时，显示驱动管理显示内存就是基于这种方式*/ 

    strcpy (fbinfo ->fix .id ,
driver _name )
; /*字符串形式的标识符*/

    fbinfo- > fix. type
= FB_TYPE_PACKED_PIXELS;

    fbinfo- > fix. type_aux
= 0; 
/*以下这些根据fb_fix_screeninfo定义中的描述，当没有硬件是都设为0*/ 

    fbinfo- > fix. xpanstep
= 0; 

    fbinfo- > fix. ypanstep
= 0; 

    fbinfo- > fix.
ywrapstep = 0;

    fbinfo- > fix. accel
= FB_ACCEL_NONE;

/*接着，再初始化fb_info中代表LCD可变参数的结构体fb_var_screeninfo*/

    fbinfo -
> var 
. nonstd           
= 0 ;

    fbinfo -
> var 
. activate         
= FB_ACTIVATE_NOW 
; 

    fbinfo -
> var 
. accel_flags      
= 0 ;

    fbinfo -
> var 
. vmode            
= FB_VMODE_NONINTERLACED 
; 

    fbinfo -
> var 
. xres             
= display -
> xres 
; 

    fbinfo -
> var 
. yres             
= display -
> yres 
; 

    fbinfo -
> var 
. bits_per_pixel   
= display -
> bpp 
;

/*指定对底层硬件操作的函数指针, 因内容较多故其定义在第③步中再讲*/

    fbinfo -
> fbops               
= &
my2440fb_ops ;

/*初始化色调色板(颜色表)为空*/

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

     { 

        fbvar -
> palette_buffer
[ i 
] = 
PALETTE_BUFF_CLEAR ; 

     }

/*Framebuffer底层硬件操作各接口函数*/

static struct fb_ops my2440fb_ops
= 

{ 

    . owner          = THIS_MODULE,

    . fb_check_var   = my2440fb_check_var,
/*第②步中已实现*/ 

    . fb_set_par     = my2440fb_set_par,
/*设置fb_info中的参数，主要是LCD的显示模式*/ 

    . fb_blank       = my2440fb_blank,
/*显示空白(即：LCD开关控制)*/ 

    . fb_setcolreg   = my2440fb_setcolreg,
/*设置颜色表*/ 

    /*以下三个函数是可选的，主要是提供fb_console的支持，在内核中已经实现，这里直接调用即可*/

    . fb_fillrect    = cfb_fillrect,
/*定义在 drivers/video/cfbfillrect.c中*/ 

    . fb_copyarea    = cfb_copyarea,
/*定义在drivers/video/cfbcopyarea.c中*/ 

    . fb_imageblit   = cfb_imageblit,
/*定义在 drivers/video/cfbimgblt.c中*/ 

}; 

/*设置 fb_info中的参数，这里根据用户设置的可变参数var调整固定参数fix*/ 

static int my2440fb_set_par(
struct fb_info * fbinfo)

{ 

    /*获得fb_info中的可变参数*/ 

    struct fb_var_screeninfo 
* var = & fbinfo-
> var; 

    /*判断可变参数中的色位模式，根据色位模式来设置色彩模式*/ 

    switch ( var-
> bits_per_pixel)

    { 

        case 32:

        case 16:

        case 12:
/*12BPP时，设置为真彩色(分成红、绿、蓝三基色)*/ 

            fbinfo- 
> fix. visual 
= FB_VISUAL_TRUECOLOR; 

            break 
; 

        case 1:
/*1BPP时，设置为黑白色(分黑、白两种色，FB_VISUAL_MONO01代表黑，FB_VISUAL_MONO10代表白)*/

            fbinfo- 
> fix. visual 
= FB_VISUAL_MONO01; 

            break 
; 

        default :
/*默认设置为伪彩色，采用索引颜色显示*/ 

            fbinfo- 
> fix. visual 
= FB_VISUAL_PSEUDOCOLOR; 

            break 
; 

    } 

    /*设置fb_info中固定参数中一行的字节数，公式：1行字节数=(1行像素个数*每像素位数BPP)/8 */

    fbinfo- > fix. line_length
= ( var-
> xres_virtual * var-
> bits_per_pixel)
/ 8; 

    /*修改以上参数后，重新激活fb_info中的参数配置(即：使修改后的参数在硬件上生效)*/

    my2440fb_activate_var( fbinfo)
; 

    return 0;

} 

/*重新激活fb_info中的参数配置*/ 

static void my2440fb_activate_var(
struct fb_info * fbinfo)

{ 

    /*获得结构体变量*/ 

    struct my2440fb_var * fbvar
= fbinfo- 
> par; 

    void __iomem * regs
= fbvar- 
> lcd_base; 

    /*获得fb_info可变参数*/ 

    struct fb_var_screeninfo 
* var = & fbinfo-
> var; 

    /*计算LCD控制寄存器1中的CLKVAL值, 根据数据手册中该寄存器的描述，计算公式如下：

    * STN屏：VCLK = HCLK / (CLKVAL * 2), CLKVAL要求>= 2

    * TFT屏：VCLK = HCLK / [(CLKVAL + 1) * 2], CLKVAL要求>= 0*/ 

    int clkdiv = my2440fb_calc_pixclk( fbvar, var-
> pixclock)
/ 2; 

    /*获得屏幕的类型*/ 

    int type = fbvar-
> regs. lcdcon1
& S3C2410_LCDCON1_TFT;

    if ( type
= = S3C2410_LCDCON1_TFT)

    { 

        /*根据数据手册按照TFT屏的要求配置LCD控制寄存器1-5*/ 

        my2440fb_config_tft_lcd_regs( fbinfo,
& fbvar- 
> regs) ;

        - - clkdiv;

        if ( clkdiv
< 0) 

        { 

            clkdiv = 0;

        } 

    } 

    else 

    { 

        /*根据数据手册按照STN屏的要求配置LCD控制寄存器1-5*/ 

        my2440fb_config_stn_lcd_regs( fbinfo,
& fbvar- 
> regs) ;

        if ( clkdiv
< 2) 

        { 

            clkdiv = 2;

        } 

    } 

    /*设置计算的LCD控制寄存器1中的CLKVAL值*/ 

    fbvar- > regs. lcdcon1
| = S3C2410_LCDCON1_CLKVAL( clkdiv)
; 

    /*将各参数值写入LCD控制寄存器1-5中*/ 

    writel( fbvar-
> regs. lcdcon1
& ~ S3C2410_LCDCON1_ENVID, regs
+ S3C2410_LCDCON1)
; 

    writel( fbvar-
> regs. lcdcon2, regs
+ S3C2410_LCDCON2)
; 

    writel( fbvar-
> regs. lcdcon3, regs
+ S3C2410_LCDCON3)
; 

    writel( fbvar-
> regs. lcdcon4, regs
+ S3C2410_LCDCON4)
; 

    writel( fbvar-
> regs. lcdcon5, regs
+ S3C2410_LCDCON5)
; 

    /*配置帧缓冲起始地址寄存器1-3*/ 

    my2440fb_set_lcdaddr( fbinfo)
; 

    fbvar- > regs. lcdcon1
| = S3C2410_LCDCON1_ENVID,

    writel( fbvar-
> regs. lcdcon1, regs
+ S3C2410_LCDCON1)
; 

} 

/*计算LCD 控制寄存器1中的CLKVAL值*/ 

static unsigned
int my2440fb_calc_pixclk(
struct my2440fb_var 
* fbvar, unsigned
long pixclk)

{ 

    /*获得LCD的时钟*/ 

    unsigned long clk
= clk_get_rate( fbvar-
> lcd_clock)
; 

    /* 像素时钟单位是皮秒，而时钟的单位是赫兹，所以计算公式为：

     * Hz -> picoseconds is / 10^-12

     */ 

    unsigned long
long div 
= ( unsigned
long long 
) clk * pixclk;

    div > 
> = 12;             /* div / 2^12 */

    do_div( div
, 625 * 625UL
* 625) 
; /* div / 5^12, do_div宏定义在asm/div64.h中*/

    return div
; 

} 

/*根据数据手册按照TFT屏的要求配置LCD控制寄存器1-5*/ 

static void my2440fb_config_tft_lcd_regs(
const struct fb_info
* fbinfo, 
struct s3c2410fb_hw * regs)

{ 

    const struct my2440fb_var * fbvar
= fbinfo- 
> par; 

    const struct fb_var_screeninfo
* var = 
& fbinfo- > var;

    /*根据色位模式设置LCD控制寄存器1和5，参考数据手册*/ 

    switch ( var-
> bits_per_pixel)

    { 

        case 1:
/*1BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_TFT1BPP; 

            break 
; 

        case 2:
/*2BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_TFT2BPP; 

            break 
; 

        case 4:
/*4BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_TFT4BPP; 

            break 
; 

        case 8:
/*8BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_TFT8BPP; 

            regs- 
> lcdcon5 | 
= S3C2410_LCDCON5_BSWP | S3C2410_LCDCON5_FRM565;

            regs- 
> lcdcon5 & 
= ~ S3C2410_LCDCON5_HWSWP;

            break 
; 

        case 16:
/*16BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_TFT16BPP; 

            regs- 
> lcdcon5 & 
= ~ S3C2410_LCDCON5_BSWP;

            regs- 
> lcdcon5 | 
= S3C2410_LCDCON5_HWSWP; 

            break 
; 

        case 32:
/*32BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_TFT24BPP; 

            regs- 
> lcdcon5 & 
= ~ ( S3C2410_LCDCON5_BSWP
| S3C2410_LCDCON5_HWSWP 
| S3C2410_LCDCON5_BPP24BL) 
; 

            break 
; 

        default :
/*无效的BPP*/ 

            dev_err( fbvar-
> dev, 
"invalid bpp %d/n" , var-
> bits_per_pixel)
; 

    } 

    /*设置LCD配置寄存器2、3、4*/ 

    regs- > lcdcon2
= S3C2410_LCDCON2_LINEVAL( var-
> yres - 1)
| 

            S3C2410_LCDCON2_VBPD( var-
> upper_margin - 1)
| 

            S3C2410_LCDCON2_VFPD( var-
> lower_margin - 1)
| 

            S3C2410_LCDCON2_VSPW( var-
> vsync_len - 1)
; 

    regs- > lcdcon3
= S3C2410_LCDCON3_HBPD( var-
> right_margin - 1)
| 

            S3C2410_LCDCON3_HFPD( var-
> left_margin - 1)
| 

            S3C2410_LCDCON3_HOZVAL( var-
> xres - 1)
; 

    regs- > lcdcon4
= S3C2410_LCDCON4_HSPW( var-
> hsync_len - 1)
; 

} 

/*根据数据手册按照STN屏的要求配置LCD控制寄存器1-5*/ 

static void my2440fb_config_stn_lcd_regs(
const struct fb_info
* fbinfo, 
struct s3c2410fb_hw * regs)

{ 

    const struct my2440fb_var    * fbvar
= fbinfo- 
> par; 

    const struct fb_var_screeninfo
* var = 
& fbinfo- > var;

    int type = regs-
> lcdcon1 &
~ S3C2410_LCDCON1_TFT;

    int hs = var-
> xres > 
> 2; 

    unsigned wdly 
= ( var-
> left_margin >
> 4) 
- 1; 

    unsigned wlh =
( var- 
> hsync_len > 
> 4) - 1;

    if ( type
! = S3C2410_LCDCON1_STN4)

    { 

        hs > >
= 1; 

    } 

    /*根据色位模式设置LCD控制寄存器1，参考数据手册*/ 

    switch ( var-
> bits_per_pixel)

    { 

        case 1:
/*1BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_STN1BPP; 

            break 
; 

        case 2:
/*2BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_STN2GREY; 

            break 
; 

        case 4:
/*4BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_STN4GREY; 

            break 
; 

        case 8:
/*8BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_STN8BPP; 

            hs * = 3;

            break 
; 

        case 12:
/*12BPP*/ 

            regs- 
> lcdcon1 | 
= S3C2410_LCDCON1_STN12BPP; 

            hs * = 3;

            break 
; 

        default :
/*无效的BPP*/ 

            dev_err( fbvar-
> dev, 
"invalid bpp %d/n" , var-
> bits_per_pixel)
; 

    } 

    

    /*设置LCD配置寄存器2、3、4, 参考数据手册*/ 

    if ( wdly
> 3) wdly 
= 3; 

    if ( wlh
> 3) wlh 
= 3; 

    regs- > lcdcon2
= S3C2410_LCDCON2_LINEVAL( var-
> yres - 1)
; 

    regs- > lcdcon3
=  S3C2410_LCDCON3_WDLY( wdly)
| 

            S3C2410_LCDCON3_LINEBLANK( var-
> right_margin / 8)
| 

            S3C2410_LCDCON3_HOZVAL( hs 
- 1) ;

    regs- > lcdcon4
= S3C2410_LCDCON4_WLH( wlh)
; 

} 

/*配置帧缓冲起始地址寄存器1-3，参考数据手册*/ 

static void my2440fb_set_lcdaddr(
struct fb_info * fbinfo)

{ 

    unsigned long saddr1, saddr2, saddr3;

    struct my2440fb_var * fbvar
= fbinfo- 
> par; 

    void __iomem * regs
= fbvar- 
> lcd_base; 

    saddr1 = fbinfo-
> fix. smem_start
> > 1;

    saddr2 = fbinfo-
> fix. smem_start;

    saddr2 + = fbinfo-
> fix. line_length
* fbinfo- 
> var. yres;

    saddr2 > >
= 1; 

    saddr3 = S3C2410_OFFSIZE( 0)
| S3C2410_PAGEWIDTH(
( fbinfo- 
> fix. line_length 
/ 2) & 0x3ff)
; 

    writel( saddr1, regs
+ S3C2410_LCDSADDR1)
; 

    writel( saddr2, regs
+ S3C2410_LCDSADDR2)
; 

    writel( saddr3, regs
+ S3C2410_LCDSADDR3)
; 

} 

/*显示空白，blank mode有5种模式，定义在fb.h中，是一个枚举*/ 

static int my2440fb_blank(
int blank_mode,
struct fb_info * fbinfo)

{ 

    struct my2440fb_var * fbvar
= fbinfo- 
> par; 

    void __iomem * regs
= fbvar- 
> lcd_base; 

    /*根据显示空白的模式来设置LCD是开启还是停止*/ 

    if ( blank_mode
= = FB_BLANK_POWERDOWN)

    { 

        my2440fb_lcd_enable( fbvar, 0)
; /*在第②步中定义*/

    } 

    else 

    { 

        my2440fb_lcd_enable( fbvar, 1)
; /*在第②步中定义*/

    } 

    /*根据显示空白的模式来控制临时调色板寄存器*/ 

    if ( blank_mode
= = FB_BLANK_UNBLANK)

    { 

        /*临时调色板寄存器无效*/ 

        writel( 0x0, regs
+ S3C2410_TPAL)
; 

    } 

    else 

    { 

        /*临时调色板寄存器有效*/ 

        writel( S3C2410_TPAL_EN, regs
+ S3C2410_TPAL)
; 

    } 

    return 0;

} 

/*设置颜色表*/ 

static int my2440fb_setcolreg(
unsigned regno,
unsigned red,
unsigned green,
unsigned blue,
unsigned transp,
struct fb_info * fbinfo)

{ 

    unsigned int val;

    struct my2440fb_var * fbvar
= fbinfo- 
> par; 

    void __iomem * regs
= fbvar- 
> lcd_base; 

    switch ( fbinfo-
> fix. visual)

    { 

        case FB_VISUAL_TRUECOLOR:

            /* 真彩色*/ 

            if ( regno
< 16) 

            { 

                u32 * pal 
= fbinfo- > pseudo_palette;

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

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

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

                pal[ regno]
= val; 

            } 

            break 
; 

        case FB_VISUAL_PSEUDOCOLOR:

            /*伪彩色*/ 

            if ( regno
< 256) 

            { 

                val = 
( red > > 0)
& 0xf800; 

                val | 
= ( green >
> 5) 
& 0x07e0; 

                val | 
= ( blue >
> 11) 
& 0x001f; 

                writel( val, regs
+ S3C2410_TFTPAL( regno)
) ; 

                /*修改调色板*/ 

                schedule_palette_update( fbvar, regno, val)
; 

            } 

            break 
; 

        default :

            return 1;

    } 

    return 0;

} 

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 void schedule_palette_update(
struct my2440fb_var    * fbvar,
unsigned int regno,
unsigned int val)

{ 

    unsigned long flags;

    unsigned long irqen;

    /*LCD中断挂起寄存器基地址*/ 

    void __iomem * lcd_irq_base
= fbvar- 
> lcd_base + S3C2410_LCDINTBASE;

    /*在修改中断寄存器值之前先屏蔽中断，将中断状态保存到flags中*/ 

    local_irq_save( flags)
; 

    fbvar- > palette_buffer[ regno]
= val; 

    /*判断调色板是否准备就像*/ 

    if ( 
! fbvar- > palette_ready)

    { 

        fbvar- > palette_ready
= 1; 

        /*使能中断屏蔽寄存器*/ 

        irqen = readl( lcd_irq_base
+ S3C24XX_LCDINTMSK)
; 

        irqen & =
~ S3C2410_LCDINT_FRSYNC;

        writel( irqen, lcd_irq_base
+ S3C24XX_LCDINTMSK)
; 

    } 

    /*恢复被屏蔽的中断*/ 

    local_irq_restore( flags)
; 

}