
#include "../s3c2440_soc.h"
#include "../string_utils.h"
#include "../key/interrupt.h"
#include "timer.h"

#define TIMER_NUM  32
#define NULL  ((void *)0)



timer_desc timer_array[TIMER_NUM];
static unsigned long long g_system_time_10ms_cnt = 0;

int register_timer(char *name, timer_func fp)
{
	int i;
	for (i = 0; i < TIMER_NUM; i++)
	{
		if (!timer_array[i].fp)
		{
			timer_array[i].name = name;
			timer_array[i].fp   = fp;
			return 0;
		}
	}
	return -1;
}

int unregister_timer(char *name)
{
	int i;
	for (i = 0; i < TIMER_NUM; i++)
	{
		if (!strcmp(timer_array[i].name, name))
		{
			timer_array[i].name = NULL;
			timer_array[i].fp   = NULL;
			return 0;
		}
	}
	return -1;
}


void timer_irq(void)
{
	int i;
	g_system_time_10ms_cnt++;

	for (i = 0; i < TIMER_NUM; i++)
	{
		if (timer_array[i].fp)
		{
			timer_array[i].fp();
		}
	}	
}


// void timer_init(void)
// {
// 	/* 设置TIMER0的时钟 */
// 	/* Timer clk = PCLK / {prescaler value+1} / {divider value} 
// 	             = 50000000/(49+1)/16
// 	             = 62500
// 				 = 50000000/(24+1)/16
// 				 = 125000
// 	 */
// 	TCFG0 = 49;  /* Prescaler 0 = 49, 用于timer0,1 */
// 	//TCFG0 = 24;
// 	TCFG1 &= ~0xf;
// 	TCFG1 |= 3;  /* MUX0 : 1/1ss6 */

// 	/* 设置TIMER0的初值 */
// 	TCNTB0 = 625;  /* 10Ms中断一次 */
// 	//TCNTB0 = 300;
// 	//TCNTB0 = 125;  /* 1Ms中断一次 */

// 	/* 加载初值, 启动timer0 */
// 	TCON |= (1<<1);   /* Update from TCNTB0 & TCMPB0 */

// 	/* 设置为自动加载并启动 */
// 	TCON &= ~(1<<1);
// 	TCON |= (1<<0) | (1<<3);  /* bit0: start, bit3: auto reload */

// 	/* 设置中断 */
// 	register_irq(10, timer_irq);
// }


void timer_init(void)
{
	/* 设置TIMER0的时钟 */
	/* Timer clk = PCLK / {prescaler value+1} / {divider value} 
	             = 50000000/(4+1)/2
	             = 5000000
	   每减1, 对应0.2us
	   每减5, 对应1us
	   50000-->0 : 对应 10ms
	 */
	TCFG0 = 4;  /* Prescaler 0 = 4, 用于timer0,1 */
	TCFG1 &= ~0xf; /* MUX0 : 1/2 */

	/* 设置TIMER0的初值 */
	TCNTB0 = 50000;  /* 10Ms中断一次 */

	/* 加载初值, 启动timer0 */
	TCON |= (1<<1);   /* Update from TCNTB0 & TCMPB0 */

	/* 设置为自动加载并启动 */
	TCON &= ~(1<<1);
	TCON |= (1<<0) | (1<<3);  /* bit0: start, bit3: auto reload */

	/* 设置中断 */
	register_irq(10, timer_irq);
}


/* 尽量少调用函数 */
void udelay(int n)
{
	int cnt = n * 5;  /* n us 对应n*5个计数值 */
	int pre = TCNTO0;
	int cur;
	int delta;

	while (cnt > 0)
	{
		cur = TCNTO0;
		if (cur <= pre)
			delta = pre - cur;
		else
			delta = pre + (50000 - cur);

		cnt = cnt - delta;
		pre = cur;
	}
}

void mdelay(int m)
{
	udelay(m*1000);
}

unsigned long long get_system_time_us(void)
{
	unsigned long long us = (50000 - TCNTO0)/5;
	return g_system_time_10ms_cnt * 10 * 1000 + us;
}

unsigned int delta_time_us(unsigned long long pre, unsigned long long now)
{
	return (now - pre);
}

