驱动开发 自动创建设备节点 终端控制设备状态

驱动代码

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

int major;
char kbuf[128] = { 0 };
struct class* cls;
struct device* dev;
unsigned int* rcc_gpio;
gpio_t* led1_base;
gpio_t* led2_base;
gpio_t* led3_base;
gpio_t* fan_base;
gpio_t* beep_base;
gpio_t* motor_base;

int myled_open(struct inode* inode, struct file* file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    //地址映射
    rcc_gpio = ioremap(PHY_RCC_GPIO, 4);
    if (rcc_gpio == NULL) {
        printk("ioremap rcc error\n");
        return -ENOMEM;
    }
    led1_base = ioremap(PHY_LED1_BASE, sizeof(gpio_t));
    if (led1_base == NULL) {
        printk("ioremap gpioe error\n");
        return -ENOMEM;
    }
    led2_base = ioremap(PHY_LED2_BASE, sizeof(gpio_t));
    if (led2_base == NULL) {
        printk("ioremap gpioe error\n");
        return -ENOMEM;
    }
    led3_base = ioremap(PHY_LED3_BASE, sizeof(gpio_t));
    if (led3_base == NULL) {
        printk("ioremap gpioe error\n");
        return -ENOMEM;
    }
    fan_base = ioremap(PHY_FAN_BASE, sizeof(gpio_t));
    if (fan_base == NULL) {
        printk("ioremap gpioe error\n");
        return -ENOMEM;
    }
    beep_base = ioremap(PHY_BEEP_BASE, sizeof(gpio_t));
    if (beep_base == NULL) {
        printk("ioremap gpioe error\n");
        return -ENOMEM;
    }
    motor_base = ioremap(PHY_MOTOR_BASE, sizeof(gpio_t));
    if (motor_base == NULL) {
        printk("ioremap gpioe error\n");
        return -ENOMEM;
    }


    //寄存器的初始化(读，改，写)
    writel(readl(rcc_gpio) | (3<<4),rcc_gpio); 
    writel(readl(&led1_base->MODER) & (~(3<<20)),&led1_base->MODER);
    writel(readl(&led1_base->MODER) | (1<<20),&led1_base->MODER);
    writel(readl(&led1_base->ODR) & (~(1<<10)),&led1_base->ODR);// LED1灭

    writel(readl(&led2_base->MODER) & (~(3<<20)),&led2_base->MODER);
    writel(readl(&led2_base->MODER) | (1<<20),&led2_base->MODER);
    writel(readl(&led2_base->ODR) & (~(1<<10)),&led2_base->ODR);// LED2灭

    writel(readl(&led3_base->MODER) & (~(3<<16)),&led3_base->MODER);
    writel(readl(&led3_base->MODER) | (1<<16),&led3_base->MODER);
    writel(readl(&led3_base->ODR) & (~(1<<8)),&led3_base->ODR);// LED3灭

    writel(readl(&fan_base->MODER) & (~(3<<18)),&fan_base->MODER);
    writel(readl(&fan_base->MODER) | (1<<18),&fan_base->MODER);
    writel(readl(&fan_base->ODR) & (~(1<<9)),&fan_base->ODR);// FAN灭

    writel(readl(rcc_gpio) | (1<<1),rcc_gpio);
    writel(readl(&beep_base->MODER) & (~(3<<12)),&beep_base->MODER);
    writel(readl(&beep_base->MODER) | (1<<12),&beep_base->MODER);
    writel(readl(&beep_base->ODR) & (~(1<<6)),&beep_base->ODR);// BEEP灭

    writel(readl(&motor_base->MODER) & (~(3<<12)),&motor_base->MODER);
    writel(readl(&motor_base->MODER) | (1<<12),&motor_base->MODER);
    writel(readl(&motor_base->ODR) & (~(1<<6)),&motor_base->ODR);// MOTOR灭

    return 0;
}
ssize_t myled_read(struct file* file,
    char __user* ubuf, size_t size, loff_t* offs)
{
    int ret;
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    if (size > sizeof(kbuf))
        size = sizeof(kbuf);
    ret = copy_to_user(ubuf, kbuf, size);
    if (ret) {
        printk("copy data to user error\n");
        return -EIO;
    }
    return size;
}
ssize_t myled_write(struct file* file,
    const char __user* ubuf, size_t size, loff_t* offs)
{
    int ret;
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    if (size > sizeof(kbuf))
        size = sizeof(kbuf);
    ret = copy_from_user(kbuf, ubuf, size);
    if (ret) {
        printk("copy data form user error\n");
        return -EIO;
    }

    //根据kbuf[0], 控制led1,led2,led3
    switch (kbuf[0])
    {
    case '1':
        if(kbuf[1] == '1')
        (writel(readl(&led1_base->ODR) | ((1<<10)),&led1_base->ODR));
        else
        (writel(readl(&led1_base->ODR) & (~(1<<10)),&led1_base->ODR));
        break;
    case '2':
        if(kbuf[1] == '1')
        (writel(readl(&led2_base->ODR) | ((1<<10)),&led2_base->ODR));
        else
        (writel(readl(&led2_base->ODR) & (~(1<<10)),&led2_base->ODR));
        break;
    case '3':
        if(kbuf[1] == '1')
        (writel(readl(&led3_base->ODR) | ((1<<8)),&led3_base->ODR));
        else
        (writel(readl(&led3_base->ODR) & (~(1<<8)),&led3_base->ODR));
        break;
    case '4':
        if(kbuf[1] == '1')
        (writel(readl(&fan_base->ODR) | (1<<9),&fan_base->ODR));
        else
        (writel(readl(&fan_base->ODR) & (~(1<<9)),&fan_base->ODR));
        break;
    case '5':
        if(kbuf[1] == '1')
        (writel(readl(&beep_base->ODR) | (1<<6),&beep_base->ODR));
        else
        (writel(readl(&beep_base->ODR) & (~(1<<6)),&beep_base->ODR));
        break;
    case '6':
        if(kbuf[1] == '1')
        (writel(readl(&motor_base->ODR) | (1<<6),&motor_base->ODR));
        else
        (writel(readl(&motor_base->ODR) & (~(1<<6)),&motor_base->ODR));
        break;
    
    default:
        break;
    }
   
    return size;
}
int myled_close(struct inode* inode, struct file* file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    iounmap(rcc_gpio);
    iounmap(led1_base);
    iounmap(led2_base);
    iounmap(led3_base);
    iounmap(fan_base);
    iounmap(beep_base);
    iounmap(motor_base);
    return 0;
}
const struct file_operations fops = {
    .open = myled_open,
    .read = myled_read,
    .write = myled_write,
    .release = myled_close,
};
static int __init myled_init(void)
{
    // 1.注册字符设备驱动
    major = register_chrdev(0, CNAME, &fops);
    if (major < 0) {
        printk("register char device driver error\n");
        return major;
    }
    printk("create cdev success major = %d\n", major);
    // 创建设备节点
    cls = class_create(THIS_MODULE, "hello");
    if (IS_ERR(cls)) {
        printk("class create error\n");
        return PTR_ERR(cls);
    }
    dev = device_create(cls, NULL, MKDEV(major, 0), NULL, CNAME);
    if (IS_ERR(dev)) {
        printk("device create error\n");
        return PTR_ERR(dev);
    }
    return 0;
}
static void __exit myled_exit(void)
{
    //销毁设备节点
    device_destroy(cls,MKDEV(major,0));
    class_destroy(cls);
    // 注销字符设备驱动
    unregister_chrdev(major, CNAME);
}
module_init(myled_init);
module_exit(myled_exit);
MODULE_LICENSE("GPL");

测试代码

#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <string.h>
#include <stdlib.h>


char buf[128] = { 0 };
int main(int argc, const char* argv[])
{
    int fd;

    if ((fd = open("/dev/myled", O_RDWR)) == -1)
        printf("open error");

    while(1){
        printf("要控制的硬件:1(LED1) 2(LED2) 3(LED3) 4(风扇) 5(蜂鸣器) 6(马达) 0(退出):\t");
        printf("状态:1(开) 0(关):");
        scanf("%s", buf);
        if(buf[0] == '0')
            break;
        write(fd, buf, sizeof(buf));
        sleep(1);
    }

    close(fd);
    return 0;
}

测试结果