控制风扇 马达 蜂鸣器

该代码示例展示了如何在Linux环境下使用C语言编写设备驱动程序,通过ioctl系统调用来控制LED、风扇、马达和蜂鸣器。程序首先打开指定设备,然后通过循环接收用户输入,根据输入调用ioctl函数执行开/关操作。设备驱动注册了相应的字符设备,并通过ioremap进行内存映射以访问硬件寄存器。
摘要由CSDN通过智能技术生成

test.c

#include<string.h>
#include<stdlib.h>
#include<stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include<unistd.h>
#include "head.h"
#include <sys/ioctl.h>
int main(int argc, char const *argv[])
{
    int a,b;//控制灯
    int c;//控制风扇
     int d;//控制马达
     int f;//控制蜂鸣器
    char buf[128]={0};
    int fd,fd_fan,fd_mada,fd_bee;
    printf("输入要打开设备 0 灯 1 风扇 2 马达 3 蜂鸣器");
      int t;
     scanf("%d",&t);
    switch(t)
    {
      case 0:
     fd=open("/dev/led0",O_RDWR);
     if(fd<0)
     {
        printf("打开失败\n");
        exit(-1);
        
     }
      //从终端读取
      while(1)
      {
        printf("请选择要实现的功能\n");
        printf("请输入要控制的灯\n");
        printf("led1:1 led2:2 led3:3>>");
        scanf("%d",&a);
        printf("0:开灯 1:关灯");
        scanf("%d",&b);

        if(b==1)
        {
            ioctl(fd,LED_ON,&a);//开灯
        }else if(b==0)
        {
           ioctl(fd,LED_OFF,&a);//关灯
        }
      }
        break;
        case 1:
      fd_fan=open("/dev/fan",O_RDWR);
      if(fd_fan<0)
      {
         printf("打开失败\n");
         exit(-1);
      }
      while(1)
      {
       printf("请选择风扇的功能\n");
         printf("0:关 1:开");
        scanf("%d",&c);
        if(c==1)
        {
            ioctl(fd_fan,FAN_ON);
        }else if(c==0)
        {
           ioctl(fd_fan,FAN_OFF);
        }
      }
        break;
        case 2:
       fd_mada=open("/dev/mada",O_RDWR);
       if(fd_mada<0)
      {
         printf("打开失败\n");
         exit(-1);
      }
      while(1)
      {
       printf("请选择马达的功能\n");
         printf("0:关 1:开");
        scanf("%d",&d);
        if(d==1)
        {
            ioctl(fd_mada,MADA_ON);
        }else if(d==0)
        {
           ioctl(fd_mada,MADA_OFF);
        }
      }
        break;
        case 3:
       fd_bee=open("/dev/bee",O_RDWR);
       if(fd_bee<0)
      {
         printf("打开失败\n");
         exit(-1);
      }
      while(1)
      {
      printf("请选择蜂鸣器的功能\n");
         printf("0:关 1:开");
        scanf("%d",&f);
        if(f==1)
        {
            ioctl(fd_bee,BEE_ON);
        }else if(f==0)
        {
           ioctl(fd_bee,BEE_OFF);
        }
      }
        break;

    }
     close(fd);
     close(fd_fan);
     close(fd_mada);
     close(fd_bee);
    return 0;
}

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  //GPIOE
#define PHY_LED2_ADDR 0x50007000  //GPIOF
#define PHY_LED3_ADDR 0x50006000
#define PHY_RCC_ADDR  0x50000A28
#define GPIOE         0X50006000
#define GPIOF         0x50007000
#define GPIOB         0x50003000
#define LED_ON   _IOW('l',1,int) //开灯
#define LED_OFF  _IOW('l',0,int) //关机
#define FAN_ON   _IO('f',1)//吹
#define FAN_OFF  _IO('f',0)//停止
#define MADA_ON  _IO('m',1)
#define MADA_OFF _IO('M',0)
#define BEE_ON   _IO('b',1)
#define BEE_OFF  _IO('b',0)

