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");