ioctl控制LED、蜂鸣器、风扇、马达

LED

head.h

#ifndef __HEAD_H__
#define __HEAD_H__ 

typedef struct{
    unsigned int MODER;
    unsigned int OTYPER;
    unsigned int OSPEEDR;
    unsigned int PUPDR;
    unsigned int IDR;
    unsigned int ODR;
}gpio_t;

#define PHY_LED1_ADDR 0X50006000
#define PHY_LED2_ADDR 0X50007000
#define PHY_LED3_ADDR 0X50006000
#define PHY_RCC_ADDR  0X50000A28

//功能码
#define LED_ON _IOW('l', 1, int)
#define LED_OFF _IOW('l', 0, int)

#endif

test.h

#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include "head.h"

int main(int argc, char const *argv[])
{
    int a, b;

    int fd = open("/dev/myled0", O_RDWR);
    if (fd < 0)
    {
        printf("打开设备文件失败\n");
        exit(-1);
    }
    while (1)
    {
        printf("请输入指令\n");
        printf("0(关灯) 1(开灯)\n");

        printf("请输入:");
        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;
        }
    }

    close(fd);

    return 0;
}

myled.h

#include 
#include 
#include 
#include 
#include 
#include "head.h"

unsigned int major; // 定义一个变量保存主设备号
char kbuf[128] = {0};

gpio_t *vir_led1;
gpio_t *vir_led2;
gpio_t *vir_led3;

unsigned int *vir_rcc;

struct class *cls;
struct device *dev;

// 封装操作方法
int mycdev_open(struct inode *inode, struct file *file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    return 0;
}

long mycdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
    switch (cmd)
    {
    case LED_ON:
        switch (arg)
        {
        case 1:                           // LED1
            vir_led1->ODR |= (0x1 << 10); // LED1开灯
            break;
        case 2:                           // LED2
            vir_led2->ODR |= (0x1 << 10); // LED2开灯
            break;
        case 3:                          // LED3
            vir_led3->ODR |= (0x1 << 8); // LED3开灯
            break;
        }

        break;
    case LED_OFF:
        switch (arg)
        {
        case 1:
            vir_led1->ODR &= (~(0x1 << 10));
            break;
        case 2:
            vir_led2->ODR &= (~(0x1 << 10));
            break;
        case 3:
            vir_led3->ODR &= (~(0x1 << 8));
            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,
    .unlocked_ioctl = mycdev_ioctl,
    .release = mycdev_close,
};

int all_led_init(void)
{
    //寄存器地址的映射
    vir_led1 = ioremap(PHY_LED1_ADDR, sizeof(gpio_t));
    if (vir_led1 == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_led2 = ioremap(PHY_LED2_ADDR, sizeof(gpio_t));
    if (vir_led2 == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_led3 = vir_led1;
    vir_rcc = ioremap(PHY_RCC_ADDR, 4);
    if (vir_rcc == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    printk("物理地址映射成功\n");
    //寄存器的初始化
    // rcc
    (*vir_rcc) |= (3 << 4);
    // 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_led1->MODER |= (1 << 16);
    vir_led1->ODR &= (~(1 << 8));
    printk("寄存器初始化成功\n");

    return 0;
}

static int __init mycdev_init(void)
{
    int i;
    // 字符设备驱动注册
    major = register_chrdev(0, "mychrdev", &fops);
    if (major < 0)
    {
        printk("字符设备驱动注册失败\n");
        return major;
    }
    printk("字符设备驱动注册成功:major=%d\n", major);

    //向上提交目录
    cls = class_create(THIS_MODULE, "myled");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        return -PTR_ERR(cls);
    }
    printk("向上提交目录成功\n");

    //向上提交设备节点信息
    for (i = 0; i < 3; i++)
    {
        dev = device_create(cls, NULL, MKDEV(major, i), NULL, "myled%d", i);
        if (IS_ERR(dev))
        {
            printk("向上提交设备节点信息失败\n");
            return -PTR_ERR(dev);
        }
    }
    printk("向上提交设备节点成功\n");

    // 寄存器映射以及初始化
    all_led_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_led1);
    iounmap(vir_led2);
    iounmap(vir_rcc);

    //销毁节点信息
    int i;
    for (i = 0; i < 3; i++)
    {
        device_destroy(cls, MKDEV(major, i));
    }

    //销毁目录信息
    class_destroy(cls);

    // 注销字符设备驱动
    unregister_chrdev(major, "mychrdev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

蜂鸣器

head.h

#ifndef __HEAD_H__
#define __HEAD_H__ 

#include "stm32mp1xx_rcc.h"
#include "stm32mp1xx_gpio.h"
#include "stm32mp1xx_tim.h"

#define PHY_BUZZER_RCC 0X50000000
#define PHY_BUZZER_GPIOB 0x50003000
#define PHY_BUZZER_TIM4  0x40002000


//功能码
#define BUZZER_ON _IOW('l', 1, int)
#define BUZZER_OFF _IOW('l', 0, int)

#endif

test.h

#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include "head.h"

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

    int fd = open("/dev/mybuzzer0", O_RDWR);
    if (fd < 0)
    {
        printf("打开设备文件失败\n");
        exit(-1);
    }
    
    while (1)
    {
        printf("请输入指令\n");
        printf("0(关闭蜂鸣器) 1(打开蜂鸣器)\n");

        printf("请输入:");
        scanf("%d", &a);

        switch (a)
        {
        case 1:
            ioctl(fd, BUZZER_ON); //开
            break;
        case 0:
            ioctl(fd, BUZZER_OFF); //关
            break;
        }
    }

    close(fd);

    return 0;
}

mybuzzer.h

#include 
#include 
#include 
#include 
#include 
#include "head.h"

unsigned int major; // 定义一个变量保存主设备号

gpio_t *vir_buzzer;
tim2_3_4_5_t *vir_tim4;

rcc_t *vir_rcc;

struct class *cls;
struct device *dev;

// 封装操作方法
int mycdev_open(struct inode *inode, struct file *file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    return 0;
}

long mycdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
    switch (cmd)
    {
    case BUZZER_ON:
        //打开蜂鸣器
        vir_tim4->CCR1 = 300;
        break;
    case BUZZER_OFF:
        //关闭蜂鸣器
        vir_tim4->CCR1 = 0;
        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,
    .unlocked_ioctl = mycdev_ioctl,
    .release = mycdev_close,
};

int buzzer_init(void)
{
    //寄存器地址的映射
    vir_rcc = ioremap(PHY_BUZZER_RCC, sizeof(rcc_t));
    if (vir_rcc == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    vir_buzzer = ioremap(PHY_BUZZER_GPIOB, sizeof(gpio_t));
    if (vir_buzzer == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_tim4 = ioremap(PHY_BUZZER_TIM4, sizeof(tim2_3_4_5_t));
    if (vir_tim4 == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    printk("物理地址映射成功\n");
    //寄存器的初始化
    // RCC
    vir_rcc->MP_APB1ENSETR |= (0x1 << 2);
    vir_rcc->MP_AHB4ENSETR |= (0x1 << 1);

    // GPIOB
    vir_buzzer->MODER &= (~(0x3 << 12));
    vir_buzzer->MODER |= (0x1 << 13);

    vir_buzzer->AFRL &= (~(0xf << 24));
    vir_buzzer->AFRL |= (0x1 << 25);

    // TIM4
    vir_tim4->PSC = 208;
    vir_tim4->ARR = 1000;
    vir_tim4->CCR1 = 300;

    vir_tim4->CCMR1 &= (~(0X1 << 16));
    vir_tim4->CCMR1 &= (~(0x3 << 5));
    vir_tim4->CCMR1 |= (0x3 << 5);
    vir_tim4->CCMR1 |= (0x1 << 3);
    vir_tim4->CCMR1 &= (~(0x3 << 0));

    vir_tim4->CCER |= (0x1 << 3);
    vir_tim4->CCER &= (~(0x1 << 1));
    vir_tim4->CCER |= (0x1 << 0);

    vir_tim4->CR1 |= (0x1 << 7);
    vir_tim4->CR1 &= (~(0x3 << 5));
    vir_tim4->CR1 |= (0x1 << 4);
    vir_tim4->CR1 |= (0x1 << 0);

    printk("寄存器初始化成功\n");

    return 0;
}

static int __init mycdev_init(void)
{
    // 字符设备驱动注册
    major = register_chrdev(0, "mychrdev", &fops);
    if (major < 0)
    {
        printk("字符设备驱动注册失败\n");
        return major;
    }
    printk("字符设备驱动注册成功:major=%d\n", major);

    //向上提交目录
    cls = class_create(THIS_MODULE, "mybuzzer");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        return -PTR_ERR(cls);
    }
    printk("向上提交目录成功\n");

    dev = device_create(cls, NULL, MKDEV(major, 0), NULL, "mybuzzer0");
    if (IS_ERR(dev))
    {
        printk("向上提交设备节点信息失败\n");
        return -PTR_ERR(dev);
    }

    printk("向上提交设备节点成功\n");

    // 寄存器映射以及初始化
    buzzer_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_buzzer);
    iounmap(vir_rcc);
    iounmap(vir_tim4);

    //销毁节点信息

    device_destroy(cls, MKDEV(major, 0));

    //销毁目录信息
    class_destroy(cls);

    // 注销字符设备驱动
    unregister_chrdev(major, "mychrdev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

风扇

head.h

#ifndef __HEAD_H__
#define __HEAD_H__ 

#include "stm32mp1xx_rcc.h"
#include "stm32mp1xx_gpio.h"
#include "stm32mp1xx_tim.h"

#define PHY_FAN_RCC 0X50000000
#define PHY_FAN_GPIOE 0x50006000
#define PHY_FAN_TIM1  0x44000000

//功能码
#define FAN_ON _IOW('l', 1, int)
#define FAN_OFF _IOW('l', 0, int)

#endif

test.h

#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include "head.h"

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

    int fd = open("/dev/myfan0", O_RDWR);
    if (fd < 0)
    {
        printf("打开设备文件失败\n");
        exit(-1);
    }
    
    while (1)
    {
        printf("请输入指令\n");
        printf("0(关闭风扇) 1(打开风扇)\n");

        printf("请输入:");
        scanf("%d", &a);

        switch (a)
        {
        case 1:
            ioctl(fd, FAN_ON); //开
            break;
        case 0:
            ioctl(fd, FAN_OFF); //关
            break;
        }
    }

    close(fd);

    return 0;
}

myfan.h

#include 
#include 
#include 
#include 
#include 
#include "head.h"

unsigned int major; // 定义一个变量保存主设备号

gpio_t *vir_fan;
tim1_t *vir_tim1;

rcc_t *vir_rcc;

struct class *cls;
struct device *dev;

// 封装操作方法
int mycdev_open(struct inode *inode, struct file *file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    return 0;
}

long mycdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
    switch (cmd)
    {
    case FAN_ON:
        //打开风扇
        vir_tim1->CCR1 = 700;
        break;
    case FAN_OFF:
        //关闭风扇
        vir_tim1->CCR1 = 0;
        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,
    .unlocked_ioctl = mycdev_ioctl,
    .release = mycdev_close,
};

int fan_init(void)
{
    //寄存器地址的映射
    vir_rcc = ioremap(PHY_FAN_RCC, sizeof(rcc_t));
    if (vir_rcc == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    vir_fan = ioremap(PHY_FAN_GPIOE, sizeof(gpio_t));
    if (vir_fan == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_tim1 = ioremap(PHY_FAN_TIM1, sizeof(tim1_t));
    if (vir_tim1 == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    printk("物理地址映射成功\n");
    //寄存器的初始化
    // RCC
    vir_rcc->MP_APB2ENSETR |= (0x1 << 0);
    vir_rcc->MP_AHB4ENSETR |= (0x1 << 4);

    // GPIOE
    vir_fan->MODER &= (~(0x3 << 18));
    vir_fan->MODER |= (0x1 << 19);

    vir_fan->AFRH &= (~(0xf << 4));
    vir_fan->AFRH |= (0x1 << 4);

    // TIM1
    vir_tim1->PSC = 208;
    vir_tim1->ARR = 1000;
    vir_tim1->CCR1 = 700;

    vir_tim1->CCMR1 &= (~(0X1 << 16));
    vir_tim1->CCMR1 &= (~(0x3 << 5));
    vir_tim1->CCMR1 |= (0x3 << 5);
    vir_tim1->CCMR1 |= (0x1 << 3);
    vir_tim1->CCMR1 &= (~(0x3 << 0));

    vir_tim1->CCER |= (0x1 << 3);
    vir_tim1->CCER &= (~(0x1 << 1));
    vir_tim1->CCER |= (0x1 << 0);

    vir_tim1->CR1 |= (0x1 << 7);
    vir_tim1->CR1 &= (~(0x3 << 5));
    vir_tim1->CR1 |= (0x1 << 4);
    vir_tim1->CR1 |= (0x1 << 0);

    vir_tim1->BDTR |= (0x1 << 15);

    printk("寄存器初始化成功\n");

    return 0;
}

static int __init mycdev_init(void)
{
    // 字符设备驱动注册
    major = register_chrdev(0, "mychrdev", &fops);
    if (major < 0)
    {
        printk("字符设备驱动注册失败\n");
        return major;
    }
    printk("字符设备驱动注册成功:major=%d\n", major);

    //向上提交目录
    cls = class_create(THIS_MODULE, "myfan");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        return -PTR_ERR(cls);
    }
    printk("向上提交目录成功\n");

    dev = device_create(cls, NULL, MKDEV(major, 0), NULL, "myfan0");
    if (IS_ERR(dev))
    {
        printk("向上提交设备节点信息失败\n");
        return -PTR_ERR(dev);
    }

    printk("向上提交设备节点成功\n");

    // 寄存器映射以及初始化
    fan_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_fan);
    iounmap(vir_rcc);
    iounmap(vir_tim1);

    //销毁节点信息

    device_destroy(cls, MKDEV(major, 0));

    //销毁目录信息
    class_destroy(cls);

    // 注销字符设备驱动
    unregister_chrdev(major, "mychrdev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

马达

head.h

#ifndef __HEAD_H__
#define __HEAD_H__

#include "stm32mp1xx_rcc.h"
#include "stm32mp1xx_gpio.h"
#include "stm32mp1xx_tim.h"

#define PHY_MOTOR_RCC   0X50000000
#define PHY_MOTOR_GPIOF 0x50007000
#define PHY_MOTOR_TIM16 0x44007000

//功能码
#define MOTOR_ON _IOW('l', 1, int)
#define MOTOR_OFF _IOW('l', 0, int)

#endif

test.h

#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include 
#include "head.h"

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

    int fd = open("/dev/mymotor0", O_RDWR);
    if (fd < 0)
    {
        printf("打开设备文件失败\n");
        exit(-1);
    }
    
    while (1)
    {
        printf("请输入指令\n");
        printf("0(关闭马达) 1(打开马达)\n");

        printf("请输入:");
        scanf("%d", &a);

        switch (a)
        {
        case 1:
            ioctl(fd, MOTOR_ON); //开
            break;
        case 0:
            ioctl(fd, MOTOR_OFF); //关
            break;
        }
    }

    close(fd);

    return 0;
}

mymotor.h

#include 
#include 
#include 
#include 
#include 
#include "head.h"

unsigned int major; // 定义一个变量保存主设备号

gpio_t *vir_motor;
tim16_17_t *vir_tim16;

rcc_t *vir_rcc;

struct class *cls;
struct device *dev;

// 封装操作方法
int mycdev_open(struct inode *inode, struct file *file)
{
    printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
    return 0;
}

long mycdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
    switch (cmd)
    {
    case MOTOR_ON:
        //打开蜂鸣器
        vir_tim16->CCR1 = 700;
        break;
    case MOTOR_OFF:
        //关闭蜂鸣器
        vir_tim16->CCR1 = 0;
        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,
    .unlocked_ioctl = mycdev_ioctl,
    .release = mycdev_close,
};

int motor_init(void)
{
    //寄存器地址的映射
    vir_rcc = ioremap(PHY_MOTOR_RCC, sizeof(rcc_t));
    if (vir_rcc == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    vir_motor = ioremap(PHY_MOTOR_GPIOF, sizeof(gpio_t));
    if (vir_motor == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_tim16 = ioremap(PHY_MOTOR_TIM16, sizeof(tim16_17_t));
    if (vir_tim16 == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    printk("物理地址映射成功\n");
    //寄存器的初始化
    // RCC
    vir_rcc->MP_APB2ENSETR |= (0x1 << 3);
    vir_rcc->MP_AHB4ENSETR |= (0x1 << 5);

    // GPIOF
    vir_motor->MODER &= (~(0x3 << 12));
    vir_motor->MODER |= (0x1 << 13);

    vir_motor->AFRL &= (~(0xf << 24));
    vir_motor->AFRL |= (0x1 << 24);

    // TIM16
    vir_tim16->PSC = 208;
    vir_tim16->ARR = 1000;
    vir_tim16->CCR1 = 0;

    vir_tim16->CCMR1 &= (~(0X1 << 16));
    vir_tim16->CCMR1 &= (~(0x3 << 5));
    vir_tim16->CCMR1 |= (0x3 << 5);
    vir_tim16->CCMR1 |= (0x1 << 3);
    vir_tim16->CCMR1 &= (~(0x3 << 0));

    vir_tim16->CCER |= (0x1 << 3);
    vir_tim16->CCER &= (~(0x1 << 1));
    vir_tim16->CCER |= (0x1 << 0);

    vir_tim16->CR1 |= (0x1 << 7);
    vir_tim16->CR1 &= (~(0x3 << 5));
    vir_tim16->CR1 |= (0x1 << 4);
    vir_tim16->CR1 |= (0x1 << 0);

    vir_tim16->BDTR |= (0x1 << 15);

    printk("寄存器初始化成功\n");

    return 0;
}

static int __init mycdev_init(void)
{
    // 字符设备驱动注册
    major = register_chrdev(0, "mychrdev", &fops);
    if (major < 0)
    {
        printk("字符设备驱动注册失败\n");
        return major;
    }
    printk("字符设备驱动注册成功:major=%d\n", major);

    //向上提交目录
    cls = class_create(THIS_MODULE, "mymotor");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        return -PTR_ERR(cls);
    }
    printk("向上提交目录成功\n");

    dev = device_create(cls, NULL, MKDEV(major, 0), NULL, "mymotor0");
    if (IS_ERR(dev))
    {
        printk("向上提交设备节点信息失败\n");
        return -PTR_ERR(dev);
    }

    printk("向上提交设备节点成功\n");

    // 寄存器映射以及初始化
    motor_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_motor);
    iounmap(vir_rcc);
    iounmap(vir_tim16);

    //销毁节点信息

    device_destroy(cls, MKDEV(major, 0));

    //销毁目录信息
    class_destroy(cls);

    // 注销字符设备驱动
    unregister_chrdev(major, "mychrdev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

你可能感兴趣的:(驱动开发,驱动开发,c语言)