驱动作业2023.6.20

通过GPIO子系统编写LED驱动，应用程序控制LED灯亮灭 发布CSDN

设备树修改

/dts-v1/;
#include "stm32mp157.dtsi"
#include "stm32mp15xa.dtsi"
#include "stm32mp15-pinctrl.dtsi"
#include "stm32mp15xxac-pinctrl.dtsi"
#include "stm32mp15xx-fsmp1x.dtsi" 
/ {
	model = "HQYJ STM32MP157 FSMP1A Discovery Board";
	compatible = "st,stm32mp157a-dk1", "st,stm32mp157";

	aliases {
		serial0 = &uart4;
		serial5 = &usart3;
	};

	chosen {
		stdout-path = "serial0:115200n8";
	};

	reserved-memory {
			gpu_reserved: gpu@d4000000 {
				  reg = <0xd4000000 0x4000000>;
				  no-map;
			  };
		
			optee_memory: optee@0xde000000 {
				  reg = <0xde000000 0x02000000>;
				  no-map;
			  };
	};
/*
	mynode@0x12345678{
		compatible = "hqyj,mynode";
		astring="hello 21091";
		uint =<0xaabbccdd 0x11223344>;
		binarry=[00 0c 29 7b f9 be];
		mixed ="hello",[11 22],<0x12345678>;
	};
*/
	myleds{
    led1=<&gpioe 10 0>;
    led2=<&gpiof 10 0>;
    led3=<&gpioe 8 0>;
	};

};

驱动代码

#include <linux/init.h>
#include <linux/module.h>
#include <linux/of_gpio.h>
#include <linux/gpio.h>
#include <linux/timer.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/device.h>
#include <linux/cdev.h>
#include <linux/slab.h>
int gpiono[3];
int major;
// struct gpio_desc *gpiono;
struct device_node *dnode;
unsigned int minor;
dev_t devno;
struct class *cls;
struct device *dev;
struct cdev *cdev;
#define LED_ON _IO('l', 1)
#define LED_OFF _IO('l', 0)
int led_init(void);
int mycdev_open(struct inode *inode, struct file *file)
{
    return 0;
}
int mycdev_close(struct inode *inode, struct file *file)
{
    return 0;
}
long mycdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
   int which;
    int ret=copy_from_user(&which,(void *)arg,4);
    if(ret)
    {
        printk("copy_from_user filed\n");
        return ret;
    }
    switch(cmd)
    {
        case LED_ON://开灯
            switch(which)
            {
                case 1:
                     gpio_set_value(gpiono[0], 1);
                    break;
                case 2:
                    gpio_set_value(gpiono[1], 1);
                    break;
                case 3:
                    gpio_set_value(gpiono[2], 1);
                    break;       
            }
            
            break;
        case LED_OFF://关灯
            switch(which)
            {
                case 1:
                     gpio_set_value(gpiono[0], 0);
                     break;
                case 2:
                     gpio_set_value(gpiono[1], 0);
                     break;
                case 3:
                     gpio_set_value(gpiono[2], 0);
                     break;
                              
            }
           
            break;
    }
    return 0;
}
struct file_operations fops = {

    .open = mycdev_open,
    .unlocked_ioctl = mycdev_ioctl,
    .release = mycdev_close,
};

static int __init mycdev_init(void)
{
    int ret, i;
    cdev = cdev_alloc();
    if (cdev == NULL)
    {
        printk("分配字符设备驱动对象失败\n");
        ret = -EFAULT;
        goto OUT1;
    }
    printk("分配对象空间成功\n");
    cdev_init(cdev, &fops);
    if (major > 0) // 静态指定设备号
    {
        ret = register_chrdev_region(MKDEV(major, minor), 3, "myled");
        if (ret)
        {
            printk("静态指定设备号失败\n");
            goto OUT2;
        }
    }
    else if (major == 0) // 动态申请设备号
    {
        ret = alloc_chrdev_region(&devno, minor, 3, "myled");
        if (ret)
        {
            printk("动态申请设备号失败\n");
            goto OUT2;
        }
        // 获取主设备号和次设备号
        major = MAJOR(devno);
        minor = MINOR(devno);
    }
    printk("申请设备号成功\n");
    ret = cdev_add(cdev, MKDEV(major, minor), 3);
    if (ret)
    {
        printk("注册字符设备驱动对象失败\n");
        goto OUT3;
    }
    cls = class_create(THIS_MODULE, "myled");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        ret = -PTR_ERR(cls);
        goto OUT4;
    }
    printk("向上提交目录成功\n");
    for (i = 0; i < 3; i++)
    {
        dev = device_create(cls, NULL, MKDEV(major, i), NULL, "myled%d", i);
        if (IS_ERR(dev))
        {
            ret = -PTR_ERR(dev);
            goto OUT5;
        }
    }
    printk("向上提交设备节点成功\n");
    led_init();
    return 0;
OUT5:
    for (--i; i >= 0; i--)
    {
        device_destroy(cls, MKDEV(major, i));
    }
    // 释放目录空间
    class_destroy(cls);
OUT4:
    cdev_del(cdev);
OUT3:
    unregister_chrdev_region(MKDEV(major, minor), 3);
OUT2:
    kfree(cdev);
OUT1:
    return ret;
}
static void __exit mycdev_exit(void)
{
    int i;
    for (i = 0; i < 3; i++)
    {
        gpio_set_value(gpiono[i], 0);
        gpio_free(gpiono[i]);
    }
    for (i = 0; i < 3; i++)
    {
        device_destroy(cls, MKDEV(major, i));
    }
    // 销毁目录空间
    class_destroy(cls);
    // 注销字符设备驱动
    unregister_chrdev(major, "mychrdev");
}
int led_init(void)
{
    int i;
    char *buf[3]={"led1","led2","led3"};
    for ( i = 0; i < 3; i++)
    {
        dnode= of_find_node_by_name(NULL, "myleds");
        if (dnode == NULL)
        {
            printk("解析设备树节点失败\n");
            return -ENOMEM;
        }

        gpiono[i] = of_get_named_gpio(dnode, buf[i], 0);
        if (gpiono[i] < 0)
        {
            printk("解析设备号失败\n");
            return -EIO;
        }
        int ret = gpio_request(gpiono[i], NULL);
        // gpiono=gpiod_get_from_of_node(dnode,"led1",0,GPIOD_OUT_LOW,NULL);
        // if (IS_ERR(gpiono))
        // {
        //     printk("GPIO编号申请失败\n");
        //     return -EIO;
        // }
        printk("GPIO编号申请成功\n");
        gpio_direction_output(gpiono[i], 0);
    }

    return 0;
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

应用代码

#include <stdlib.h>
#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <string.h>
#include <sys/ioctl.h>
#define LED_ON _IO('l', 1)
#define LED_OFF _IO('l', 0)
int main(int argc, char const *argv[])
{
    char buf[128] = "";
    int a;
    int b;
    int fd = open("/dev/myled1", O_RDWR);
    while (1)
    {
        printf("请输入:1(开灯) 0(关灯)>");
        scanf("%d", &a);
        printf("请输入控制的灯:1(LED1) 2(LED2) 3(LED3)>");
        scanf("%d", &b);
        switch (a)
        {
        case 1:
            ioctl(fd, LED_ON, &b); // 开灯
            break;
        case 0:
            ioctl(fd, LED_OFF, &b); // 关灯
            break;
        default:
            break;
        }
    }
close(fd);

return 0;
}