#include "../s3c2440_soc.h"
#include "interrupt.h"
#include "../lcd/framebuffer.h"
#include "../lcd/geometry.h"
#include "../lcd/font.h"
#include "../app/functional_selection.h"

irq_func irq_array[32];

/* 初始化中断控制器 */
void interrupt_init(void)
{
	/* enable EINT0 EINT2 EINT8_23 */
	INTMSK &= ~((1<<0) | (1<<2) | (1<<5));
	/* enable timer0 int */
	INTMSK &= ~(1<<10); 
}

/* 读EINTPEND分辨率哪个EINT产生(eint4~23)
 * 清除中断时, 写EINTPEND的相应位
 */
void key_eint_irq(int irq)
{
	unsigned int val = EINTPEND;
	unsigned int val1 = GPFDAT;
	unsigned int val2 = GPGDAT;
	
	/* eint0 : s2 控制 D12 */
	if (irq == 0) 
	{
		if (val1 & (1<<0)) /* s2 --> gpf6 */
		{
			/* 松开 */
			fb_print_string(120,100,"KEY1",0xffffff);
			GPFDAT |= (1<<6);
		}
		else
		{
			/* 按下 */
			fb_print_string(120,100,"KEY1",0xff0000);
			GPFDAT &= ~(1<<6);
		}
		
	}
	
	/* eint2 : s3 控制 D11 */
	else if (irq == 2) 
	{
		if (val1 & (1<<2)) /* s3 --> gpf5 */
		{
			/* 松开 */
			fb_print_string(120,100,"KEY2",0xffffff);
			GPFDAT |= (1<<5);
		}
		else
		{
			/* 按下 */
			fb_print_string(120,100,"KEY2",0xff0000);
			GPFDAT &= ~(1<<5);
		}
		
	}
	
	 /* eint8_23, eint11--s4 控制 D10, eint19---s5 控制所有LED */
	else if (irq == 5)
	{
		/* eint11 */
		if (val & (1<<11)) 
		{
			if (val2 & (1<<3)) /* s4 --> gpf4 */
			{
				/* 松开 */
				fb_print_string(120,100,"KEY3",0xffffff);
				GPFDAT |= (1<<4);
			}
			else
			{
				/* 按下 */
				fb_print_string(120,100,"KEY3",0xff0000);
				GPFDAT &= ~(1<<4);
			}
		}
		/* eint19 */
		else if (val & (1<<19)) 
		{
			if (val2 & (1<<11))
			{
				/* 松开 */
				/* 熄灭所有LED */
				fb_print_string(120,100,"KEY4",0xffffff);
				GPFDAT |= ((1<<4) | (1<<5) | (1<<6));
			}
			else
			{
				/* 按下: 点亮所有LED */
				fb_print_string(120,100,"KEY4",0xff0000);
				GPFDAT &= ~((1<<4) | (1<<5) | (1<<6));
			}
		}
	}

	EINTPEND = val;
}


void handle_irq_c(void)
{
	/* 分辨中断源 */
	int bit = INTOFFSET;

	/* 调用对应的处理函数 */
	irq_array[bit](bit);
	
	/* 清中断 : 从源头开始清 */
	SRCPND = (1<<bit);
	INTPND = (1<<bit);	
}

void register_irq(int irq, irq_func fp)
{
	irq_array[irq] = fp;

	INTMSK &= ~(1<<irq);
}

void unregister_irq(int irq)
{
	INTMSK |= (1<<irq);
}

/* 初始化按键, 设为中断源 */
void key_eint_init(void)
{
	/* 配置GPIO为中断引脚 */
	GPFCON &= ~((3<<0) | (3<<4));
	GPFCON |= ((2<<0) | (2<<4));   /* S2,S3被配置为中断引脚 */

	GPGCON &= ~((3<<6) | (3<<22));
	GPGCON |= ((2<<6) | (2<<22));   /* S4,S5被配置为中断引脚 */
	

	/* 设置中断触发方式: 双边沿触发 */
	EXTINT0 |= (7<<0) | (7<<8);     /* S2,S3 */
	EXTINT1 |= (7<<12);             /* S4 */
	EXTINT2 |= (7<<12);             /* S5 */

	/* 设置EINTMASK使能eint11,19 */
	EINTMASK &= ~((1<<11) | (1<<19));

	// register_irq(0, key_eint_irq);
	// register_irq(2, key_eint_irq);
	// register_irq(5, key_eint_irq);
}

void key_display(void)
{
	clear_screen(0xffffff);
	/* return框显示 */
	fb_disp_rectangle(340,200,110,40,0xff0000);

	fb_print_string(350,215,"Return",0);
	fb_print_string(100,80,"KEY TEST. The button you press is: ",0xff0000);
}

void key_test(void)
{
	int index;

	key_display();

	register_irq(0, key_eint_irq);
	register_irq(2, key_eint_irq);
	register_irq(5, key_eint_irq);
	while(1)
	{

		index = index_read();
		if (index == 11)
		{
			unregister_irq(0);
			unregister_irq(2);
			unregister_irq(5);
			break;
		}
			
	}
}
