imx6q内核定时器实现led闪烁

/************************************************************************* > File Name: led_drv.c > Author: XXDK > Email: v.manstein@qq.com > Created Time: Sun 12 Mar 2017 07:16:54 AM PDT ************************************************************************/ #include<linux/init.h> #include<linux/module.h> #include<linux/timer.h> #include<asm/gpio.h> #include<mach/iomux-mx6q.h> #define SABRESD_GPIO_LED4 IMX_GPIO_NR(3, 21) #define SABRESD_GPIO_LED5 IMX_GPIO_NR(3, 22) #define SABRESD_GPIO_LED6 IMX_GPIO_NR(3, 23) // 实例化定时器对象 struct timer_list led_timer; int test_data = 88; // 构建led 类型 struct led_resource { char *name; int gpio; int data; }; // 实例化led对象集群 struct led_resource led_res[] = { [0] = { .name = "led4", .gpio = SABRESD_GPIO_LED4 }, [1] = { .name = "led5", .gpio = SABRESD_GPIO_LED5 }, [2] = { .name = "led6", .gpio = SABRESD_GPIO_LED6 } }; // 定时器超时处理方法 static void Led_timer_expires_handle(unsigned long data) { int i; int *pdata = (int *)data; printk("data is: %d at %s\n", *pdata, __func__); if(gpio_get_value(led_res[0].gpio)) { for(i = 0; i < ARRAY_SIZE(led_res); i++) gpio_set_value(led_res[i].gpio, 0); } else if(!gpio_get_value(led_res[0].gpio)) { for(i = 0; i < ARRAY_SIZE(led_res); i++) gpio_set_value(led_res[i].gpio, 1); } /**************************************************** * 修改定时器超时时间 * 此函数等价于： * 1. 先删除定时器 del_timer(&led_timer) * 2. 指定新的超时时间 expires = jiffies + 2*HZ * 3. 添加注册启动timer add_timer(&led_timer); ****************************************************/ mod_timer(&led_timer, jiffies + msecs_to_jiffies(2000)); } static int led_timer_init(void) { int i; // 申请 led 的 gpio 资源 for(i = 0; i < ARRAY_SIZE(led_res); i++) { gpio_request(led_res[i].gpio, led_res[i].name); gpio_direction_output(led_res[i].gpio, 0); } // 初始化定时器对象 init_timer(&led_timer); // 指定超时时间 led_timer.expires = jiffies + 2*HZ; // 指定超时处理方法 led_timer.function = Led_timer_expires_handle; // 给超时处理方法传递参数 led_timer.data = (unsigned long)&test_data; // 向内核注册并且启动定时器，开始倒计时 add_timer(&led_timer); return 0; } static void led_timer_exit(void) { int i; // 从内核移除定时器对象 del_timer(&led_timer); // 释放led 的 gpio资源 for(i = 0; i < ARRAY_SIZE(led_res); i++) { gpio_direction_output(led_res[i].gpio, 0); gpio_free(led_res[i].gpio); } } module_init(led_timer_init); module_exit(led_timer_exit); MODULE_LICENSE("GPL");