#endif

led.c

#include<linux/init.h>
#include<linux/module.h>
#include<linux/fs.h>
#include<linux/io.h>
#include<linux/device.h>
#include <linux/uaccess.h>
#include "head.h"
struct class *cls;
struct device *dev;
int major;
char kbuf[128]={0};
gpio_t *vir_led1;
gpio_t *vir_led2;
gpio_t *vir_led3;
unsigned int *vir_rcc;

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)
{
   int which;
   int ret=copy_from_user(&which,(void*)arg,4);
   if(ret)
   {
      printk("拷贝用户空间数据失败\n");
      return -EIO;
   }
   switch(cmd)
   {
      case LED_ON://开灯
         switch(which)
         {
        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;
        case LED_OFF:
        switch(which)
        {
         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=ioremap(PHY_LED3_ADDR,sizeof(gpio_t));
   if(vir_led3==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);
   //led1
   vir_led1->MODER&=(~(0x3<<20));
   vir_led1->MODER|=(1<<20);
   vir_led1->ODR&=(~(1<<10));
      //led2
   vir_led2->MODER&=(~(0x3<<20));
   vir_led2->MODER|=(1<<20);
   vir_led2->ODR&=(~(1<<10));
      //led3
   vir_led3->MODER&=(~(0x3<<16));
   vir_led3->MODER|=(1<<16);
   vir_led3->ODR&=(~(1<<8));
   printk("寄存器初始化成功\n");
   return 0;
}
static int __init mycdev_init (void)
{
   int i;
   //字符设备驱动注册
   major=register_chrdev(0,"led",&fops);
   if(major<0)
   {
     printk("字符设备驱动注册失败\n");
     return major;
   }
    printk("字符设备驱动注册成功major=%d\n",major);
    //向上提交目录
    cls=class_create(THIS_MODULE,"led");
    if(IS_ERR(cls))
    {
      printk("向上提交目录\n");
      return -PTR_ERR(cls);
    }
    //向上提交设备节点信息
    //为三盏灯创建三个设备文件
    for(i=0;i<3;i++)
    {
     dev=device_create(cls,NULL,MKDEV(major,i),NULL,"led%d",i);
     if(IS_ERR(dev))
     {
      printk("向上提交设备节点信息失败\n");
      return -PTR_ERR(dev);
     }
    }
    all_led_init();
    printk("%d\n",__LINE__);
    return 0;
} 

static void __exit mycdev_exit(void)
{
    int i;
    //取消地址映射
    iounmap(vir_led1);
    iounmap(vir_led2);
    iounmap(vir_led3);
    iounmap(vir_rcc);
    for(i=0;i<3;i++)
    {
        device_destroy(cls,MKDEV(major,i));
    }
    //销毁目录信息
    class_destroy(cls);
    //注销字符设备驱动
    unregister_chrdev(major,"led");
}
module_init(mycdev_init);
module_exit (mycdev_exit);
MODULE_LICENSE("GPL");

fan.c

#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/device.h>
#include <linux/uaccess.h>
#include "head.h"
struct class *cls;
struct device *dev;
int major;
gpio_t *vir_gpioe;
unsigned int *vir_rcc;

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_gpioe->ODR |= (0X1 << 9);
      break;
   case FAN_OFF:
      vir_gpioe->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,

};

static int __init mycdev_init(void)
{

   // 字符设备驱动注册
   major = register_chrdev(0, "fan", &fops);
   if (major < 0)
   {
      printk("字符设备驱动注册失败\n");
      return major;
   }
   printk("字符设备驱动注册成功major=%d\n", major);
   // 向上提交目录
   cls = class_create(THIS_MODULE, "fan");
   if (IS_ERR(cls))
   {
      printk("向上提交目录失败\n");
      return -PTR_ERR(cls);
   }
   // 向上提交设备节点信息
   dev = device_create(cls, NULL, MKDEV(major, 0), NULL, "fan");
   if (IS_ERR(dev))
   {
      printk("向上提交设备节点失败\n");
      return -PTR_ERR(dev);
   }
   vir_gpioe = ioremap(PHY_LED1_ADDR, sizeof(gpio_t));
   if (vir_gpioe == 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;
   }
   (*vir_rcc) |= (1 << 4);
   // led1
   vir_gpioe->MODER &= (~(0x3 << 18));
   vir_gpioe->MODER |= (1 << 18);
   vir_gpioe->ODR &= (~(1 << 9));
   return 0;
}

static void __exit mycdev_exit(void)
{
   // 取消地址映射
   iounmap(vir_gpioe);
   iounmap(vir_rcc);

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

mada.c

#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/device.h>
#include <linux/uaccess.h>
#include "head.h"
struct class *cls;
struct device *dev;
int major;
gpio_t *vir_gpiof;
unsigned int *vir_rcc;

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 MADA_ON:
      vir_gpiof->ODR |= (0X1 << 6);
      break;
   case MADA_OFF:
      vir_gpiof->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,

};

static int __init mycdev_init(void)
{

   // 字符设备驱动注册
   major = register_chrdev(0, "mada", &fops);
   if (major < 0)
   {
      printk("字符设备驱动注册失败\n");
      return major;
   }
   printk("字符设备驱动注册成功major=%d\n", major);
   // 向上提交目录
   cls = class_create(THIS_MODULE, "mada");
   if (IS_ERR(cls))
   {
      printk("向上提交目录失败\n");
      return -PTR_ERR(cls);
   }
   // 向上提交设备节点信息
   dev = device_create(cls, NULL, MKDEV(major, 0), NULL, "mada");
   if (IS_ERR(dev))
   {
      printk("向上提交设备节点失败\n");
      return -PTR_ERR(dev);
   }
   vir_gpiof = ioremap(GPIOF, sizeof(gpio_t));
   if (vir_gpiof == 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;
   }
   (*vir_rcc) |= (0x3 << 4);
   
   vir_gpiof->MODER &= (~(0x3 << 12));
   vir_gpiof->MODER |= (1 << 12);
   vir_gpiof->ODR &= (~(1 << 6));
   return 0;
}

static void __exit mycdev_exit(void)
{
   // 取消地址映射
   iounmap(vir_gpiof);
   iounmap(vir_rcc);

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

bee.c

#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/device.h>
#include <linux/uaccess.h>
#include "head.h"
struct class *cls;
struct device *dev;
int major;
gpio_t *vir_gpiob;
unsigned int *vir_rcc;

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 BEE_ON:
      vir_gpiob->ODR |= (0X1 << 6);
      break;
   case BEE_OFF:
      vir_gpiob->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,

};

static int __init mycdev_init(void)
{

   // 字符设备驱动注册
   major = register_chrdev(0, "bee", &fops);
   if (major < 0)
   {
      printk("字符设备驱动注册失败\n");
      return major;
   }
   printk("字符设备驱动注册成功major=%d\n", major);
   // 向上提交目录
   cls = class_create(THIS_MODULE, "bee");
   if (IS_ERR(cls))
   {
      printk("向上提交目录失败\n");
      return -PTR_ERR(cls);
   }
   // 向上提交设备节点信息
   dev = device_create(cls, NULL, MKDEV(major, 0), NULL, "bee");
   if (IS_ERR(dev))
   {
      printk("向上提交设备节点失败\n");
      return -PTR_ERR(dev);
   }
   vir_gpiob = ioremap(GPIOB, sizeof(gpio_t));
   if (vir_gpiob == 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;
   }
   (*vir_rcc) |= (1 << 1);
   // led1
   vir_gpiob->MODER &= (~(0x3 << 12));
   vir_gpiob->MODER |= (1 << 12);
   vir_gpiob->ODR &= (~(1 << 6));
   return 0;
}

static void __exit mycdev_exit(void)
{
   // 取消地址映射
   iounmap(vir_gpiob);
   iounmap(vir_rcc);

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值