Linux 裝置驅動之 ioctl小試牛刀（2）

    ioctl小試牛刀（1）的進階筆記，該底層ioctl處理通過移位的方式可以控制所有的寄存器！～

 

main.c 上層應用測試代碼

#include <stdio.h><br />#include <sys/types.h><br />#include <sys/stat.h><br />#include <fcntl.h><br />#include <unistd.h><br />#include <linux/ioctl.h><br />#include "../ioctl_c.h"<br />GPIO_Data_S io_ctl;<br />void main(void)<br />{<br />int testdev;<br />int i;<br />char buf[10];<br />testdev = open ("/dev/test",O_RDWR);<br />if(testdev == -1)<br />{<br />printf("Cann't open file...../n");<br />exit(0);<br />}<br />printf("buf = 0x%x/n",buf);<br />read(testdev,buf,10);<br />write(testdev,buf,1);<br />while(1)<br />{<br />io_ctl.port=6;<br />io_ctl.bit=5;<br />io_ctl.value=1;<br />io_ctl.v=0;<br />ioctl(testdev,GPIO_IO_SET,&io_ctl);<br />ioctl(testdev,GPIO_IO_WRITE,&io_ctl);<br />ioctl(testdev,GPIO_IO_READ,&io_ctl);<br />io_ctl.port=6;<br /> io_ctl.bit=6;<br /> io_ctl.value=1;<br /> io_ctl.v=1;<br /> ioctl(testdev,GPIO_IO_SET,&io_ctl);<br /> ioctl(testdev,GPIO_IO_WRITE,&io_ctl);<br /> ioctl(testdev,GPIO_IO_READ,&io_ctl);<br />sleep(1);<br />io_ctl.port=6;<br />io_ctl.bit=6;<br />io_ctl.value=1;<br />io_ctl.v=0;<br />ioctl(testdev,GPIO_IO_SET,&io_ctl);<br />ioctl(testdev,GPIO_IO_WRITE,&io_ctl);<br />ioctl(testdev,GPIO_IO_READ,&io_ctl);<br />io_ctl.port=6;<br /> io_ctl.bit=5;<br /> io_ctl.value=1;<br /> io_ctl.v=1;<br /> ioctl(testdev,GPIO_IO_SET,&io_ctl);<br /> ioctl(testdev,GPIO_IO_WRITE,&io_ctl);<br /> ioctl(testdev,GPIO_IO_READ,&io_ctl);<br />sleep(1);<br />}<br />//ioctl(testdev,GPIO_IO_WRITE,sizeof(GPIO_Data_S));<br />//ioctl(testdev,GPIO_IO_READ,sizeof(GPIO_Data_S));<br />printf("%s",buf);<br />//for(i = 0;i<10;i++)<br />//printf("[%d]/n",buf[i]);<br />close(testdev);<br />}<br />/*<br />mknod /dev/test c 253 0<br />*/

 

 

ioctl底層驅動代碼實現

#include <linux/types.h><br />#include <linux/fs.h><br />#include <linux/mm.h><br />#include <linux/errno.h><br />#include <linux/module.h><br />#include <linux/moduleparam.h><br />#include <linux/kernel.h><br />#include <asm/uaccess.h><br />#include <linux/cdev.h><br />#include <linux/ioctl.h><br />#include <linux/slab.h><br />#include <linux/fcntl.h><br />#include <asm/segment.h><br />#include <asm/io.h><br />#include <asm/arch/regs-gpio.h><br />#include "ioctl_c.h"<br />unsigned int test_major=253;<br />unsigned int test_minor=0;<br />struct cdev cdevc;<br />MODULE_LICENSE("Dual BSD/GPL");<br />GPIO_Data_S ioctl;</p><p>static int read_test(struct file *file,char *buf,int count ,loff_t *f_pos)<br />{<br />printk("/n read_test");<br />printk("%d",count);<br />return count;<br />}<br />static int write_test(struct file *file,const char *buf,int count, loff_t *f_pos)<br />{<br />printk("/n write_test");<br />return count;<br />}<br />static void gpio_cfg()<br />{<br />size_t Data;<br />printk("gpio_cfg start!/n");<br />Data = __raw_readl(ioctl.port*0x10+S3C2410_GPACON);<br />Data &= ~(3<<2*ioctl.bit);<br />Data |= (ioctl.value<<2*ioctl.bit);<br />__raw_writel(Data,ioctl.port*0x10+S3C2410_GPACON);<br />}<br />static void gpio_read()<br />{<br />printk("gpio_read start!!/n");<br />size_t Data_con,Data_dat;<br />Data_con = __raw_readl(ioctl.port*0x10+S3C2410_GPACON);<br />Data_dat = __raw_readl(ioctl.port*0x10+S3C2410_GPADAT);<br />printk("%ld/n%ld/n",Data_con,Data_dat);<br />}<br />static void gpio_write()<br />{<br />printk("gpio-write start!!/n");<br />size_t Data;<br />Data = __raw_readl(ioctl.port*0x10+S3C2410_GPADAT);<br />Data &= ~(1<<ioctl.bit);<br />Data |=(ioctl.v<<ioctl.bit);<br />__raw_writel(Data,ioctl.port*0x10+S3C2410_GPADAT);<br />}<br />static int ioctl_test(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)<br />{<br />if(copy_from_user(&ioctl,arg,sizeof(GPIO_Data_S)))<br />{<br />return - EFAULT;<br />}<br />printk("/n ioctl_test");<br />switch(cmd)<br />{<br />case GPIO_IO_SET:gpio_cfg();break;<br />//case GPIO_IO_GET:;break;<br />case GPIO_IO_WRITE:gpio_write();break;<br />case GPIO_IO_READ:gpio_read();break;<br />default:break;<br />}<br />return cmd;<br />}<br />static int open_test(struct inode *inode,struct file *file)<br />{<br />printk("/n open_test");<br />return 0;<br />}<br />static void release_test(struct inode *inode,struct file *file)<br />{<br />printk("/n release_test");<br />}<br />struct file_operations test_fops = {<br />.owner=THIS_MODULE,<br />.read=read_test,<br />.write=write_test,<br />.open=open_test,<br />.ioctl=ioctl_test,<br />.release=release_test,<br />};<br />int simple_c_init_module(void)<br />{<br />int result;<br />dev_t dev = 0;</p><p>dev=MKDEV(test_major,test_minor);<br />result = register_chrdev_region(dev,1,"test");</p><p>printk("major= %d,minor=%d /n",test_major,test_minor);</p><p>if(result < 0)<br />{<br />printk(KERN_INFO "test : can't get major number/n");<br />return result;<br />}</p><p>cdev_init(&cdevc,&test_fops);<br />cdevc.owner= THIS_MODULE;<br />cdevc.ops=&test_fops;<br />result=cdev_add(&cdevc,dev,1);<br />if(result)<br />printk("Error %d adding test",result);<br />return 0;<br />}<br />void simple_c_cleanup_module(void)<br />{<br />dev_t dev=0;<br />dev = MKDEV(test_major,test_minor);<br />cdev_del(&cdevc);<br />unregister_chrdev_region(dev,1);<br />}<br />module_init(simple_c_init_module);<br />module_exit(simple_c_cleanup_module);