GPIO子系统实现流水点亮熄灭6栈灯

mycdev.c:

#include <linux/init.h>
#include <linux/module.h>
#include <linux/cdev.h>
#include <linux/fs.h>
#include <linux/device.h>
#include <linux/uaccess.h>
#include <linux/slab.h>
#include <linux/of.h>
#include <linux/of_gpio.h>

char kbuf[128]={0};
struct cdev *cdev;
#if 0
unsigned int major=0;
#else
unsigned int major=500;
#endif
unsigned int i,minor=0;//存放次设备号
dev_t devno;//存储设备号
struct class *cls;
struct device *dev;
//分配定时器
struct timer_list timer;
struct device_node *dnode;
struct device_node *dnode1;
int flag=1;
int gpiono1,gpiono2,gpiono3,gpiono4,gpiono5,gpiono6;
//定时器处理函数
void timer_handler(struct timer_list *timer)
{
    if(flag==1)
        gpio_set_value(gpiono1,!gpio_get_value(gpiono1));
    if(flag==2)
        gpio_set_value(gpiono2,!gpio_get_value(gpiono2));
    if(flag==3)
        gpio_set_value(gpiono3,!gpio_get_value(gpiono3));
    if(flag==4)
        gpio_set_value(gpiono4,!gpio_get_value(gpiono4));
    if(flag==5)
        gpio_set_value(gpiono5,!gpio_get_value(gpiono5));
    if(flag==6){
        flag=0;
        gpio_set_value(gpiono6,!gpio_get_value(gpiono6));
    }
    flag++;
    mod_timer(timer,jiffies+HZ);
}
int mycdev_open(struct inode *inode,struct file *file)
{
    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
    return 0;
}
ssize_t mycdev_read(struct file *file,char *ubuf,size_t size,loff_t *loff)
{
    int ret;
    if(size>sizeof(kbuf))
        size=sizeof(kbuf);
    ret=copy_to_user(ubuf,kbuf,size);
    if(ret)
    {
        printk("copy to user filed\n");
        return -EIO;
    }
    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 *loff)
{
    int ret;
    if(size>sizeof(kbuf))
        size=sizeof(kbuf);
    ret=copy_from_user(kbuf,ubuf,size);
    if(ret)
    {
        printk("copy from user filed\n");
        return -EIO;
    }
    printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
    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,
};
static int __init mycdev_init(void)
{
    /*
        1.分配对象
        2.对象初始化
        3.设备资源的申请（设备号）
        4.注册
        5.向上提交目录
        6.向上提交节点信息
    */
    int ret;
    cdev=cdev_alloc();
    if(cdev==NULL){
        printk("cdev alloc error!!!\n");
        ret=-ENOMEM;
        goto ERR1;
    }
    cdev_init(cdev,&fops);//初始化字符设备驱动对象
    if(major==0){
        ret=alloc_chrdev_region(&devno,minor,3,"led");
        if(ret){
            printk("alloc chrdev region error!!!\n");
            goto ERR2;
        }
        major=MAJOR(devno);
        minor=MINOR(devno);
    }
    else if(major>0){
        ret=register_chrdev_region(MKDEV(major,minor),3,"led");
        if(ret){
            printk("register chrdev region error!!!\n");
            goto ERR2;
        }
    }
    //将驱动对象注册进内核
    ret=cdev_add(cdev,MKDEV(major,minor),3);
    if(ret){
        printk("cdev add error!!!\n");
        goto ERR3;
    }
    //向上提交目录
    cls=class_create(THIS_MODULE,"led");
    if(IS_ERR(cls)){
        printk("向上提交目录失败\n");
        ret=PTR_ERR(cls);
        goto ERR4;
    }
    //向上提交节点信息
    for(i=0;i<3;i++){
        dev=device_create(cls,NULL,MKDEV(major,i),NULL,"led%d",i);
        if(IS_ERR(dev)){
            printk("向上提交节点信息失败\n");
            ret=PTR_ERR(dev);
            goto ERR5;
        }
    }
    //解析设备树节点
    dnode=of_find_node_by_name(NULL,"extend-leds");
    if(dnode==NULL)
    {
        printk("解析设备树节点失败\n");
        return -1;
    }
    //解析主板设备树节点
    dnode1=of_find_node_by_name(NULL,"core-leds");
    if(dnode1==NULL)
    {
        printk("解析主板设备树节点失败\n");
        return -1;
    }
    printk("解析设备树节点成功\n");
    //根据设备树节点解析gpio编号
    gpiono1=of_get_named_gpio(dnode,"led1",0);
    if(gpiono1<0)
    {
        printk("解析gpio1编号失败\n");
        return -1;
    }
    gpiono2=of_get_named_gpio(dnode,"led2",0);
    if(gpiono2<0)
    {
        printk("解析gpio2编号失败\n");
        return -1;
    }
    gpiono3=of_get_named_gpio(dnode,"led3",0);
    if(gpiono3<0)
    {
        printk("解析gpio3编号失败\n");
        return -1;
    }
    gpiono4=of_get_named_gpio(dnode1,"led1",0);
    if(gpiono4<0)
    {
        printk("解析主板gpio1编号失败\n");
        return -1;
    }
    gpiono5=of_get_named_gpio(dnode1,"led2",0);
    if(gpiono5<0)
    {
        printk("解析主板gpio2编号失败\n");
        return -1;
    }
    gpiono6=of_get_named_gpio(dnode1,"led3",0);
    if(gpiono6<0)
    {
        printk("解析主板gpio3编号失败\n");
        return -1;
    }
    printk("解析gpio编号成功\n");
    //申请gpio编号
    gpio_request(gpiono1,NULL);
    gpio_request(gpiono2,NULL);
    gpio_request(gpiono3,NULL);
    gpio_request(gpiono4,NULL);
    gpio_request(gpiono5,NULL);
    gpio_request(gpiono6,NULL);
    //设置gpio为输出并且初始化数值为0
    gpio_direction_output(gpiono1,0);
    gpio_direction_output(gpiono2,0);
    gpio_direction_output(gpiono3,0);
    gpio_direction_output(gpiono4,0);
    gpio_direction_output(gpiono5,0);
    gpio_direction_output(gpiono6,0);
    //定时器初始化
    //指定定时阈值
    timer.expires=jiffies+HZ;
    timer_setup(&timer,timer_handler,0);
    add_timer(&timer);
    return 0;
ERR5:
    for(;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 mycdev_exit(void)
{
    gpio_free(gpiono1);
    gpio_free(gpiono2);
    gpio_free(gpiono3);
    gpio_free(gpiono4);
    gpio_free(gpiono5);
    gpio_free(gpiono6);
    del_timer(&timer);
    /*
        1.销毁设备节点
        2.销毁目录
        3.注销驱动对象
        4.释放设备资源（设备号）
    */
   for(i=0;i<3;i++)
        device_destroy(cls,MKDEV(major,i));
   class_destroy(cls);
   unregister_chrdev_region(MKDEV(major,minor),3);
   kfree(cdev);
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

添加设备树节点信息:

 实验现象：