#include <string.h>
#include "2410addr.h"
#include "2410lib.h"
#include "Ts_sep.h"
#include "def.h"

#define LOOP 1
#define ADCPRS 39


void __irq Adc_or_TsSep(void)
{
	int i;
	U32 Pt[6];

	rINTSUBMSK|=(BIT_SUB_ADC|BIT_SUB_TC);	// Mask sub interrupt (ADC and TC) 

	// TC(Touch screen Control) Interrupt	
	if(rADCTSC&0x100)
	{
		Uart_Printf("\nStylus Up!!\n");
		rADCTSC&=0xff;	// Set stylus down interrupt
	}
	else 
	{
		Uart_Printf("\nStylus Down!!\n");
			
		// <X-Position Read>
		rADCTSC=(0<<8)|(0<<7)|(1<<6)|(1<<5)|(0<<4)|(1<<3)|(0<<2)|(1);
		// Down,Hi-Z,AIN5,GND,Ext vlt,Pullup Dis,Normal,X-position
		for(i=0;i<LOOP;i++);			//delay to set up the next channel
		for(i=0;i<5;i++)
		{
			rADCCON|=0x1;				// Start X-position conversion
			while(rADCCON & 0x1);		// Check if Enable_start is low
			while(!(0x8000&rADCCON));	// Check ECFLG
			Pt[i]=(0x3ff&rADCDAT0);
		}
		Pt[5]=(Pt[0]+Pt[1]+Pt[2]+Pt[3]+Pt[4])/5;
		Uart_Printf("X-Posion[AIN5] is %04d\n", Pt[5]);

		// <Y-Position Read>
		rADCTSC=(0<<8)|(0<<7)|(1<<6)|(1<<5)|(0<<4)|(1<<3)|(0<<2)|(2);
			// Down,GND,Ext vlt,Hi-Z,AIN7,Pullup Dis,Normal,Y-position
		for(i=0;i<LOOP;i++);			//delay to set up the next channel
		for(i=0;i<5;i++)
		{
			rADCCON|=0x1;				// Start X-position conversion
			while(rADCCON & 0x1);		// Check if Enable_start is low
			while(!(0x8000&rADCCON));	// Check ECFLG
			Pt[i]=(0x3ff&rADCDAT1);
		}
		Pt[5]=(Pt[0]+Pt[1]+Pt[2]+Pt[3]+Pt[4])/5;
		Uart_Printf("Y-Posion[AIN7] is %04d\n", Pt[5]);
		rADCTSC=(1<<8)|(1<<7)|(1<<6)|(0<<5)|(1<<4)|(0<<3)|(0<<2)|(3);
			// Up,GND,AIN,Hi-z,AIN,Pullup En,Normal,Waiting mode
	}

	rSUBSRCPND|=BIT_SUB_TC;
	rINTSUBMSK=~(BIT_SUB_TC);			// Unmask sub interrupt (TC)	
	ClearPending(BIT_ADC);
}

void Ts_Sep(void)
{
	Uart_Printf("[Touch Screen Test.]\n");
	Uart_Printf("Separate X/Y position conversion mode test\n");

	rADCDLY=(50000);	// ADC Start or Interval Delay

	rADCCON = (1<<14)|(ADCPRS<<6)|(0<<3)|(0<<2)|(0<<1)|(0);
	// Enable Prescaler,Prescaler,AIN7/5 fix,Normal,Disable read start,No operation
	rADCTSC=(0<<8)|(1<<7)|(1<<6)|(0<<5)|(1<<4)|(0<<3)|(0<<2)|(3);
	// Down,YM:GND,YP:AIN5,XM:Hi-z,XP:AIN7,XP pullup En,Normal,Waiting for interrupt mode

	pISR_ADC=(unsigned)Adc_or_TsSep;
	rINTMSK=~(BIT_ADC);
	rINTSUBMSK=~(BIT_SUB_TC);

	Uart_Printf("\nType any key to exit!!!\n");
	Uart_Printf("\nStylus Down, please...... \n");
	
	Uart_Getch();

	rINTSUBMSK|=BIT_SUB_TC;
	rINTMSK|=BIT_ADC;
	Uart_Printf("[Touch Screen Test.]\n");
}