需求:
编写驱动,应用层程序,在应用层通过ioctl控制LED灯流水,当按键KEY1按下,让风扇转动
实现过程:
在源码目录下arch/arm/boot/dts/stm32mp157a-fsmp1a.dts中增加设备结点内容
mygpio{
led1=<&gpioe 10 0>;
led2=<&gpiof 10 0>;
led3=<&gpioe 8 0>;
fan=<&gpioe 9 0>;
};
myirqs{
compatible = "hqyj,irq";
interrupt-parent = <&gpiof>;
interrupts = <9 0>, <7 0>, <8 0>;
};
驱动源文件:
#include "mycdev.h"
irqreturn_t irq1_handler(int irqno,void* arg)
{
gpio_set_value(gpiono4,!gpio_get_value(gpiono4));
return IRQ_HANDLED;
}
long mycdev_ioctl(struct file* file,unsigned int cmd,unsigned long args)
{
int whitch;
int ret;
printk("myled_ioctl in\n");
switch(cmd)
{
case LED_ON:
ret = copy_from_user(&whitch,(void*)args,sizeof(int));
if(ret)
{
printk("copy_from_user failed\n");
return -EIO;
}
printk("cmd in\n");
printk("cmd = %d , whitch = %d\n",cmd,whitch);
switch(whitch)
{
case LED1:
printk("LED1 in\n");
gpiod_set_value(gpiono1,1);
break;
case LED2:
gpio_set_value(gpiono2,1);
break;
case LED3:
gpio_set_value(gpiono3,1);
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:
gpiod_set_value(gpiono1,0);
break;
case LED2:
gpio_set_value(gpiono2,0);
break;
case LED3:
gpio_set_value(gpiono3,0);
break;
}
break;
}
return 0;
}
const struct file_operations fops = {
.unlocked_ioctl = mycdev_ioctl,
};
// 入口函数
static int __init mycdev_init(void)
{
int i,ret;
//解析设备树结点获取gpio节点信息结构体
dnode_pin=of_find_node_by_name(NULL,"mygpio");
if(NULL == dnode_pin)
{
printk("解析设备树myleds结点失败\n");
return -EIO;
}
printk("解析设备树myleds结点成功\n");
//解析结点信息结构体内容获得gpio编号gpiono1~3
gpiono1 = gpiod_get_from_of_node(dnode_pin,"led1",0,GPIOD_OUT_LOW,NULL);
if(IS_ERR(gpiono1))
{
printk("解析gpio编号1失败\n");
return PTR_ERR(gpiono1);
}
printk("解析gpio编号1成功\n");
gpiono2 = of_get_named_gpio(dnode_pin,"led2",0);
if(gpiono2 < 0)
{
printk("解析gpio编号2失败\n");
return -EIO;
}
printk("解析gpio编号2成功\n");
gpiono3 = of_get_named_gpio(dnode_pin,"led3",0);
if(gpiono3 < 0)
{
printk("解析gpio编号3失败\n");
return -EIO;
}
printk("解析gpio编号3成功\n");
gpiono4 = of_get_named_gpio(dnode_pin,"fan",0);
if(gpiono4 < 0)
{
printk("解析gpio编号4失败\n");
return -EIO;
}
printk("解析gpio编号4成功\n");
//向内核申请使用gpio编号并设置为输出模式与默认低电平
// gpio_request(gpiono1,NULL);
// gpio_direction_output(gpiono1,0);
gpio_request(gpiono2,NULL);
gpio_direction_output(gpiono2,0);
gpio_request(gpiono3,NULL);
gpio_direction_output(gpiono3,0);
gpio_request(gpiono4,NULL);
gpio_direction_output(gpiono4,0);
//解析设备树结点获取中断节点信息结构体
dnode_irq=of_find_node_by_name(NULL,"myirqs");
if(NULL == dnode_irq)
{
printk("解析设备树myirqs结点失败\n");
return -EIO;
}
printk("解析设备树myirqs结点成功\n");
for (i = 0; i < 3; i++)
{
irqno[i] = irq_of_parse_and_map(dnode_irq, i);
if (!irqno[i])
{
printk("获取软中断号1失败\n");
return -ENXIO;
}
printk("获取软中断号%d成功\n",i);
request_irq(irqno[i], irq1_handler, IRQF_TRIGGER_FALLING, "myirq", (void*)i);
}
//1.分配对象
cdev = cdev_alloc();
if(NULL == cdev)
{
printk("分配对象空间失败\n");
ret=-ENOMEM;
goto ERR1;
}
printk("分配对象空间成功\n");
//2.初始化驱动对象
cdev_init(cdev,&fops);
if(0 == major)
{
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;
}
}
//3.注册对象
ret = cdev_add(cdev,MKDEV(major,minor),3);
if(ret)
{
printk("驱动对象注册进内核失败\n");
goto ERR3;
}
printk("驱动对象注册进内核成功\n");
cls = class_create(THIS_MODULE,"mycdev");
if(IS_ERR(cls))
{
printk("向上提交目录失败\n");
goto ERR4;
}
printk("向上提交目录成功\n");
dev = device_create(cls,NULL,MKDEV(major,0),NULL,"mycdev0");
if(IS_ERR(dev))
{
printk("向上提交结点信息失败\n");
goto ERR5;
}
printk("向上提交结点信息成功\n");
printk("向上提交设备结点成功\n");
printk("major = %d\n",major);
return 0;
ERR5:
device_destroy(cls,MKDEV(major,0));
class_destroy(cls);
ERR4:
cdev_del(cdev);
ERR3:
unregister_chrdev_region(MKDEV(major,minor),3);
ERR2:
kfree(cdev);
ERR1:
return ret;
return 0;
}
// 出口函数
static void __exit mycdev_exit(void)
{
int i;
device_destroy(cls,MKDEV(major,0));
class_destroy(cls);
cdev_del(cdev);
unregister_chrdev_region(MKDEV(major,minor),3);
kfree(cdev);
for(i=0;i<3;i++)
{
free_irq(irqno[i],NULL);
}
gpio_set_value(gpiono4,0);
gpio_free(gpiono4);
gpio_set_value(gpiono3,0);
gpio_free(gpiono3);
gpio_set_value(gpiono2,0);
gpio_free(gpiono2);
gpiod_set_value(gpiono1,0);
gpiod_put(gpiono1);
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");
驱动头文件:
#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/cdev.h>
#include <linux/slab.h>
#include <linux/device.h>
#include <linux/uaccess.h>
#include <linux/io.h>
#include <linux/poll.h>
#include <linux/of.h>
#include <linux/of_gpio.h>
#include <linux/timer.h>
#include <linux/of_irq.h>
#include <linux/interrupt.h>
#include <linux/delay.h>
struct device_node* dnode_irq;
struct device_node* dnode_pin;
struct gpio_desc* gpiono1;
int gpiono2;
int gpiono3;
int gpiono4;
int irqno[3];
struct cdev* cdev;
dev_t devno;
#if 0
unsigned int major = 0;
#else
unsigned int major = 500;
#endif
unsigned int minor = 0;
struct class* cls;
struct device* dev;
#define LED_ON _IOW('a',1,int)
#define LED_OFF _IOW('a',0,int)
enum{
LED1,
LED2,
LED3,
};
测试文件:
#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <stdlib.h>
#include <sys/ioctl.h>
#define LED_ON _IOW('a',1,int)
#define LED_OFF _IOW('a',0,int)
enum{
LED1,
LED2,
LED3,
};
int main(int argc,const char * argv[])
{
int cmd;
int fd = -1;
fd = open("/dev/mycdev0",O_RDWR);
if(fd == -1)
{
perror("open is error\n");
return -1;
}
int whitch;
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);
}
return 0;
}