#include "tslib.h"
#include "../lcd/geometry.h"
#include "touchscreen.h"
#include "../my_printf.h"
#include "../lcd/lcd.h"
#include "../nand_flash.h"
#include "../my_printf.h"
#include "../string_utils.h"
#include "../lcd/font.h"

#define NULL ((void *)0)
#define DEBUG

/* 校准参数 */
static int g_kx;
static int g_ky;
static int g_ts_xc, g_ts_yc;
static int g_lcd_xc, g_lcd_yc;

static int g_ts_xy_swap = 0;


static unsigned int fb_base;
static int xres, yres, bpp;

char parameter_saving[50];
static int str_size=50;
unsigned char buf[50];

int get_lcd_x_frm_ts_x(int ts_x)
{
// #ifdef DEBUG
// 	printf("-----\n\r");
// 	printf("g_kx=%d, ts_x=%d, g_ts_xc=%d, g_lcd_xc=%d\n\r", g_kx, ts_x, g_ts_xc, g_lcd_xc);
// 	printf("g_kx * (ts_x - g_ts_xc) / 100 + g_lcd_xc = %d\n\r", g_kx * (ts_x - g_ts_xc) / 100 + g_lcd_xc);
// #endif // DEBUG
	return g_kx * (ts_x - g_ts_xc) / 100 + g_lcd_xc;
	/* 浮点数操作，先乘后除，否则就是0 */
}

int get_lcd_y_frm_ts_y(int ts_y)
{
	return g_ky * (ts_y - g_ts_yc) / 100 + g_lcd_yc;
}

/* 校准点击屏幕，获取校准点的数据 */
void get_calibrate_point_data(int lcd_x, int lcd_y, int *px, int *py)
{
	int pressure;
	int x, y;
	int sum_x = 0, sum_y = 0;
	int cnt = 0;
	
	fb_disp_cross(lcd_x, lcd_y, 0xffffff);

	/* 等待点击 */

	do {
		ts_read_raw(&x, &y, &pressure);
		//ts_read_raw_test(&x, &y, &pressure);
	} while (pressure == 0);


	do {
		if (cnt < 128)
		{
			sum_x += x;
			sum_y += y;
			cnt++;
		}
		ts_read_raw(&x, &y, &pressure); 
		//ts_read_raw_test(&x, &y, &pressure);
		printf("get raw data: x = %08d, y = %08d, cnt = %d\n\r", x, y, cnt);
	} while (pressure);

	*px = sum_x / cnt;
	*py = sum_y / cnt;

	printf("return raw data: x = %08d, y = %08d\n\r", *px, *py);

	/* 直到松开才返回 */
	fb_disp_cross(lcd_x, lcd_y, 0);
}


int is_ts_xy_swap(int a_ts_x, int a_ts_y, int b_ts_x, int b_ts_y)
{
	int dx = b_ts_x - a_ts_x;
	int dy = b_ts_y - a_ts_y;

	if (dx < 0)
		dx = 0 - dx;
	if (dy < 0)
		dy = 0 - dy;

	if(dx > dy)
		return 0; /* xy没有反转 */
	else
		return 1; /* xy反了 */
}

void swap_xy(int *px, int *py)
{
	int tmp = *px;
	*px = *py;
	*py = tmp;
}

/*
----------------------------
|                          |
|  +(A)              (B)+  |
|                          |
|                          |
|                          |
|            +(E)          |
|                          |
|                          |
|                          |
|  +(D)              (C)+  |
|                          |
----------------------------

*/


