【驱动开发day3作业】

【驱动开发day3作业】_第1张图片

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_MOTOR_ADDR 0X50007000
#define PHY_FAN_ADDR 0X50006000
#define PHY_BEEP_ADDR 0X50003000
#define PHY_RCC_ADDR  0X50000A28
//功能码
#define LED_ON _IOW('l',1,int)
#define LED_OFF _IOW('l',0,int)

#define BEEP_ON _IOW('b',1,int)
#define BEEP_OFF _IOW('b',0,int)

#define FAN_ON _IOW('f',1,int)
#define FAN_OFF _IOW('f',0,int)

#define MOTOR_ON _IOW('m',1,int)
#define MOTOR_OFF _IOW('m',0,int)
#endif 

 应用层代码

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


int open_led()
{
    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);
}

int open_beep()
{
    int a, b;
    int fd = open("/dev/mybeep0", 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, BEEP_ON); // 打开
            break;
        case 0:
            ioctl(fd, BEEP_OFF);
            break;
        }
    }

    close(fd);
}

int open_fan()
{
    int a, b;
    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);
}

int open_motor()
{
    int a, b;
    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);
}



int main(int argc, char const *argv[])
{
    int choice;
    char buf[128] = {0};
    printf("请选择你要控制哪个设备(1:灯 2:蜂鸣器 3:风扇 4:马达)");
    scanf("%d",&choice);
    switch (choice)
    {
    case 1:
        open_led();
        break;
    case 2:
        open_beep();
        break;
    case 3:
        open_fan();
        break;
    case 4:
        open_motor();
        break;
    }

    return 0;
}

灯驱动代码

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

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;
        }

        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;
}


// 灯的设备注册
int led_dev_register(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");
    return 0;
}



