ioctl 控制led 蜂鸣器 风扇
驱动代码:
#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/io.h>
#include <linux/device.h>
#include "head.h"
unsigned int major,major1,major2,major3;
char kbuf[128]={0};
gpio_t *vir_led1;
gpio_t *vir_led2;
gpio_t *vir_led3;
gpio_t *vir_bee;
gpio_t *vir_fan;
gpio_t *vir_power;
unsigned int *vir_rcc;
struct class *cls;
struct class *cls1;
struct class *cls2;
struct class *cls3;
struct device *dev;
struct device *dev1;
struct device *dev2;
struct device *dev3;
int i;
int mycdev_open(struct inode *inode, struct file *file)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
ssize_t mycdev_read(struct file *file, char __user *ubuf, size_t size, loff_t *lof)
{
printk("%s:%s:%d\n",__FILE__,__func__,__LINE__);
return 0;
}
ssize_t mycdev_write(struct file *file, const char __user *ubuf, size_t size, loff_t *lof)
{
long ret;
ret=copy_from_user(kbuf,ubuf,size);
if(ret)
{
printk("copy_from_user filed\n");
return -EIO;
}
return 0;
}
long mycdev_ioctl (struct file *file , unsigned int cmd, unsigned long arg)
{
if(cmd == LED_ON)
/* code */
switch (arg)
{
case 1/* constant-expression */:
/* code */
vir_led1->ODR|=(0x1<<10);
break;
case 2:
vir_led2->ODR|=(0x1<<10);
break;
case 3:
vir_led3->ODR|=(0x1<<8);
break;
case 4:
vir_bee->ODR |=(0x1<<6);
break;
case 5:
vir_fan->ODR |=(0x1<<9);
break;
case 6:
vir_power->ODR |=(0x1<<6);
break;
default:
break;
}
else if(cmd == LED_OFF)
{
switch (arg)
{
case 1/* constant-expression */:
/* code */
vir_led1->ODR &= (~(0x1<<10));
break;
case 2:
vir_led2->ODR &= (~(0x1<<10));
break;
case 3:
vir_led3->ODR &= (~(0x1<<8));
break;
case 4:
vir_bee->ODR &=(~(0x1<<6));
break;
case 5:
vir_fan->ODR &=(~(0x1<<9));
break;
case 6:
vir_power->ODR &=(~(0x1<<6));
break;
default:
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,
.release=mycdev_close,
.read=mycdev_read,
.write=mycdev_write,
.unlocked_ioctl=mycdev_ioctl,
};
static int __init mycdev_init(void)
{
//给灯注册字符设备驱动
major=register_chrdev(0,"myled",&fops);
if(major<0)
{
printk("注册字符设备驱动失败");
return major;
}
printk("注册字符设备驱动成功major=%d\n",major);
major1=register_chrdev(0,"mybee",&fops);
if(major1<0)
{
printk("注册字符设备驱动失败");
return major1;
}
printk("注册蜂鸣器字符设备驱动成功major1=%d\n",major1);
major2=register_chrdev(0,"myfan",&fops);
if(major2<0)
{
printk("注册字符设备驱动失败");
return major2;
}
printk("注册风扇字符设备驱动成功major2=%d\n",major2);
major3=register_chrdev(0,"mypower",&fops);
if(major3<0)
{
printk("注册字符设备驱动失败");
return major3;
}
printk("注册马达字符设备驱动成功major3=%d\n",major3);
//映设蜂鸣器地址
vir_bee=ioremap(GPIOB,4);
if(vir_bee == NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
vir_fan=ioremap(GPIOE,4);
if(vir_fan == NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
vir_power=ioremap(GPIOF,4);
if(vir_power == NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
vir_led1=ioremap(GPIOE,4);
if(vir_led1 == NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
vir_led2=ioremap(GPIOF,4);
if(vir_led2== NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
vir_led3=ioremap(GPIOE,4);
if(vir_led3== NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
//映射rcc地址
vir_rcc=ioremap(PHY_LED_RCC,4);
if(vir_rcc == NULL)
{
printk("映射物理内存失败%d\n",__LINE__);
return -EFAULT;
}
//向上提交目录
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");
cls1 = class_create(THIS_MODULE,"mybee");
if(IS_ERR(cls1))
{
printk("向上提交目录失败\n");
return -PTR_ERR(cls1);
}
printk("向上提交目录信息成功\n");
cls2 = class_create(THIS_MODULE,"myfan");
if(IS_ERR(cls2))
{
printk("向上提交目录失败\n");
return -PTR_ERR(cls2);
}
printk("向上提交目录信息成功\n");
cls3 = class_create(THIS_MODULE,"mypower");
if(IS_ERR(cls3))
{
printk("向上提交目录失败\n");
return -PTR_ERR(cls3);
}
printk("向上提交目录信息成功\n");
dev1=device_create(cls1, NULL, MKDEV(major1,0),NULL,"mybee");
if(IS_ERR(dev1))
{
printk("向上提交设备节点信息失败\n");
return -PTR_ERR(dev1);
}
dev2=device_create(cls2, NULL, MKDEV(major2,0),NULL,"myfan");
if(IS_ERR(dev2))
{
printk("向上提交设备节点信息失败\n");
return -PTR_ERR(dev2);
}
dev3=device_create(cls3, NULL, MKDEV(major3,0),NULL,"mypower");
if(IS_ERR(dev3))
{
printk("向上提交设备节点信息失败\n");
return -PTR_ERR(dev3);
}
//led1寄存器的初始化
(*vir_rcc)|=(0x1<<4); //RCC使能
(*vir_rcc)|=(0x1<<5);
(*vir_rcc)|=(0x1<<1);
(vir_led1->MODER) &= (~(0x3<<20)); //设置为输出模式
(vir_led1->MODER) |=(0x1<<20);
(vir_led1->ODR) &= (~(0x1<<10)); //输出低电平
printk("led1寄存器初始化成功\n");
//led2寄存器初始化
(vir_led2->MODER) &=(~(0x3<<20));
(vir_led2->MODER) |=(0x1<<20);
(vir_led2->ODR) &= (~(0x1<<10));
printk("led2寄存器初始化成功\n");
//led3寄存器初始化
(vir_led3->MODER) &=(~(0x3<<16));
(vir_led3->MODER) |=(0x1<<16);
(vir_led3->ODR) &= (~(0x1<<8));
printk("led2寄存器初始化成功\n");
//蜂鸣器初始化
(vir_bee->MODER) &=(~(0x3<<12));
(vir_bee->MODER) |=(0x1<<12);
(vir_bee->ODR) &=(~(0x1 <<6));
//风扇初始化
(vir_fan->MODER) &=(~(0x3<<18));
(vir_fan->MODER) |=(0x1<<18);
(vir_fan->ODR) &=(~(0x1<<9));
//马达初始化
(vir_power->MODER) &=(~(0x3<<12));
(vir_power->MODER) |=(0x1<<12);
(vir_power->ODR) &=(~(0x1 <<6));
return 0;
}
static void __exit mycdev_exit(void)
{
iounmap(vir_led1);
iounmap(vir_led2);
iounmap(vir_led3);
iounmap(vir_rcc);
iounmap(vir_bee);
iounmap(vir_fan);
iounmap(vir_power);
for(i=0;i<3;i++)
{
device_destroy(cls,MKDEV(major,i));
}
class_destroy(cls);
unregister_chrdev(major,"myled");
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");
head.h
#ifndef __HEAD_H__
#define __HEAD_H__
typedef struct {
volatile unsigned int MODER; // 0x00
volatile unsigned int OTYPER; // 0x04
volatile unsigned int OSPEEDR; // 0x08
volatile unsigned int PUPDR; // 0x0C
volatile unsigned int IDR; // 0x10
volatile unsigned int ODR; // 0x14
volatile unsigned int BSRR; // 0x18
volatile unsigned int LCKR; // 0x1C
volatile unsigned int AFRL; // 0x20
volatile unsigned int AFRH; // 0x24
volatile unsigned int BRR; // 0x28
volatile unsigned int res;
volatile unsigned int SECCFGR; // 0x30
}gpio_t;
#define GPIOE 0x50006000
#define GPIOF 0x50007000
#define GPIOB 0x50003000
#define PHY_LED_RCC 0x50000A28
//功能码
#define LED_ON _IOW('1',1,int )
#define LED_OFF _IOW('1',0,int )
结果: