/*************************************************************************
	> File Name: led_drv.c
	> Author: XXDK
	> Email: [email protected] 
	> 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");