static int __init mycdev_init(void)
{

    // 灯的设备注册
    led_dev_register();
    
    // 灯的寄存器映射以及初始化
    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");

蜂鸣器驱动代码

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


int magjor;
char kbuf[128] = {0};
gpio_t *vir_beep;
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 BEEP_ON:
        vir_beep->ODR |= (0x1 << 6);
        break;
    case BEEP_OFF:
        vir_beep->ODR &= (~(0x1 << 6));
        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_beep_init(void)
{
    // 寄存器地址的映射
    vir_beep = ioremap(PHY_BEEP_ADDR, sizeof(gpio_t));
    if (vir_beep == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_rcc = ioremap(PHY_RCC_ADDR, 4);
    if (vir_rcc == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    printk("物理地址映射成功\n");
    // 寄存器的初始化
    // rcc
    (*vir_rcc) |= (1 << 1);
    
    vir_beep->MODER &= (~(3 << 12));
    vir_beep->MODER |= (1 << 12);
    vir_beep->ODR &= (~(1 << 6));

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

    return 0;
}



// 蜂鸣器的设备注册
int beep_dev_register(void)
{
    int i;
    // 字符设备驱动注册
    magjor = register_chrdev(0,"mybeepdev",&fops);
    if (magjor < 0)
    {
        printk("字符设备驱动注册失败\n");
        return magjor;
    }
    printk("字符设备驱动注册成功:major=%d\n", magjor);
    // 向上提交目录
    cls = class_create(THIS_MODULE, "mybeep");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        return -PTR_ERR(cls);
    }
    printk("向上提交目录信息成功\n");
    // 向上提交设备节点信息
    dev = device_create(cls, NULL, MKDEV(magjor, 0), NULL, "mybeep0");
    if (IS_ERR(dev))
    {
        printk("向上提交设备节点信息失败\n");
        return -PTR_ERR(dev);
    }

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

static int __init mycdev_init(void)
{

    // 蜂鸣器的设备注册
    beep_dev_register();

    // 蜂鸣器的寄存器映射以及初始化
    all_beep_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_beep);
    iounmap(vir_rcc);
    // 销毁节点信息
    device_destroy(cls, MKDEV(magjor, 0));
    // 销毁目录信息
    class_destroy(cls);
    // 注销字符设备驱动
    unregister_chrdev(magjor, "mybeepdev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

风扇驱动代码

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

int major;
char kbuf[128] = {0};
gpio_t *vir_fan;

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 FAN_ON:
        vir_fan->ODR |= (0x1 << 9);

        break;
    case FAN_OFF:
        vir_fan->ODR &= (~(0x1 << 9));
        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_fan_init(void)
{
    // 寄存器地址的映射
    vir_fan = ioremap(PHY_FAN_ADDR, sizeof(gpio_t));
    if (vir_fan == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    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);
    //
    vir_fan->MODER &= (~(3 << 18));
    vir_fan->MODER |= (1 << 18);
    vir_fan->ODR &= (~(1 << 9));

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

    return 0;
}

// 风扇的设备注册
int fan_dev_register(void)
{
    int i;
    // 字符设备驱动注册
    major = register_chrdev(0, "myfandev", &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");
    return 0;
}

static int __init mycdev_init(void)
{

    // 风扇的设备注册
    fan_dev_register();

    // 风扇的寄存器映射以及初始化
    all_fan_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_fan);
    iounmap(vir_rcc);
    // 销毁节点信息

    device_destroy(cls, MKDEV(major, 0));
    // 销毁目录信息
    class_destroy(cls);
    // 注销字符设备驱动
    unregister_chrdev(major, "myfandev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

马达驱动代码

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


int magjor;
char kbuf[128] = {0};
gpio_t *vir_motor;
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 MOTOR_ON:
        vir_motor->ODR |= (0x1 << 6);
        break;
    case MOTOR_OFF:
        vir_motor->ODR &= (~(0x1 << 6));
        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_motor_init(void)
{
    // 寄存器地址的映射
    vir_motor = ioremap(PHY_MOTOR_ADDR, sizeof(gpio_t));
    if (vir_motor == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }
    vir_rcc = ioremap(PHY_RCC_ADDR, 4);
    if (vir_rcc == NULL)
    {
        printk("ioremap filed:%d\n", __LINE__);
        return -ENOMEM;
    }

    printk("物理地址映射成功\n");
    // 寄存器的初始化
    // rcc
    (*vir_rcc) |= (1 << 1);
    
    vir_motor->MODER &= (~(3 << 12));
    vir_motor->MODER |= (1 << 12);
    vir_motor->ODR &= (~(1 << 6));

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

    return 0;
}



// 马达的设备注册
int motor_dev_register(void)
{
    int i;
    // 字符设备驱动注册
    magjor = register_chrdev(0,"mymotordev",&fops);
    if (magjor < 0)
    {
        printk("字符设备驱动注册失败\n");
        return magjor;
    }
    printk("字符设备驱动注册成功:major=%d\n", magjor);
    // 向上提交目录
    cls = class_create(THIS_MODULE, "mymotor");
    if (IS_ERR(cls))
    {
        printk("向上提交目录失败\n");
        return -PTR_ERR(cls);
    }
    printk("向上提交目录信息成功\n");
    // 向上提交设备节点信息
    dev = device_create(cls, NULL, MKDEV(magjor, 0), NULL, "mymotor0");
    if (IS_ERR(dev))
    {
        printk("向上提交设备节点信息失败\n");
        return -PTR_ERR(dev);
    }

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

static int __init mycdev_init(void)
{

    // 马达的设备注册
    motor_dev_register();

    // 马达的寄存器映射以及初始化
    all_motor_init();

    return 0;
}
static void __exit mycdev_exit(void)
{
    // 取消地址映射
    iounmap(vir_motor);
    iounmap(vir_rcc);
    // 销毁节点信息
    device_destroy(cls, MKDEV(magjor, 0));
    // 销毁目录信息
    class_destroy(cls);
    // 注销字符设备驱动
    unregister_chrdev(magjor, "mymotordev");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");

 测试结果:

【驱动开发day3作业】_第2张图片

【驱动开发day3作业】_第3张图片 

 

你可能感兴趣的:(驱动开发,算法)