控制三盏灯亮灭
代码:
- //head.h
-
- #ifndef __HEAD_H__
- #define __HEAD_H__
- #define PHY_RCC 0x50000A28
- #define PHY_GPIOE_MODER 0x50006000
- #define PHY_GPIOF_MODER 0x50007000
- #define PHY_GPIOE_ODR 0x50006014
- #define PHY_GPIOF_ODR 0x50007014
-
-
- #endif
- //demo.c
-
- #include<linux/init.h>
- #include<linux/module.h>
- #include<linux/fs.h>
- #include<linux/uaccess.h>
- #include<linux/io.h>
- #include"include/head.h"
- char kbuf[128] = {0};
- int a = 10;
- unsigned int major;
-
- unsigned int *vir_led1_odr;
- unsigned int *vir_led1_moder;
- unsigned int *vir_rcc;
- unsigned int *vir_led2_odr;
- unsigned int *vir_led2_moder;
-
- int mycdev_open(struct inode *inode,struct file *file)
- {
- printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
- return 0;
- }
-
- ssize_t mycdev_write(struct file *file,const char *ubuf,size_t size,loff_t *lof)
- {
- printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
- int ret = copy_from_user(kbuf,ubuf,size);
- if(ret)
- {
- printk("failed\n");
- return -EIO;
- }
- switch(kbuf[0]) //kbuf的第0位为led灯,第2位为led灯的状态
- {
- case '1':
- if(kbuf[2] == '0')
- {
- //关灯
- (*vir_led1_odr) &= (~(0x1 << 10));
- }
- else if(kbuf[2] == '1')
- {
- //开灯
- (*vir_led1_odr) |= (0x1 << 10);
- }
- break;
- case '2':
- if(kbuf[2] == '0')
- {
- //关灯
- (*vir_led2_odr) &= (~(0x1 << 10));
- }
- else if(kbuf[2] == '1')
- {
- //开灯
- (*vir_led2_odr) |= (0x1 << 10);
- }
- break;
- case '3':
- if(kbuf[2] == '0')
- {
- //关灯
- (*vir_led1_odr) &= (~(0x1 << 8));
- }
- else if(kbuf[2] == '1')
- {
- //开灯
- (*vir_led1_odr) |= (0x1 << 8);
- }
- break;
- default:
- break;
- }
-
-
-
- return 0;
- }
-
- ssize_t mycdev_read(struct file *file,char *ubuf,size_t size,loff_t *lof)
- {
- printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
- int ret = copy_to_user(ubuf,kbuf,size);
- if(ret)
- {
- printk("failed\n");
- return -EIO;
- }
- return 0;
- }
-
- int mycdev_close(struct inode *inode,struct file *file)
- {
- printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
- return 0;
- }
-
- struct file_operations fops = {
- .open = mycdev_open,
- .read = mycdev_read,
- .write = mycdev_write,
- .release = mycdev_close,
- };
-
- module_param(a,int,0664);
- static int __init mycdev_init(void)
- {
- printk("a = %d\n",a);
- major = register_chrdev(0,"mychrdev",&fops);
- if(major < 0)
- {
- printk("字符设备驱动注册失败\n");
- return major;
- }
- printk("字符设备驱动注册成功 major = %d\n",major);
- vir_led1_moder = ioremap(PHY_GPIOE_MODER,4);
- if(NULL == vir_led1_moder)
- {
- printk("物理内存地址映射失败\n");
- return -EFAULT;
- }
- vir_led1_odr = ioremap(PHY_GPIOE_ODR,4);
- if(NULL == vir_led1_odr)
- {
- printk("物理内存地址映射失败\n");
- return -EFAULT;
- }
-
- vir_rcc = ioremap(PHY_RCC,4);
- if(NULL == vir_rcc)
- {
- printk("物理内存地址映射失败\n");
- return -EFAULT;
- }
-
- vir_led2_moder = ioremap(PHY_GPIOF_MODER,4);
- if(NULL == vir_led2_moder)
- {
- printk("物理内存地址映射失败\n");
- return -EFAULT;
- }
-
- vir_led2_odr = ioremap(PHY_GPIOF_ODR,4);
- if(NULL == vir_led2_odr)
- {
- printk("物理内存地址映射失败\n");
- return -EFAULT;
- }
- printk("寄存器内存映射成功\n");
- (*vir_rcc) |= (0x1 << 4);
- (*vir_rcc) |= (0x1 << 5);
- (*vir_led1_moder) &= (~(0x3 << 20)); //led1_moder
- (*vir_led1_moder) |= (0x1 << 20);
- (*vir_led1_moder) &= (~(0x3 << 16)); //led3_moder
- (*vir_led1_moder) |= (0x1 << 16);
- (*vir_led1_odr) &= (~(0x1 << 10)); //led1_odr
- (*vir_led1_odr) &= (~(0x1 << 8)); //led3_odr
- (*vir_led2_moder) &= (~(0x3 << 20)); //led2_moder
- (*vir_led2_moder) |= (0x1 << 20);
- (*vir_led2_odr) &= (~(0X1 << 10)); //led2_odr
-
-
- return 0;
- }
-
- static void __exit mycdev_exit(void)
- {
- unregister_chrdev(major,"mychrdev");
-
- }
-
- module_init(mycdev_init);
- module_exit(mycdev_exit);
- MODULE_LICENSE("GPL");
- //test.c
- #include<unistd.h>
- #include<fcntl.h>
- #include<sys/stat.h>
- #include<sys/types.h>
- #include<stdio.h>
- #include<string.h>
-
- int main(int argc, char const *argv[])
- {
- char buf[128] = {0};
- int fd = open("/dev/mychrdev",O_RDWR);
- if(fd < 0)
- {
-
- printf("打开设备文件失败\n");
- return -1;
- }
- printf("打开设备文件成功\n");
- while(1)
- {
- fgets(buf,sizeof(buf),stdin);
- buf[strlen(buf) - 1] = 0;
- write(fd,buf,sizeof(buf));
- }
-
- //read(fd,buf,sizeof(buf));
-
- memset(buf,0,sizeof(buf));
- read(fd,buf,sizeof(buf));
- printf("buf:%s\n",buf);
- close(fd);
- return 0;
- }
实验现象: