内核设备控制三个文件节点控制三个灯

#include <stdio.h>

#include <sys/types.h>

#include <sys/stat.h>

#include <fcntl.h>

#include <unistd.h>

#include <stdlib.h>

#include <sys/ioctl.h>

#include "myled.h"

#include <string.h>

int main(int argc, char const *argv[])

{

    char buf[128] = {};

    int which,off;

    int fd = open("/dev/my_led0", O_RDWR);

    if (fd < 0)

    {

        printf("打开设备文件失败\n");

        exit(-1);

    }

    printf("打开设备成功\n");

    //在终端输入

    int fd1 = open("/dev/my_led1", O_RDWR);

    if (fd1 < 0)

    {

        printf("打开设备文件失败\n");

        exit(-1);

    }

    printf("打开设备成功\n");

    //在终端输入

    int fd2 = open("/dev/my_led2", O_RDWR);

    if (fd2 < 0)

    {

        printf("打开设备文件失败\n");

        exit(-1);

    }

    printf("打开设备成功\n"); //在终端输入

    //在终端输入

    while (1)

    {

        printf("请输入控制命令 1开灯 0:关灯\n");

        fgets(buf, sizeof(buf), stdin);

        //吃掉换行符

        buf[strlen(buf) - 1] = '\0';

        printf("请输入要操作的灯1-->led1,2-->led2,3-->led3\n");

        scanf("%d", &which);

        getchar();

        if (which == 1)

        {

            ioctl(fd, led_ON, &which);

           

        }

        else if (which == 2)

        {

            ioctl(fd1, led_ON, &which);

           

        }

        else if (which == 3)

        {

            ioctl(fd2, led_ON, &which);

           

        }

         else if (which == 4)

        {

            ioctl(fd2, led_ON, &which);

           

        }

         else if (which == 5)

        {

            ioctl(fd2, led_ON, &which);

           

        }

         else if (which == 6)

        {

            ioctl(fd2, led_ON, &which);

        }

         else if (which == 11)

        {

            ioctl(fd2, led_OFF, &which);

        }

        else if (which == 12)

        {

            ioctl(fd2, led_OFF, &which);

        }

        else if (which == 13)

        {

            ioctl(fd2, led_OFF, &which);

        }

        else if (which == 14)

        {

            ioctl(fd2, led_OFF, &which);

        }

        else if (which == 15)

        {

            ioctl(fd2, led_OFF, &which);

        }

        else if (which == 16)

        {

            ioctl(fd2, led_OFF, &which);

        }

    }

    close(fd);

    close(fd1);

    close(fd2);

    return 0;

}

myled.c文件

#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/cdev.h>
#include <linux/uaccess.h>
#include <linux/device.h>
#include <linux/ioctl.h>
#include<linux/slab.h>
#include "myled.h"
#define CNAME "myled"


int minor=0;//次设备号从0开始
#if 0
unsigned int major = 0;//动态申请
#else
unsigned int major = 500;//静态指定设备号
#endif
char kbuf[128] = {}; //定义数组用于存放和用户之间拷贝的数据
gpio_t *vir_led1;
gpio_t *vir_led2;
gpio_t *vir_led3;
gpio_t *vir_fan1;
gpio_t *vir_sp1;
gpio_t *vir_m1;
unsigned int *vir_rcc_apb1;
unsigned int *vir_rcc_apb2;
unsigned int *vir_rcc;
struct class *cls; //句柄
struct device *dev;

struct cdev *cdev;//分配字符设备对象
const int count=3;//设备节点个数为3
//对应的是open()
int mycdev_open(struct inode *inode, struct file *file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    return 0;
}
// read()
ssize_t mycdev_read(struct file *file, char __user *ubuf, size_t size, loff_t *loff)
{
    // size参数是用户期待读到的字节长度
    int ret;
    if (size > sizeof(kbuf))
        size = sizeof(kbuf);
    ret = copy_to_user(ubuf, kbuf, size);
    if (ret)
    {
        printk("数据从内核向用户拷贝失败\n");
        return -EIO;
    }

    return size;
}
// write()
ssize_t mycdev_write(struct file *file, const char __user *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("数据从内核向用户拷贝失败\n");
        return -EIO;
    }
    /*if(kbuf[0]=='1')//开灯
        vir_led1->ODR |= (1<<10);
    else if(kbuf[0]=='2')
        vir_led2->ODR |= (1 << 10);
    else if(kbuf[0]=='3')
       vir_led3->ODR |= (1 << 8);
    else//关灯
    {
        vir_led1->ODR &= ~(1<<10);
        vir_led2->ODR&= ~(1 << 10);
       vir_led3->ODR &= ~(1 << 8);
    }*/
    return size;
}

// close()
long ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
    // cmd是传输过来的功能模块,arg是传递过来的第三个参数,选择是哪个灯的
    // file对应着文件描述符文件
    int which, ret;
    switch (cmd)
    {
    case led_ON:
    {
        ret = copy_from_user(&which, (void *)arg, sizeof(int)); //获取发送的数据是否成功
        if (ret)
        {
            printk("数据向内核拷贝失败\n");
            return -EIO;
        }
        switch (which)
        {
        case 11:
            vir_led1->ODR |= (1 << 10);
            break;
        case 12:
            vir_led2->ODR |= (1 << 10);
            break;
        case 13:
            vir_led3->ODR |= (1 << 8);
            break;
        case 14:
            vir_m1->ODR |= (1 << 6);
            break;
        case 15:
            vir_fan1->ODR |= (1 << 9);
            break;
        case 16:
            vir_sp1->ODR |= (1 << 6);
            break;
        }
        break;
    }

    case led_OFF:
    {
        ret = copy_from_user(&which, (void *)arg, sizeof(int));
        if (ret)
        {
            printk("用户向内核拷贝数据失败\n");
            return -EIO;
        }
        switch (which)
        {
        case LED1:
            vir_led1->ODR &= ~(1 << 10);
            break;
        case LED2:
            vir_led2->ODR &= ~(1 << 10);
            break;
        case LED3:
            vir_led3->ODR &= ~(1 << 8);
            break;
        case M1:
            vir_m1->ODR &= ~(1 << 6);
            break;
        case FAN1:
            vir_fan1->ODR &= ~(1 << 9);
            break;
        case SP1:
            vir_sp1->ODR &= ~(1 << 6);
            break;
        }
        break;
    }
    default:
        printk("功能码错误\n");
        break;
    }
    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,
        .unlocked_ioctl = ioctl,
        .release = mycdev_close,
};
int all_led_init(void)
{
    //进行物理地址的映射
    vir_led1 = ioremap(PHY_LED1_ADDR, sizeof(gpio_t));
    if (vir_led1 == NULL)
    {
        printk("vir_led1 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_led1 映射成功\n");
    vir_led2 = ioremap(PHY_LED2_ADDR, sizeof(gpio_t));
    if (vir_led2 == NULL)
    {
        printk("vir_led2 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_led2 映射成功\n");
    vir_led3 = ioremap(PHY_LED3_ADDR, sizeof(gpio_t));
    if (vir_led3 == NULL)
    {
        printk("vir_led3 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_led3 映射成功\n");
    vir_rcc = ioremap(PHY_RCC_ADDR, 4);
    if (vir_rcc == NULL)
    {
        printk("vir_rcc 映射失败\n");
        return -ENOMEM;
    }
    //apb1
    vir_rcc_apb1 = ioremap(PHY_RCC_APB1, 4);
    if (vir_rcc_apb1 == NULL)
    {
        printk("vir_rcc_apb1 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_rcc_apb1 映射成功\n");
    //apb2
    vir_rcc_apb2 = ioremap(PHY_RCC_APB2, 4);
    if (vir_rcc_apb2 == NULL)
    {
        printk("vir_rcc_apb2 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_rcc_apb2 映射成功\n");
    //风扇
    vir_fan1 = ioremap(PHY_FAN1_ADDR, sizeof(gpio_t));
    if (vir_fan1 == NULL)
    {
        printk("vir_fan1 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_fan1 映射成功\n");
    // m1
    vir_m1 = ioremap(PHY_M1_ADDR, sizeof(gpio_t));
    if (vir_m1 == NULL)
    {
        printk("vir_m1 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_m1 映射成功\n");
    // sp1
    vir_sp1 = ioremap(PHY_SP1_ADDR, sizeof(gpio_t));
    if (vir_sp1 == NULL)
    {
        printk("vir_sp1 映射失败\n");
        return -ENOMEM;
    }
    printk("vir_sp1 映射成功\n");
    //寄存器的初始化
    // led1
    vir_led1->MODER &= ~(3 << 20);
    vir_led1->MODER |= (1 << 20);
    vir_led1->ODR &= ~(1 << 10);

    // led2
    vir_led2->MODER &= ~(3 << 20);
    vir_led2->MODER |= (1 << 20);
    vir_led2->ODR &= ~(1 << 10);

    // led3
    vir_led3->MODER &= ~(3 << 16);
    vir_led3->MODER |= (1 << 16);
    vir_led3->ODR &= ~(1 << 8);
    // fan1
    vir_fan1->MODER &= ~(3 << 18);
    vir_fan1->MODER |= (1 << 18);
    vir_fan1->ODR &= ~(1 << 9);
    // sp1
    vir_sp1->MODER &= ~(3 << 12);
    vir_sp1->MODER |= (1 << 12);
    vir_sp1->ODR &= ~(1 << 6);
    // m1
    vir_m1->MODER &= ~(3 << 12);
    vir_m1->MODER |= (1 << 12);
    vir_m1->ODR &= ~(1 << 6);
    //使能TIM寄存器
    (*vir_rcc) |= (3 << 4);
    (*vir_rcc_apb1) |= (1 << 2); //使能TIM4
    (*vir_rcc_apb2) |= (1 << 0); //使能TIM1
    (*vir_rcc_apb2) |= (1 << 3); //使能TIM16
    (*vir_rcc) |= (1 << 1);      //使能gpiob
    return 0;
}
//入口函数,当驱动安装的时候执行
static int __init demo_init(void)
{

    //动态注册字符设备驱动
   /*/ major = register_chrdev(0, CNAME, &fops);
    if (major < 0)
    {
        printk("字符设备驱动注册失败\n");
        return major;
    }
    printk("字符设备驱动注册成功major=%d\n", major);*/
    //分配设备对象空间
    int ret,i;
    //分配对象
    dev_t devno;
    cdev=cdev_alloc();
    if(cdev==NULL)
    {
        printk("cdev alloc memory err\n");
        
        ret = -ENOMEM;
        goto ERR1;
    }
    printk("对象分配成功\n");
    //对象的初始化
    cdev_init(cdev,&fops);
    //设备号的申请
 
    if(major==0)//动态申请
    {
        ret=alloc_chrdev_region(&devno,minor,count,"my_led");
        if(ret)
        {
            printk("动态申请设备号失败\n");
            goto ERR2;
        }
        major = MAJOR(devno);
        minor = MINOR(devno);
        printk("动态申请设备号成功\n");
    }
    else
    {
        ret=register_chrdev_region(MKDEV(major,minor),count,"my_led");
        if(ret)
        {
            printk("静态申请设备号失败\n");
            goto ERR2;
        }
          printk("静态申请设备号成功\n");
    }
    //注册字符设备驱动
    ret=cdev_add(cdev,MKDEV(major,minor),count);
    if(ret)
    {
        printk("字符设备驱动注册失败\n");
        goto ERR3;
    }
    printk("注册字符设备驱动成功\n");
   
     //自动创建设备节点
      cls = class_create(THIS_MODULE,"led");
     if(IS_ERR(cls))
     {
        printk("创建逻辑节点目录失败\n");
        ret=PTR_ERR(cls);
        goto ERR4;
     }
      printk("创建逻辑节点目录成功\n");
    //向上提交节点信息
    for(i=0;i<3;i++)
    {
      dev = device_create(cls,NULL,MKDEV(major,i),NULL,"my_led%d",i);
        if(IS_ERR(dev))
         {
          printk("创建逻辑节点失败\n");
          ret = PTR_ERR(dev);
          goto ERR5;
         }
    }
     printk("创建逻辑节点成功\n");
     //寄存器的初始化
    all_led_init();
    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),count);
ERR2:
    kfree(cdev);
ERR1:
    return ret;
}

//出口函数,卸载驱动的时候执行
static void __exit demo_exit(void)
{
    ///1.销毁设备节点
    int i;
    for(i=0;i<count;i++)
    {
         device_destroy(cls,MKDEV(major,i));
    }
     class_destroy(cls);
     //2.注销字符设备驱动
    cdev_del(cdev);
    //3.释放设备号
    unregister_chrdev_region(MKDEV(major,minor),count);
    
    //取消映射
    iounmap(vir_led1);
    iounmap(vir_led2);
    iounmap(vir_led3);
    iounmap(vir_rcc);
    iounmap(vir_m1);
    iounmap(vir_fan1);
    iounmap(vir_sp1);
    iounmap(vir_rcc_apb1);
    iounmap(vir_rcc_apb2);
   
    //4.释放动态申请的空间
    kfree(cdev);
}
module_init(demo_init);
module_exit(demo_exit);
MODULE_LICENSE("GPL");
 

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值