/* 校准，获取校准参数 */
void ts_calibrate(void)
{
	int a_ts_x, a_ts_y;
	int b_ts_x, b_ts_y;
	int c_ts_x, c_ts_y;
	int d_ts_x, d_ts_y;
	int e_ts_x, e_ts_y;

	/* X轴方向 */
	int ts_s1, ts_s2;
	int lcd_s;

	/* Y轴方向 */
	int ts_d1, ts_d2;
	int lcd_d;

	
	/* 这里如果用指针的话 *parameter_saving，会卡死在这里，不会进入界面，不知道原因 */
	int i=0;
	
	// volatile unsigned char *p;
	
	fb_print_string(70, 70, "Touch cross to calibrate touchscreen", 0xffffff);

	/* 获得LCD的参数: fb_base, xres, yres, bpp */
	get_lcd_params(&fb_base, &xres, &yres, &bpp);

	/* 对于ABCDE, 循环: 显示"+"、点击、读ts原始值 */
	/* A(50, 50) */
	get_calibrate_point_data(50, 50, &a_ts_x, &a_ts_y);	

	/* B(xres-50, 50) */
	get_calibrate_point_data(xres-50, 50, &b_ts_x, &b_ts_y);

	/* C(xres-50, yres-50) */
	get_calibrate_point_data(xres-50, yres-50, &c_ts_x, &c_ts_y);

	/* D(50, yres-50) */
	get_calibrate_point_data(50, yres-50, &d_ts_x, &d_ts_y);
	
	/* E(xres/2, yres/2) */
	get_calibrate_point_data(xres/2, yres/2, &e_ts_x, &e_ts_y);

	/* 确定触摸屏数据XY是否反转 */
	g_ts_xy_swap = is_ts_xy_swap(a_ts_x, a_ts_y, b_ts_x, b_ts_y);

	if (g_ts_xy_swap)
	{
		/* 对调所有点的XY坐标 */
		swap_xy(&a_ts_x, &a_ts_y);
		swap_xy(&b_ts_x, &b_ts_y);
		swap_xy(&c_ts_x, &c_ts_y);
		swap_xy(&d_ts_x, &d_ts_y);
		swap_xy(&e_ts_x, &e_ts_y);
	}

	/* 确定公式的参数并保存 */
	ts_s1 = b_ts_x - a_ts_x;
	ts_s2 = c_ts_x - d_ts_x;
	lcd_s = xres-50 - 50;

	ts_d1 = d_ts_y - a_ts_y;
	ts_d2 = c_ts_y - b_ts_y;
	lcd_d = yres-50-50;

	g_kx = 100 * (2*lcd_s) / (ts_s1 + ts_s2);
	g_ky = 100 * (2*lcd_d) / (ts_d1 + ts_d2);

	/* 注意g_kx、g_ky浮点数操作，除以100 的时候，一定要在最后除 */


	g_ts_xc = e_ts_x;
	g_ts_yc = e_ts_y;

	g_lcd_xc = xres/2;
	g_lcd_yc = yres/2;

// #ifdef DEBUG
// 	printf("校准数据：g_kx=%d, g_ky=%d, g_ts_xc=%d, g_ts_yc=%d, g_lcd_xc=%d, g_lcd_yc=%d\n\r" ,g_kx, g_ky, g_ts_xc, g_ts_yc, g_lcd_xc, g_lcd_yc);
// #endif // DEBUG
	
	/* 构造字符串，方便存入nand flash */
	sprintf(parameter_saving, "%s_%d_%d_%d_%d_%d_%d_%d_%d_%d", "ok", g_kx, g_ky, g_ts_xc, g_ts_yc, g_lcd_xc, g_lcd_yc, g_ts_xy_swap, xres, yres);
	
// #ifdef DEBUG
// 	printf("%s\n\r", parameter_saving);
// #endif // DEBUG
	
	str_size = strlen(parameter_saving)+1;

	/* 将数据存进nand flash，地址0x2000000 */
	nand_erase(0x2000000, 128*1024);
	nand_write(0x2000000, parameter_saving, str_size);
	nand_read(0x2000000, buf, str_size);
	
#ifdef DEBUG
	printf("buf=%s\n\r",buf);
	printf("A lcd_x = %08d, lcd_y = %08d\n\r", get_lcd_x_frm_ts_x(a_ts_x), get_lcd_y_frm_ts_y(a_ts_y));
	printf("B lcd_x = %08d, lcd_y = %08d\n\r", get_lcd_x_frm_ts_x(b_ts_x), get_lcd_y_frm_ts_y(b_ts_y));
	printf("C lcd_x = %08d, lcd_y = %08d\n\r", get_lcd_x_frm_ts_x(c_ts_x), get_lcd_y_frm_ts_y(c_ts_y));
	printf("D lcd_x = %08d, lcd_y = %08d\n\r", get_lcd_x_frm_ts_x(d_ts_x), get_lcd_y_frm_ts_y(d_ts_y));
	printf("E lcd_x = %08d, lcd_y = %08d\n\r", get_lcd_x_frm_ts_x(e_ts_x), get_lcd_y_frm_ts_y(e_ts_y));
#endif // DEBUG

	/* return框显示 */
	fb_disp_rectangle(340,200,110,40,0xffffff);
	fb_print_string(350,215,"Return",0xffffff);
}

	



