#include "s3c2440_soc.h"

typedef void(*irq_func)(int);
irq_func irq_array[32];


/* SRCPND 用来显示哪个中断产生了, 需要清除对应位
 * bit0-eint0
 * bit2-eint2
 * bit5-eint8_23
 */

/* INTMSK 用来屏蔽中断, 1-masked
 * bit0-eint0
 * bit2-eint2
 * bit5-eint8_23
 */

/* INTPND 用来显示当前优先级最高的、正在发生的中断, 需要清除对应位
 * bit0-eint0
 * bit2-eint2
 * bit5-eint8_23
 */

/* INTOFFSET : 用来显示INTPND中哪一位被设置为1
 */

/* 初始化中断控制器 */
void interrupt_init(void)
{
	INTMSK &= ~((1<<0) | (1<<2) | (1<<5));
	INTMSK &= ~(1<<10);  /* enable timer0 int */
}

/* 读EINTPEND分辨率哪个EINT产生(eint4~23)
 * 清除中断时, 写EINTPEND的相应位
 */


void key_eint_irq(int irq)
{
	unsigned int val = EINTPEND;
	unsigned int val1 = GPFDAT;
	unsigned int val2 = GPGDAT;
	int i,j;
	if (irq == 0) /* eint0 : s2 控制 D12 */
	{
		if (val1 & (1<<0)) /* s2 --> gpf6 */
		{
			/* 松开 */
			GPFDAT |= (1<<6);
		}
		else
		{
			/* 按下 */
			GPFDAT &= ~(1<<6);
		}
		
	}
	else if (irq == 2) /* eint2 : s3 控制 D11 */
	{
		if (val1 & (1<<2)) /* s3 --> gpf5 */
		{
			/* 松开 */
			GPFDAT |= (1<<5);
		}
		else
		{
			/* 按下 */
			GPFDAT &= ~(1<<5);
		}
		
	}
	else if (irq == 5) /* eint8_23, eint11--s4 控制 D10, eint19---s5 控制所有LED */
	{
		if (val & (1<<11)) /* eint11 */
		{
			if (val2 & (1<<3)) /* s4 --> gpf4 */
			{
				/* 松开 */
				GPFDAT |= (1<<4);
			}
			else
			{
				/* 按下 */
				GPFDAT &= ~(1<<4);
			}
		}
		else if (val & (1<<19)) /* eint19 */
		{
			if (val2 & (1<<11))
			{
				/* 松开 */
				/* 熄灭所有LED */
				GPFDAT |= ((1<<4) | (1<<5) | (1<<6));
			}
			else
			{
				/* 按下: 点亮所有LED */
				GPFDAT &= ~((1<<4) | (1<<5) | (1<<6));
			}
		}
		else if (val & (1<<15)) /* eint15, 用于光敏电阻 */
		{
			if (val2 & (1<<7))
			{

				for (j = 20; j <20+16; j++)
				{
					for (i = 20; i < 480; i++)
					{
						fb_put_pixel(i, j, 0x80FFFF);
					}
				}
				fb_print_string(20, 20, "rphotoresistor  light!!!!!", 0xA0);
			}
			else
			{
				for (j = 20; j <20+16; j++)
				{
					for (i = 20; i < 480; i++)
					{
						fb_put_pixel(i, j, 0x80FFFF);
					}
				}
				fb_print_string(20, 20, "rphotoresistor dark.......", 0xA0);
			}
		}
	}

	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_uninstall(void)
{
	EINTMASK |= ((1<<11) | (1<<19));
	unregister_irq(0);
	unregister_irq(2);
	unregister_irq(5);
}

/* 初始化按键, 设为中断源 */
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被配置为中断引脚 */

	/* 配置GPG7为中断引脚, 用于光敏电阻 */
	//GPGCON &= ~((3<<14));
	//GPGCON |= ((2<<14));   
	

	/* 设置中断触发方式: 双边沿触发 */
	EXTINT0 |= (7<<0) | (7<<8);     /* S2,S3 */
	EXTINT1 |= (7<<12);             /* S4 */
	EXTINT2 |= (7<<12);             /* S5 */

	/* 配置GPG7/EINT15为双边沿触发, 用于光敏电阻 */
	//EXTINT1 |= (7<<28);

	/* 设置EINTMASK使能eint11,19 */
	EINTMASK &= ~((1<<11) | (1<<19));

	/* 使能中断GPG7/EINT15, 用于光敏电阻 */
	//EINTMASK &= ~((1<<15));

	register_irq(0, key_eint_irq);
	register_irq(2, key_eint_irq);
	register_irq(5, key_eint_irq);
}

void res_eint_init(void)
{

	/* 配置GPG7为中断引脚, 用于光敏电阻 */
	GPGCON &= ~((3<<14));
	GPGCON |= ((2<<14));   
	
	/* 配置GPG7/EINT15为双边沿触发, 用于光敏电阻 */
	EXTINT1 |= (7<<28);

	/* 使能中断GPG7/EINT15, 用于光敏电阻 */
	EINTMASK &= ~((1<<15));
	register_irq(5, key_eint_irq);

}

void res_eint_uninstall(void)
{
	EINTMASK |= ((1<<15));
	unregister_irq(5);
}