ioctl_beep.zip_linux beep_linux beep modprobe

#include <linux/kernel.h>//printk #include <linux/module.h>//MODULE_LICENSE #include <linux/fs.h> //MKDEV register_chrdev_region unregister_chrdev_region #include <linux/cdev.h>// cdev_init cdev_add cdev_del #include <asm/uaccess.h> #include <asm/io.h> #include <linux/device.h> #include "head.h" MODULE_LICENSE("GPL"); #define CHRDEV_MAROR 300 #define CHRDEV_MINOR 0 #define NUM_OF_DEVICE 1 #define GPD0CON 0X114000A0 #define TCFG0 0X139D0000 dev_t devno; struct cdev cdev; char data[128] ; volatile unsigned int *gpd0con; volatile unsigned int *tcfg0; volatile unsigned int *tcfg1; volatile unsigned int *tcon; volatile unsigned int *tcntb0; volatile unsigned int *tcmpb0; struct class *cls; static int fs4412_beep_open (struct inode *inode, struct file *file) { printk("fs4412_beep_open \n"); return 0; } static ssize_t fs4412_beep_read (struct file *file, char __user *buf, size_t size, loff_t *loff) { int ret; if(size > 128) size = 128; if(size < 0) return -ENOMEM; ret = copy_to_user(buf,data,size); if(0 != ret) { printk("copy_to_user fail \n"); return -EAGAIN; } printk("fs4412_beep_read \n"); return 0; } static int fs4412_beep_release (struct inode *inode, struct file *file) { printk("fs4412_beep_release \n"); return 0; } static ssize_t fs4412_beep_write (struct file *file, const char __user *buf, size_t size, loff_t *loff) { int ret; if(size > 128) size = 128; if(size < 0) return -ENOMEM; ret = copy_from_user(data,buf,size); if(0 != ret) { printk("copy_to_user fail \n"); return -EAGAIN; } printk("data1 = %s\n",data); printk("fs4412_beep_write \n"); return 0; } static long fs4412_beep_ioctl (struct file *file, unsigned int cmd, unsigned long arg) { switch(cmd) { case BEEP_ON: *tcon = (*tcon &~(0xf <<0))|(0x9 <<0); break; case BEEP_OFF: *tcon = (*tcon &~(0xf <<0))&~(0x9 <<0); break; } return 0; } struct file_operations fs4412_beep_fops = { .owner = THIS_MODULE, .open = fs4412_beep_open, .read = fs4412_beep_read, .write = fs4412_beep_write, .unlocked_ioctl = fs4412_beep_ioctl, .release = fs4412_beep_release, }; /*function:入口函数 * param: void * return: int * */ int chrdev_init(void) { int ret; //1.申请设备号 devno = MKDEV(CHRDEV_MAROR,CHRDEV_MINOR); //2.注册设备号 ret = register_chrdev_region(devno,NUM_OF_DEVICE,"duang"); if(0 != ret) { printk("register_chrdev_region fail \n"); return -EBUSY; } //3.初始化cdev //4.将cdev结构体添加到系统中 cdev_add(&cdev,devno,NUM_OF_DEVICE); cdev_init(&cdev,&fs4412_beep_fops); gpd0con = ioremap(GPD0CON,0x4); if(NULL == gpd0con) { printk("ioremap fail \n"); goto err1; } tcfg0 = ioremap(TCFG0,0x10); if(NULL == tcfg0) { printk("ioremap tcfg0 \n"); goto err2; } tcfg1 = tcfg0 +1; tcon = tcfg0 +2; tcntb0 = tcfg0 +3; tcmpb0 = tcfg0 +4; *gpd0con = (*gpd0con &~(0xf <<0))|(0x2 <<0); *tcfg0 = (*tcfg0 &~(0xff <<0))|(0xff <<0); *tcfg1 = (*tcfg1 &~(0xf <<0))|(0x2 <<0); *tcntb0 = *tcntb0 |500; *tcmpb0 = *tcmpb0 |250; *tcon = (*tcon &~(0xf <<0))|(0x2 <<0); *tcon = (*tcon &~(0xf <<0))&~(0x9 <<0); cls = class_create(THIS_MODULE,"beep"); device_create(cls,NULL,devno,NULL,"pwm"); printk("chrdev_init \n"); return 0; err2: iounmap(gpd0con); err1: cdev_del(&cdev); unregister_chrdev_region(devno,NUM_OF_DEVICE); return ret; } /*function: 出口函数 * param:void * return:int * */ void chrdev_exit(void) { device_destroy(cls,devno); class_destroy(cls); iounmap(gpd0con); iounmap(tcfg0); cdev_del(&cdev); unregister_chrdev_region(devno,NUM_OF_DEVICE); printk("chrdev_exit \n"); } module_init(chrdev_init); module_exit(chrdev_exit );