/* 字符串分割 */
void split(char **arr, char *str, const char *del) 
{
	char *s = strtok(str, del);
	while(s != NULL) 
	{
		*arr++ = s;
		s = strtok(NULL, del);
	}
}

/* 从nand中读取触摸屏校准数据 */
void ts_data_from_nand(void)
{
	char *str[10];
	char *p;
	const char *del = "_";
	int i=0;
	
	/* 数据解析 */
	/* 取数据，是一个整的字符串 */
	nand_read(0x2000000, buf, str_size);
	p = (char *)buf;

	/* 分割字符串，每个数据单独存放在str字符串数组中 */
	split(str, p, del);


	/* 打印数据 */
	printf("Nand flash:");
	while(i<7)
	{
		
		printf("%s  ", *(str+i++));
	}
	printf("\n\r");

	
	
	/* 数据判断 */
	if (!strcmp(*str,"ok"))
	{
		/* 第一个数据是ok，直接参数获取 */ 
		/* g_kx = ((double)atoi(*(str+1))) / 100;
		g_ky = ((double)atoi(*(str+2))) / 100; */
	 	g_kx = atoi(*(str+1));
		g_ky = atoi(*(str+2)); 

		//printf("atoi(*(str+1)) = %d, atoi(*(str+2))=%d\n\r", atoi(*(str+1)), atoi(*(str+2)));
		//printf("g_kx = %d, g_ky=%d\n\r", g_kx, g_ky);

		g_ts_xc = atoi(*(str+3));
		g_ts_yc = atoi(*(str+4));
		g_lcd_xc = atoi(*(str+5));
		g_lcd_yc = atoi(*(str+6));
		g_ts_xy_swap = atoi(*(str+7));
		xres = atoi(*(str+8));
		yres = atoi(*(str+9));
	}
	else
	{
		/* 第一个数据不是ok，说明没有经过校准，运行校准程序 */
		ts_calibrate();
	}
}

/*
 * 读TS原始数据, 转换为LCD坐标
 */
int ts_read(int *lcd_x, int *lcd_y, int *lcd_pressure)
{
	int ts_x=0, ts_y=0;
	static int ts_pressure;
	int tmp_x, tmp_y;
	
	ts_read_raw(&ts_x, &ts_y, &ts_pressure);

	if (g_ts_xy_swap)
	{
		swap_xy(&ts_x, &ts_y);
	}

	/* 使用公式计算 
	 * 参数是 g_kx、g_ts_xc、g_lcd_xc
	 * 		 g_ky、g_ts_yc、g_lcd_yc
	 */
	tmp_x = g_kx * (ts_x - g_ts_xc)  / 100 + g_lcd_xc;
	tmp_y = g_ky * (ts_y - g_ts_yc)  / 100 + g_lcd_yc;

// #ifdef DEBUG
// 	printf("g_kx		= %d, g_ky	  	= %d\n\r", g_kx, g_ky);
// 	printf("ts_x		= %d, ts_y	  	= %d\n\r" ,ts_x, ts_y);
// 	printf("g_ts_xc		= %d, g_ts_yc 	= %d\n\r" ,g_ts_xc, g_ts_yc);
// 	printf("g_lcd_xc	= %d, g_lcd_yc	= %d\n\r" ,g_lcd_xc, g_lcd_yc);
// 	printf("tmp_x=%d, tmp_y=%d\n\r",tmp_x,tmp_y);
// 	printf("xres=%d, yres=%d\n\r",xres,yres);

// #endif // DEBUG

	if (tmp_x < 0 || tmp_x >= xres || tmp_y < 0 || tmp_y >= yres)
		return -1;
	
	*lcd_x = tmp_x;
	*lcd_y = tmp_y;
	*lcd_pressure = ts_pressure;
	return 0;
}

