#include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /*------------------字符设备内容----------------------*/ #define DEV_NAME "led_test" #define DEV_CNT (1) /*定义 led 资源结构体,保存获取得到的节点信息以及转换后的虚拟寄存器地址*/ struct led_resource { struct device_node *device_node; //led的设备树节点 void __iomem *va_DR; void __iomem *va_DDR; }; static dev_t led_devno; //定义字符设备的设备号 static struct cdev led_chr_dev; //定义字符设备结构体chr_dev struct class *class_led; //保存创建的类 struct device *device; // 保存创建的设备 struct device_node *led_test_device_node; //led_test的设备树节点结构体 /*定义led灯的led_resource 结构体,保存获取得到的节点信息*/ struct led_resource led_res; /*字符设备操作函数集,open函数*/ static int led_chr_dev_open(struct inode *inode, struct file *filp) { printk("\n led_chr_dev_open \n"); return 0; } /*字符设备操作函数集,write函数*/ static ssize_t led_chr_dev_write(struct file *filp, const char __user *buf, size_t cnt, loff_t *offt) { unsigned int register_data = 0; //暂存读取得到的寄存器数据 unsigned char write_data; //用于保存接收到的数据 int error = copy_from_user(&write_data, buf, cnt); if (error < 0) { return -1; } /*设置led引脚 输出电平*/ if (write_data) { register_data |= ((unsigned int)0x1 << (23)); register_data |= ((unsigned int)0x1 << (7)); writel(register_data, led_res.va_DR); // GPIO0_C7引脚输出高电平,红灯灭 } else { register_data |= ((unsigned int)0x1 << (23)); register_data &= ~((unsigned int)0x1 << (7)); writel(register_data, led_res.va_DR); // GPIO0_C7引脚输出低电平,红灯亮 } return 0; } /*字符设备操作函数集*/ static struct file_operations led_chr_dev_fops = { .owner = THIS_MODULE, .open = led_chr_dev_open, .write = led_chr_dev_write, }; /*----------------平台驱动函数集-----------------*/ static int led_probe(struct platform_device *pdv) { int ret = -1; //保存错误状态码 unsigned int register_data = 0; printk(KERN_EMERG "\t match successed \n"); /*获取led_test的设备树节点*/ led_test_device_node = of_find_node_by_path("/led_test"); if (led_test_device_node == NULL) { printk(KERN_ERR "\t get led_test failed! \n"); return -1; } /*获取led节点*/ led_res.device_node = of_find_node_by_name(led_test_device_node,"led"); if (led_res.device_node == NULL) { printk(KERN_ERR "\n get led_device_node failed ! \n"); return -1; } /*获取 reg 属性并转化为虚拟地址*/ led_res.va_DR = of_iomap(led_res.device_node, 0); if(led_res.va_DR == NULL){ printk("of_iomap is error \n"); return -1; } led_res.va_DDR = of_iomap(led_res.device_node, 1); if(led_res.va_DDR == NULL){ printk("of_iomap is error \n"); return -1; } // 设置模式寄存器:输出模式 register_data = readl(led_res.va_DDR); register_data |= ((unsigned int)0x1 << (23)); register_data |= ((unsigned int)0x1 << (7)); writel(register_data,led_res.va_DDR); // 设置置位寄存器:默认输出高电平 register_data = readl(led_res.va_DR); register_data |= ((unsigned int)0x1 << (23)); register_data |= ((unsigned int)0x1 << (7)); writel(register_data, led_res.va_DR); /*---------------------注册 字符设备部分-----------------*/ //第一步 //采用动态分配的方式,获取设备编号,次设备号为0, //DEV_CNT为1,当前只申请一个设备编号 ret = alloc_chrdev_region(&led_devno, 0, DEV_CNT, DEV_NAME); if (ret < 0) { printk("fail to alloc led_devno\n"); goto alloc_err; } //第二步 //关联字符设备结构体cdev与文件操作结构体file_operations led_chr_dev.owner = THIS_MODULE; cdev_init(&led_chr_dev, &led_chr_dev_fops); //第三步 //添加设备至cdev_map散列表中 ret = cdev_add(&led_chr_dev, led_devno, DEV_CNT); if (ret < 0) { printk("fail to add cdev\n"); goto add_err; } //第四步 /*创建类 */ class_led = class_create(THIS_MODULE, DEV_NAME); /*创建设备*/ device = device_create(class_led, NULL, led_devno, NULL, DEV_NAME); return 0; add_err: //添加设备失败时,需要注销设备号 unregister_chrdev_region(led_devno, DEV_CNT); printk("\n error! \n"); alloc_err: return -1; } static const struct of_device_id led_ids[] = { {.compatible = "fire,led_test"}, {/* sentinel */} }; /*定义平台设备结构体*/ struct platform_driver led_platform_driver = { .probe = led_probe, .driver = { .name = "leds-platform", .owner = THIS_MODULE, .of_match_table = led_ids, }}; /* *驱动初始化函数 */ static int __init led_platform_driver_init(void) { int DriverState; DriverState = platform_driver_register(&led_platform_driver); printk(KERN_EMERG "\tDriverState is %d\n", DriverState); return 0; } /* *驱动注销函数 */ static void __exit led_platform_driver_exit(void) { /*取消物理地址映射到虚拟地址*/ iounmap(led_res.va_DR); iounmap(led_res.va_DDR); /*删除设备*/ device_destroy(class_led, led_devno); //清除设备 class_destroy(class_led); //清除类 cdev_del(&led_chr_dev); //清除设备号 unregister_chrdev_region(led_devno, DEV_CNT); //取消注册字符设备 /*注销字符设备*/ platform_driver_unregister(&led_platform_driver); printk(KERN_EMERG "dts test led exit!\n"); } module_init(led_platform_driver_init); module_exit(led_platform_driver_exit); MODULE_LICENSE("GPL");