Beep Driver-白红宇

Beep Driver

阅读量：6818 次

发布时间：2019-06-26

本文共 5368 字，大约阅读时间需要 17 分钟。

蜂鸣器驱动，基于miscdevice子系统。

beepdrv.c

1 /* beepdrv.c  2    TP-6000's beep driver. GUANGZHOU ZHIYUAN  3   4    Copyright (c) 2006 GUANGZHOU ZHIYUAN ELECTRONICS CO.LTD  5    By Chenxibing 
       
           6 */  7   8 #include 
        
           9 #include 
         
           10 #include 
          
            11 #include 
           
             12 #include 
            
              13 #include 
             
               14 #include 
              
                15 #include 
               
                 16 #include 
                
                  17 #include 
                 
                   18 #include 
                  
                    19 #include 
                   
                     20 #include 
                    
                      21 #include 
                     
                       22 23 #include 
                      
                        24 #include 
                       
                         25 #include 
                        
                          26 #include 
                         
                           27 #include 
                          
                            28 #include 
                           
                             29 30 #include 
                            
                              31 #include 
                             
                               32 33 #include 
                              
                                34 35 #include "beepdrv.h" 36 37 #define DEV_NAME "beep" 38 #define GPIO_IOBASE io_p2v(GPIO_BASE) 39 40 static struct semaphore beep_sem; 41 42 static int tp_beep_open(struct inode *inode, struct file *filp) 43 { 44 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07 45 46 try_module_get(THIS_MODULE); 47 printk( KERN_INFO DEV_NAME " opened!\n"); 48 return 0; 49 } 50 51 static int tp_beep_release(struct inode *inode, struct file *filp) 52 { 53 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07 54 55 module_put(THIS_MODULE); 56 printk(KERN_INFO DEV_NAME " released!\n"); 57 return 0; 58 } 59 60 static ssize_t tp_beep_write(struct file *filp, const char __user *buff, size_t count, loff_t *ppos) 61 { 62 int i; 63 unsigned char ctrl=0; 64 65 if (count > 1) { 66 return -EFBIG; 67 } 68 69 if (down_interruptible(&beep_sem)) 70 return -ERESTARTSYS; 71 72 get_user(ctrl, (u8 *)buff); 73 // printk("write date ctrl=0x%0x\n", ctrl); 74 75 76 i = (ctrl-0x30)&0x03; 77 if(i==0) { 78 __raw_writel(_BIT(7), GPIO_P3_OUTP_CLR(GPIO_IOBASE));//CLR GPIO_07 79 80 } else { 81 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07 82 83 } 84 85 up(&beep_sem); 86 return count; 87 } 88 89 static int tp_beep_ioctl(struct inode *inode, struct file *filp, 90 unsigned int cmd, unsigned long arg) 91 { 92 int level; 93 94 if (_IOC_TYPE(cmd) != BEEP_IOC_MAGIC) { 95 return -ENOTTY; 96 } 97 98 if (_IOC_NR(cmd) >= BEEP_IOC_MAXNR) { 99 return -ENOTTY;100 }101 102 // printk("arg=0x%x\n", arg);103 104 105 106 switch (cmd) {107 case SET_BEEP_ON:108 //printk("BEEP_ON\n");109 110 __raw_writel(_BIT(7), GPIO_P3_OUTP_CLR(GPIO_IOBASE));//CLR GPIO_07111 112 udelay(10);113 break;114 115 case SET_BEEP_OFF:116 //printk("BEEP_OFF\n");117 118 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07119 120 udelay(10);121 break;122 123 default:124 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07125 126 break;127 }128 129 return 0;130 }131 132 static struct file_operations tp_beep_fops = {133 .owner = THIS_MODULE,134 .write = tp_beep_write,135 .ioctl = tp_beep_ioctl,136 .open = tp_beep_open,137 .release = tp_beep_release,138 };139 140 static struct miscdevice tp_beep_miscdev =141 {142 .minor = MISC_DYNAMIC_MINOR,143 .name = DEV_NAME,144 .fops = &tp_beep_fops,145 };146 147 148 static int tp_beep_probe(struct device *dev)149 {150 int ret;151 152 printk(KERN_INFO DEV_NAME " probing...\n");153 ret = misc_register(&tp_beep_miscdev);154 if (ret)155 printk(KERN_ERR "Failed to register miscdev.\n");156 157 return ret;158 }159 160 static int tp_beep_remove(struct device *dev)161 {162 misc_deregister(&tp_beep_miscdev);163 printk(KERN_INFO DEV_NAME " removed!\n");164 165 return 0;166 }167 168 struct platform_device *tp_beep_device;169 static struct device_driver tp_beep_driver = {170 .name = DEV_NAME,171 .owner = THIS_MODULE,172 .bus = &platform_bus_type,173 .probe = tp_beep_probe,174 .remove = tp_beep_remove,175 };176 177 static int __init tp_beep_init(void)178 {179 int rc = 0;180 int i;181 182 printk(KERN_INFO DEV_NAME " init...\n");183 184 for(i=0; i<4; i++) {185 // s3c2410_beep_cfgpin(BEEP01[i], BEEP01_OUTP[i]);186 187 // s3c2410_beep_pullup(BEEP01[i], 0); //enable pullup188 189 // s3c2410_beep_setpin(BEEP01[i], 1); //default all HIGH190 191 }192 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07193 194 195 tp_beep_device = platform_device_register_simple(DEV_NAME, -1, NULL, 0);196 if(IS_ERR(tp_beep_device)) {197 goto out;198 }199 200 rc = driver_register(&tp_beep_driver);201 if (rc < 0) {202 platform_device_unregister(tp_beep_device);203 }204 205 sema_init(&beep_sem, 1);206 out:207 return rc; 208 }209 210 static void __exit tp_beep_exit(void)211 {212 __raw_writel(_BIT(7), GPIO_P3_OUTP_SET(GPIO_IOBASE));//SET GPIO_07213 214 printk(KERN_INFO DEV_NAME " init...\n");215 driver_unregister(&tp_beep_driver);216 platform_device_unregister(tp_beep_device);217 printk(KERN_INFO "tp_beep exit!\n");218 }219 220 module_init(tp_beep_init);221 module_exit(tp_beep_exit);222 223 MODULE_AUTHOR("Abing 
                               
                                ");224 MODULE_DESCRIPTION("ZHIYUAN tp-beep Driver");225 MODULE_LICENSE("GPL");

beepdrv.h

#ifndef __BEEPDRV_H #define __BEEPDRV_H #include <linux/ioctl.h> #define BEEP_IOC_MAGIC 'b' #define SET_BEEP_ON _IO(BEEP_IOC_MAGIC, 0) #define SET_BEEP_OFF _IO(BEEP_IOC_MAGIC, 1) #define BEEP_IOC_MAXNR 2 #endif //__BEEPDRV_H