#include <timer.h>
#include <gic.h>
#include <lcd.h>
#include <tp.h>
//#include <isr.h>
#include <pwm.h>
#include <backlight.h> 
#include <wdt.h>
extern u8 irtime;

void do_wdt(void)
{
	printf("wdt timer...\n");
	wdt_reset_set(0);
	iowrite32(9527, WTCLRINT);
}


void do_timer3(void)
{
	printf("***\n");
	int val,n;

	val = ioread32(TINT_CSTAT);
	val |= 1 << 8;
	iowrite32(val, TINT_CSTAT);


	timer3_int_disable();


	udelay(1000000);

	
}

void timer3_init(int us)
{
	int val;

	/*设置第一级分频因子为99*/
	val = ioread32(TCFG0);
	val &= ~(0xff << 8);
	val |= (99 << 8);
	iowrite32(val, TCFG0);

	/*第二级分频因子为1， 则两级分频后的频率为1MHz*/
	val = ioread32(TCFG1);
	val &= ~(0xf << 12);
	iowrite32(val, TCFG1);

	iowrite32(us, TCNTB3);

#define TIMER3ID 72
	irq_request_cpu0(TIMER3ID, do_timer3, 0);

}

void timer3_int_enable(void)
{
	int val;

	/*手动更新TCNTB4到逻辑单元*/
	val = ioread32(TCON);
///	val &= ~(0x7 << 20);
	val &= ~(0xf << 16);
	iowrite32(val, TCON);
	val |= 1 << 17;
	iowrite32(val, TCON);
	val &= ~(1 << 17);
	iowrite32(val, TCON);

	/*启动timer4， 并设置自动加载*/
	val |= (1 << 16) | (1 << 15);
	iowrite32(val, TCON);
	
	/*使能TIMER4的定时中断*/
	val = ioread32(TINT_CSTAT);
	val |= 1 << 3;
	iowrite32(val, TINT_CSTAT);
}

void timer3_int_disable(void)
{
	int val;

	/*停止timer4的功能*/
	val = ioread32(TCON);
	val &= ~(1 << 16);
	iowrite32(val, TCON);

	/*使能TIMER4的定时中断*/
	val = ioread32(TINT_CSTAT);
	val &= ~(1 << 3);
	iowrite32(val, TINT_CSTAT);
}
void do_timer4(void)
{
	int val,n;

	val = ioread32(TINT_CSTAT);
	val |= 1 << 9;
	irtime ++;
	iowrite32(val, TINT_CSTAT);
	
}

/**********************timer4的初始化**************************/
void timer4_init(int us)
{
	int val;

	/*设置第一级分频因子为99*/
	val = ioread32(TCFG0);
	val &= ~(0xff << 8);
	val |= (99 << 8);
	iowrite32(val, TCFG0);

	/*第二级分频因子为1， 则两级分频后的频率为1MHz*/
	val = ioread32(TCFG1);
	val &= ~(0xf << 16);
	iowrite32(val, TCFG1);

	iowrite32(us, TCNTB4);

#define TIMER4ID 73
	irq_request_cpu0(TIMER4ID, do_timer4, 0);

}

void timer4_int_enable(void)
{
	int val;

	/*手动更新TCNTB4到逻辑单元*/
	val = ioread32(TCON);
	val &= ~(0x7 << 20);
	iowrite32(val, TCON);
	val |= 1 << 21;
	iowrite32(val, TCON);
	val &= ~(1 << 21);
	iowrite32(val, TCON);

	/*启动timer4， 并设置自动加载*/
	val |= (1 << 20) | (1 << 22);
	iowrite32(val, TCON);
	
	/*使能TIMER4的定时中断*/
	val = ioread32(TINT_CSTAT);
	val |= 1 << 4;
	iowrite32(val, TINT_CSTAT);
}

void timer4_int_disable(void)
{
	int val;

	/*停止timer4的功能*/
	val = ioread32(TCON);
	val &= ~(1 << 20);
	iowrite32(val, TCON);

	/*使能TIMER4的定时中断*/
	val = ioread32(TINT_CSTAT);
	val &= ~(1 << 4);
	iowrite32(val, TINT_CSTAT);
}

/**********************timer4**************************/

static void timer0_init(int periodus, int duty)
{
	int val;
	/*设置GPD0[0]引脚作为TOUT0，PWM0的输出*/
	val = ioread32(GPD0CON);
	val &= ~0xf;
	val |= 0x2;
	iowrite32(val, GPD0CON);

	/*设置第一级分频因子为99*/
	val = ioread32(TCFG0);
	val &= ~0xff;
	val |= 99;
	iowrite32(val, TCFG0);

	/*第二级分频因子为1， 则两级分频后的频率为1MHz*/
	val = ioread32(TCFG1);
	val &= ~0xf;
	iowrite32(val, TCFG1);

	val = periodus;
	iowrite32(val, TCNTB0);
	iowrite32(val>>1, TCMPB0);

	/*手动更新TCNTB0,TCMPB0到逻辑单元*/
	val = ioread32(TCON);
	val &= ~0xf;
	iowrite32(val, TCON);

	val |= 1 << 1;
	iowrite32(val, TCON);
	val &= ~(1 << 1);
	iowrite32(val, TCON);

	val |= (1 << 0) | (1 << 3);
	iowrite32(val, TCON);
}

void beep_set_hz(u32 freq)
{
#define USPERSEC 1000000UL
	u32 tmp = USPERSEC/freq;
	u32 val;

	/*设置GPD0的0引脚为TOU0*/
	val = ioread32(GPD0CON);
	val &= ~0xf;
	val |= 0x2;
	iowrite32(val, GPD0CON);

	timer0_init(tmp, tmp >> 1);
}



#if 0
/*蜂鸣器的驱动引脚连接到了GPD0[0]引脚*/
void beep_init(int hz, int duty)
{
	int us;

	us = 1000000/hz;
	timer0_init(us, duty);
}
#endif
