?? leddrv.c
字號(hào):
/**************************************************************** leddrv8.c* IO口硬件驅(qū)動(dòng)程序** File Name: leddrv8.c* Description: 開(kāi)關(guān)量輸入測(cè)試 PB0~PB11 12路輸入 開(kāi)關(guān)量輸出測(cè)試 PB12~PB15 4路LED輸出 PB16~PB19 4路繼電器輸出***************************************************************/#include <linux/module.h>#include <linux/config.h>#include <linux/kernel.h>#include <linux/init.h>#include <linux/sched.h>#include <linux/fs.h>#include <linux/mm.h>#include <linux/poll.h>#include <linux/slab.h>#include <linux/ioport.h>#include <asm/uaccess.h>#include <asm/io.h>#include <linux/fcntl.h>#include <asm/arch/hardware.h>static int led_write(struct file *,const char *,int,loff_t *);static int led_read(struct file *,const char *,int,loff_t *);/***************************************************************************** 名稱：led_read(struct file *led_file, const char *buf,int len,loff_t *loff)* 功能：讀函數(shù)* 入口參數(shù)：* 出口參數(shù)：無(wú)* 硬件功能：對(duì)PB0~PB11操作（12路開(kāi)關(guān)量輸入）****************************************************************************/static int led_read(struct file *led_file, const char *buf,int len,loff_t *loff){ //PB0~PB11 12路 int status,nread; AT91PS_SYS sys = (AT91PS_SYS) AT91C_VA_BASE_SYS; sys->PIOB_PER |= 0x00000fff; sys->PIOB_ODR |= 0x00000fff; sys->PIOB_IFER |= 0x0000000fff; sys->PMC_PCER = 0x1 << AT91C_ID_PIOB; //status = (unsigned char)(sys->PIOC_PDSR & 0x0000ffff); status = (unsigned short int)(sys->PIOB_PDSR & 0x00000fff); printk("<1>Stat is :%ld \n",status); //if(nread = copy_to_user((void *)buf,(char*)&status,sizeof(int))) if(nread = copy_to_user((void *)buf,(char*)&status,sizeof(unsigned short int))) { printk("EFAULT \n"); return -EFAULT; } return nread;}/***************************************************************************** 名稱：led_write(struct file *led_file, const char *buf,int len,loff_t *loff)* 功能：寫(xiě)函數(shù)* 入口參數(shù)：* 出口參數(shù)：無(wú)* 硬件功能：對(duì)PB12 PB13 PB14 PB15操作（4個(gè)指示燈） 對(duì)PB16 PB17 PB18 PB19操作（4個(gè)繼電器） 對(duì)PB22 PB23 PB24 PB25 PB26 PB27 PB28 操作（7個(gè)led指示燈）****************************************************************************/static int led_write(struct file *led_file, const char *buf,int len,loff_t *loff){ unsigned int iopdata; AT91PS_SYS sys = (AT91PS_SYS) AT91C_VA_BASE_SYS;//pc口 //==========================================================// //設(shè)定Pb12、PB13口為輸出 //PIO Enable Register sys->PIOB_PER=(unsigned int)(1<<12)|(unsigned int)(1<<13); //PIO Output Enable Register sys->PIOB_OER=(unsigned int)(1<<12)|(unsigned int)(1<<13); //PIO Output Write Register sys->PIOB_OWER=(unsigned int)(1<<12)|(unsigned int)(1<<13); //==========================================================// //設(shè)定Pb14、PB15口為輸出 //PIO Enable Register sys->PIOB_PER=(unsigned int)(1<<14)|(unsigned int)(1<<15); //PIO Output Enable Register sys->PIOB_OER=(unsigned int)(1<<14)|(unsigned int)(1<<15); //PIO Output Write Register sys->PIOB_OWER=(unsigned int)(1<<14)|(unsigned int)(1<<15); //==========================================================// //設(shè)定Pb16、PB17口為輸出 //PIO Enable Register sys->PIOB_PER=(unsigned int)(1<<16)|(unsigned int)(1<<17); //PIO Output Enable Register sys->PIOB_OER=(unsigned int)(1<<16)|(unsigned int)(1<<17); //PIO Output Write Register sys->PIOB_OWER=(unsigned int)(1<<16)|(unsigned int)(1<<17); //==========================================================// //設(shè)定PB18、PB19口為輸出 //PIO Enable Register sys->PIOB_PER=(unsigned int)(1<<18)|(unsigned int)(1<<19); //PIO Output Enable Register sys->PIOB_OER=(unsigned int)(1<<18)|(unsigned int)(1<<19); //PIO Output Write Register sys->PIOB_OWER=(unsigned int)(1<<18)|(unsigned int)(1<<19); //==========================================================// //設(shè)定PB22～PB23口為輸出 //PIO Enable Register sys->PIOB_PER=(unsigned int)(1<<22)|(unsigned int)(1<<23)|(unsigned int)(1<<24)|(unsigned int)(1<<25); //PIO Output Enable Register sys->PIOB_OER=(unsigned int)(1<<22)|(unsigned int)(1<<23)|(unsigned int)(1<<24)|(unsigned int)(1<<25); //PIO Output Write Register sys->PIOB_OWER=(unsigned int)(1<<22)|(unsigned int)(1<<23)|(unsigned int)(1<<24)|(unsigned int)(1<<25); //==========================================================// //設(shè)定PB26～PB28口為輸出 //PIO Enable Register sys->PIOB_PER=(unsigned int)(1<<26)|(unsigned int)(1<<27)|(unsigned int)(1<<28); //PIO Output Enable Register sys->PIOB_OER=(unsigned int)(1<<26)|(unsigned int)(1<<27)|(unsigned int)(1<<28); //PIO Output Write Register sys->PIOB_OWER=(unsigned int)(1<<26)|(unsigned int)(1<<27)|(unsigned int)(1<<28); //==========================================================// //從用戶空間拷貝數(shù)據(jù)到內(nèi)核空間 if(copy_from_user((char*)&iopdata,buf,len)) return -EFAULT; //************************新增加********************************************// //PIO Output Data Register // if((iopdata==((unsigned int)(1<<16)))||(iopdata==((unsigned int)(1<<17)))) sys->PIOB_ODSR=iopdata; // else if((iopdata==((unsigned int)(1<<18)))||(iopdata==((unsigned int)(1<<19)))) // sys->PIOB_ODSR=iopdata; //************************新增加********************************************// return len;}/***************************************************************************** 名稱：file_operations* 功能：定義文件操作* 入口參數(shù)：* 出口參數(shù)：****************************************************************************/static struct file_operations led_fops={ write :(void(*))led_write, read :(void(*))led_read,};//定義模塊名char led_name[]="leddrv2";//指定主設(shè)備號(hào)static int gmajor = 254;//注冊(cè)函數(shù)static int __init leddrv_init_module(void){ int retv; //注冊(cè)模塊 retv=register_chrdev(gmajor,led_name,&led_fops); if(retv<0) { printk("<1>Register Fail!\n"); return retv; } printk("<1>Led device OK!\n"); return 0;}//注銷(xiāo)函數(shù)static void __exit leddrv_cleanup(void){ int retv; //注銷(xiāo)模塊 retv=unregister_chrdev(gmajor,led_name); if(retv<0) { printk("<1>UnRegister Fail!\n"); return; } printk("<1>LEDDRV:GOOD-bye!\n");}module_init(leddrv_init_module);module_exit(leddrv_cleanup);/*end of leddrv.c*/?? 快捷鍵說(shuō)明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號(hào)
Ctrl + =
減小字號(hào)
Ctrl + -