/***************************************************************
* Institue of Automation,Chinese Academy of Sciences
* Beijing Hyesco Embedded System Co.,Ltd.
* www.hyesco.com
* File Name: leddrv.c
* Description: PC14、PC15 Control
* Author: 
***************************************************************/

#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 struct file_operations led_fops=
{
      write	:(void(*))led_write,
};

//定義模塊名
char led_name[]="leddrv";            

//指定主設備號
static int gmajor = 254;

//注冊函數
static int __init leddrv_init_module(void)
{	
	int retv;
      	//注冊模塊
      	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;

}

//注銷函數
static void __exit leddrv_cleanup(void)
{
      	int retv;
      	//注銷模塊
      	retv=unregister_chrdev(gmajor,led_name);
      	if(retv<0)
      	{
        	printk("<1>UnRegister Fail!\n");
        	return;
      	}
      	printk("<1>LEDDRV:GOOD-bye!\n");

}

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;  
       	//設定PC14、PC15口為輸出
       	//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);	       
       
       	//從用戶空間拷貝數據到內核空間
       	if(copy_from_user((char*)&iopdata,buf,len))
        	return -EFAULT;
       
       	//PIO Output Data Register	
       	sys->PIOB_ODSR=iopdata; 
       
       	return len;

}


module_init(leddrv_init_module);
module_exit(leddrv_cleanup);

/*end of leddrv.c*/