mycdev.c
#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/cdev.h>
#include <linux/uaccess.h>
#include <linux/slab.h>
#include <linux/io.h>
#include "myled.h"
#define CNAME "myled"
struct cdev *cdev;
struct class *cls;
struct device *dev;
dev_t devno;
gpio_t* virt_gpioe = NULL;
gpio_t* virt_gpiof = NULL;
gpio_t* virt_gpioz = NULL;
unsigned int * virt_rcc = NULL;
unsigned int * virt_rcc2 = NULL;
#define LED1_ON (virt_gpioe->ODR |= (0x1 << 10))
#define LED1_OFF (virt_gpioe->ODR &= (~(0x1 << 10)))
#define LED2_ON (virt_gpiof->ODR |= (0x1 << 10))
#define LED2_OFF (virt_gpiof->ODR &= (~(0x1 << 10)))
#define LED3_ON (virt_gpioe->ODR |= (0x1 << 8))
#define LED3_OFF (virt_gpioe->ODR &= (~(0x1 << 8)))
#define LED5_ON (virt_gpioz->ODR |= (0x1 << 5))
#define LED5_OFF (virt_gpioz->ODR &= (~(0x1 << 5)))
#define LED6_ON (virt_gpioz->ODR |= (0x1 << 6))
#define LED6_OFF (virt_gpioz->ODR &= (~(0x1 << 6)))
#define LED7_ON (virt_gpioz->ODR |= (0x1 << 7))
#define LED7_OFF (virt_gpioz->ODR &= (~(0x1 << 7)))
unsigned int minor=0;
#if 0
unsigned int major =0;
#else
unsigned int major=500;
#endif
int myled_open (struct inode *inode, struct file *file)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
ssize_t myled_read (struct file *file, char __user *ubuf, size_t size, loff_t *loff)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
ssize_t myled_write (struct file *file, const char __user *ubuf, size_t size, loff_t *loff)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
int myled_close (struct inode *inode, struct file *file)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
long myled_ioctl(struct file *file,unsigned int cmd,unsigned long args)
{
int whitch;
int ret;
switch(cmd)
{
case LED_ON:
ret = copy_from_user(&whitch,(void*)args,sizeof(int));
if(ret)
{
printk("copy from user is error\n");
return -EIO;
}
switch(whitch)
{
case LED1:
LED1_ON;
break;
case LED2:
LED2_ON;
break;
case LED3:
LED3_ON;
break;
case LED5:
LED5_ON;
break;
case LED6:
LED6_ON;
break;
case LED7:
LED7_ON;
break;
}
break;
case LED_OFF:
ret = copy_from_user(&whitch,(void*)args,sizeof(int));
if(ret)
{
printk("copy from user is error\n");
return -EIO;
}
switch(whitch)
{
case LED1:
LED1_OFF;
break;
case LED2:
LED2_OFF;
break;
case LED3:
LED3_OFF;
break;
case LED5:
LED5_OFF;
break;
case LED6:
LED6_OFF;
break;
case LED7:
LED7_OFF;
break;
}
break;
}
return 0;
}
const struct file_operations fops ={
.unlocked_ioctl = myled_ioctl,
.open = myled_open,
.read = myled_read,
.write = myled_write,
.release = myled_close,
};
//驱动入口函数
static int __init demo_init(void)
{
int ret,i;
//分配对象
cdev = cdev_alloc();
if(cdev == NULL)
{
printk("分配对象错误\n");
ret = -ENOMEM;
goto ERR1;
}
//对象初始化
//设备资源的申请(设备号)
cdev_init(cdev,&fops);
if(major==0)
{
ret=alloc_chrdev_region(&devno,minor,3,"mycdev");
if(ret)
{
printk("动态申请设备号失败\n");
goto ERR2;
}
major=MAJOR(devno);
minor=MINOR(devno);
}
else if(major>0)
{
ret=register_chrdev_region(MKDEV(major,minor),3,"mycdev");
{
if(ret)
{
printk("静态申请设备号失败\n");
goto ERR2;
}
}
}
//注册
ret = cdev_add(cdev,MKDEV(major,minor),3);
if(ret)
{
printk("驱动对象注册进内核失败\n");
goto ERR3;
}
//向上提交目录
cls=class_create(THIS_MODULE,"mycdev");
if(IS_ERR(cls))
{
printk("向上提交目录失败\n");
goto ERR4;
}
//向上提交设备节点信息
for(i=0;i<3;i++)
{
dev=device_create(cls,NULL,MKDEV(major,i),NULL,"mycdev%d",i);
if(IS_ERR(dev))
{
printk("向上失败\n");
goto ERR5;
}
}
//将物理地址映射为虚拟地址
virt_rcc = ioremap(PHY_RCC_LED1,4);
if(virt_rcc == NULL)
{
printk("rcc ioremap is error\n");
return -ENOMEM;
}
virt_rcc2 = ioremap(PHY_RCC_LED2,4);
if(virt_rcc2 == NULL)
{
printk("rcc ioremap is error\n");
return -ENOMEM;
}
//映射GPIOE地址
virt_gpioe = ioremap(PHY_GPIOE_ADDR,sizeof(gpio_t));
if(virt_gpioe== NULL)
{
printk("virt_gpioe ioremap is error\n");
return -ENOMEM;
}
//映射GPIOF地址
virt_gpiof = ioremap(PHY_GPIOF_ADDR,sizeof(gpio_t));
if(virt_gpiof== NULL)
{
printk("virt_gpiof ioremap is error\n");
return -ENOMEM;
}
//映射GPIOZ地址
virt_gpioz = ioremap(PHY_GPIOZ_ADDR,sizeof(gpio_t));
if(virt_gpioz== NULL)
{
printk("virt_gpioz ioremap is error\n");
return -ENOMEM;
}
//对led1---->PE10引脚初始化 对led3---->PE8引脚初始化
*virt_rcc |= (0x1 << 4);//5.1 使能GPIOE组时钟[4]=1
virt_gpioe->MODER &= (~(0x3 << 20));//5.2 设置PE10引脚为输出模式 [21:20] = 01
virt_gpioe->MODER |= (0x1 << 20);
virt_gpioe->ODR &= (~(0x1 << 10)); //5.3 设置PE10引脚输出低电平
//对led2---->PF10引脚初始化
*virt_rcc |= (0x1 << 5);//5.1 使能GPIOF组时钟[5]=1
virt_gpiof->MODER &= (~(0x3 << 20));//5.2 设置PF10引脚为输出模式 [21:20] = 01
virt_gpiof->MODER |= (0x1 << 20);
virt_gpiof->ODR &= (~(0x1 << 10)); //5.3 设置PF10引脚输出低电平
//对led3---->PE8引脚初始化
virt_gpioe->MODER &= (~(0x3 << 16));//5.2 设置PE8引脚为输出模式 [17:16] = 01
virt_gpioe->MODER |= (0x1 << 16);
virt_gpioe->ODR &= (~(0x1 << 8)); //5.3 设置PE8引脚输出低电平
//对led4--->PZ5引脚初始化
*virt_rcc |= (0x1 << 0);// 使能GPIOZ组时钟[0]=1
virt_gpioz->MODER &= (~(0x3 << 10));//设置PZ5引脚为输出模式 [11:10] = 01
virt_gpioz->MODER |= (0x1 << 10);
virt_gpioz->ODR &= (~(0x1 << 5)); //设置PZ5引脚输出低电平
//对led5--->PZ6引脚初始化
virt_gpioz->MODER &= (~(0x3 << 12));//设置PZ6引脚为输出模式 [13:12] = 01
virt_gpioz->MODER |= (0x1 << 12);
virt_gpioz->ODR &= (~(0x1 << 6)); //设置PZ6引脚输出低电平
//对led6--->PZ7引脚初始化
virt_gpioz->MODER &= (~(0x3 << 14));//设置PZ7引脚为输出模式 [15:14] = 01
virt_gpioz->MODER |= (0x1 << 14);
virt_gpioz->ODR &= (~(0x1 << 7)); //设置PZ7引脚输出低电平
return 0; //函数返回值
ERR5:
for(--i;i>=0;i--)
{
device_destroy(cls,MKDEV(major,i));
}
class_destroy(cls);
ERR4:
cdev_del(cdev);
ERR3:
unregister_chrdev_region(MKDEV(major,minor),3);
ERR2:
kfree(cdev);
ERR1:
return ret;
}
//驱动出口函数
static void __exit demo_exit(void)
{
int i = 0;
iounmap(virt_rcc);
iounmap(virt_rcc2);
iounmap(virt_gpioe);
iounmap(virt_gpiof);
iounmap(virt_gpioz);
for(i=0;i<3;i++)
{
device_destroy(cls,MKDEV(major,i));
}
class_destroy(cls);
cdev_del(cdev);
unregister_chrdev_region(MKDEV(major,minor),3);
kfree(cdev);
}
module_init(demo_init);
module_exit(demo_exit);
MODULE_LICENSE("GPL"); //遵循GPL协议
myled.h
#ifndef __MYLED_H__
#define __MYLED_H__
//RCC基地址:0x50000A28
#define PHY_RCC_LED1 0x50000A28
#define PHY_RCC_LED2 0x50000210
typedef struct{
volatile unsigned int MODER;
volatile unsigned int OTYPER;
volatile unsigned int OSPEEDR;
volatile unsigned int PUPDR;
volatile unsigned int IDR;
volatile unsigned int ODR;
}gpio_t;
//GPIOE、GPIOF基地址
#define PHY_GPIOE_ADDR 0x50006000
#define PHY_GPIOF_ADDR 0x50007000
//GPIOZ基地址
#define PHY_GPIOZ_ADDR 0x54004000
#define LED_ON _IOW('a',1,int)
#define LED_OFF _IOW('a',0,int)
enum{
LED1,
LED2,
LED3,
LED5,
LED6,
LED7,
};
#endif
text.c
#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <errno.h>
#include <string.h>
#include <sys/ioctl.h>
#include "myled.h"
int main(int argc,const char * argv[])
{
char buf[128] = {0};
int whitch;
int fd = -1;
fd = open("/dev/mycdev0",O_RDWR);
if(fd == -1)
{
perror("open is error\n");
return -1;
}
while(1)
{
whitch = LED1;
ioctl(fd,LED_ON,&whitch);
sleep(1);
ioctl(fd,LED_OFF,&whitch);
sleep(1);
whitch = LED2;
ioctl(fd,LED_ON,&whitch);
sleep(1);
ioctl(fd,LED_OFF,&whitch);
sleep(1);
whitch = LED3;
ioctl(fd,LED_ON,&whitch);
sleep(1);
ioctl(fd,LED_OFF,&whitch);
sleep(1);
whitch = LED5;
ioctl(fd,LED_ON,&whitch);
sleep(1);
ioctl(fd,LED_OFF,&whitch);
sleep(1);
whitch = LED6;
ioctl(fd,LED_ON,&whitch);
sleep(1);
ioctl(fd,LED_OFF,&whitch);
sleep(1);
whitch = LED7;
ioctl(fd,LED_ON,&whitch);
sleep(1);
ioctl(fd,LED_OFF,&whitch);
sleep(1);
}
close(fd);
return 0;
}
效果如图所示:
![](https://img-blog.csdnimg.cn/img_convert/d4abcccd219109435aedce7ff4046b33.jpeg)
![](https://img-blog.csdnimg.cn/img_convert/9969ea44a4cf234c1718366a61f6896b.jpeg)
![](https://img-blog.csdnimg.cn/img_convert/6b17f4523c31a9f5ec37cf507255eb68.jpeg)