驱动
#include <linux/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/uaccess.h>
#include <linux/io.h>
#include <linux/device.h>
#include <linux/cdev.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/of.h>
#include <linux/of_gpio.h>
#include "head.h"
#if 1
int major = 0; // 动态申请主设备号
#else
int major = 500; // 静态申请主设备号
#endif
int minor = 0; // 存放次设备号的变量
struct cdev *cdev; // 字符设备驱动对象指针
dev_t devno; // 设备号
struct class *cls;
struct device *dev;
struct gpio_desc *gpiono[3];
struct device_node *node;
const char *led[3] = {"led1", "led2", "led3"};
// struct timer_list mytimer;
// void mytimer_function(struct timer_list *timer)
// {
// gpiod_set_value(gpiono1, !gpiod_get_value(gpiono1));
// mod_timer(&mytimer,jiffies+HZ);
// }
char kbuf[128] = {0};
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 *ubuf, size_t size, loff_t *off)
{
int ret;
// 判断kbuf的大小,如果<size,把size的数值修改为kbuf的大小
if (size > sizeof(kbuf))
size = sizeof(kbuf);
ret = copy_to_user(ubuf, kbuf, size);
if (ret)
{
printk("copy_to_user filed\n");
return -EIO; // 拷贝失败返回错误码
}
printk("%s:%s:%d\n", __FILE__, __func__, __LINE__);
return 0;
}
ssize_t mycdev_write(struct file *file, const char *ubuf, size_t size, loff_t *off)
{
int ret, i;
if (size > sizeof(kbuf))
size = sizeof(kbuf);
ret = copy_from_user(kbuf, ubuf, size);
if (ret)
{
printk("copy_from_user filed\n");
return -EIO; // 拷贝失败返回错误码
}
for (i = 0; i < 3; i++)
{
if (kbuf[0] == '1' + i)
{
gpiod_set_value(gpiono[i], !gpiod_get_value(gpiono[i]));
}
}
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,
.read = mycdev_read,
.write = mycdev_write,
.release = mycdev_close,
};
// 入口函数
static int __init mycdev_init(void)
{
int ret, i;
cdev = cdev_alloc();
if (cdev == NULL)
{
printk("给字符设备驱动对象申请内存失败\n");
ret = -ENOMEM;
goto ERR1;
}
// 对象初始化
cdev_init(cdev, &fops);
// 申请设备号
if (major == 0) // 动态申请
{
ret = alloc_chrdev_region(&devno, minor, 3, "mydev");
if (ret)
{
printk("动态申请设备号失败\n");
goto ERR2;
}
major = MAJOR(devno); // 获取主设备号
minor = MINOR(devno); // 获取次设备号
}
else if (major > 0)
{
ret = register_chrdev_region(MKDEV(major, minor), 3, "mydev");
if (ret)
{
printk("静态申请设备号失败\n");
goto ERR2;
}
}
// 将对象注册进内核
ret = cdev_add(cdev, MKDEV(major, minor), 3);
if (ret)
{
printk("注册失败\n");
goto ERR3;
}
printk("字符设备驱动对象注册成功\n");
// 向上提交目录
cls = class_create(THIS_MODULE, "mydev");
if (IS_ERR(cls)) // 指针指向预留空间,函数调用失败
{
printk("向上提交目录失败\n");
ret = PTR_ERR(cls);
goto ERR4;
}
printk("向上提交目录成功\n");
// 向上提交设备节点
for (i = 0; i < 3; i++)
{
dev = device_create(cls, NULL, MKDEV(major, i), NULL, "mydev%d", i);
if (IS_ERR(dev)) // 指针指向预留空间,函数调用失败
{
printk("向上提交设备节点失败\n");
ret = PTR_ERR(dev);
goto ERR5;
}
}
printk("设备节点向上提交成功\n");
// 解析设备树节点
node = of_find_node_by_path("/myleds");
if (node == NULL)
{
printk("设备树节点信息解析失败\n");
goto ERR5;
}
for (i = 0; i < 3; i++)
{
gpiono[i] = gpiod_get_from_of_node(node, led[i], 0, GPIOD_OUT_LOW, NULL);
if (IS_ERR(gpiono[i]))
{
printk("获取并注册gpio失败\n");
goto ERR6;
}
}
// mytimer.expires=jiffies+HZ;
// timer_setup(&mytimer,mytimer_function,0);
// add_timer(&mytimer);
return 0;
ERR6:
for (--i; i >=0; i--)
{
// 先灭灯
gpiod_set_value(gpiono[i], 0);
// 释放gpio编号
gpiod_put(gpiono[i]);
}
i=3;
ERR5:
// 将前面提交成功的设备节点删除
for (--i; i >= 0; i--)
{
device_destroy(cls, MKDEV(major, i));
}
// 将目录删除
class_destroy(cls);
ERR4:
cdev_del(cdev);
ERR3:
unregister_chrdev_region(MKDEV(major, minor), 3);
ERR2:
kfree(cdev);
ERR1:
return ret;
}
// 出口函数
static void __exit mycdev_exit(void)
{
int i;
for (i = 0; i < 3; i++)
{
// 先灭灯
gpiod_set_value(gpiono[i], 0);
// 释放gpio编号
gpiod_put(gpiono[i]);
}
// 删除节点信息
for (i = 0; i < 3; i++)
{
device_destroy(cls, MKDEV(major, i));
}
// 删除目录信息
class_destroy(cls);
// 字符设备驱动的注销
unregister_chrdev(major, "mydev");
// del_timer(&mytimer);
}
module_init(mycdev_init);
module_exit(mycdev_exit);
MODULE_LICENSE("GPL");
应用
#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/wait.h>
#include <fcntl.h>
#include <sys/epoll.h>
#include <sys/time.h>
#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
int main(int argc, const char *argv[])
{
int ret;
char buf;
int fd = open("/dev/mydev0", O_RDWR);
if (fd < 0)
{
printf("设备文件打开失败\n");
exit(-1);
}
while (1)
{
printf("请输入要进行操作的硬件:1(LED1) 2(LED2) 3(LED3)\n");
scanf("%c", &buf);
while (getchar() != '\n')
;
if (buf > '0' && buf < '4')
{
ret = write(fd, &buf, 1);
if (ret < 0)
{
printf("写入失败\n");
exit(-1);
}
}
else
{
printf("请重新输入!\n");
}
}
return 0;
}