#include "screen_calibrate.h"
#include "tft.h"
#include "touch.h"


#define CCENTER 20  //Pixel Distance from Sides for Calibration Cross
#define CLENGTH 10	//Length of the Calibration Cross Lines
#define CBEGIN (CCENTER-CLENGTH/2)
#define CEND (CCENTER + CLENGTH/2)
#define DWIDTH 320
#define DHEIGHT 240

extern volatile bool calibration; //from touch.c


static void enter(void* screen) {
	int _x1,_y1,_x2,_y2,dx,dy;

	tft_clear(BLACK);

	tft_print_line(50,50,WHITE,BLACK,0,"Hit the markers exactly!");
	//-----------------First Point--------------------
	tft_draw_line(CCENTER,CBEGIN,CCENTER,CEND,WHITE);	//Draw Cross
	tft_draw_line(CBEGIN,CCENTER,CEND,CCENTER,WHITE);	//Draw Cross
	calibration=1; //TouchX + TouchY Values will not be converted to Pixels
	while(calibration);	//Wait on PenUp
	POINT_STRUCT p1 = touch_get_last_point();
	_x1=p1.x;
	_y1=p1.y;
	tft_fill_rectangle(CBEGIN,CBEGIN,CEND,CEND,BLACK); //Clear Cross

	//-----------------Second Point-------------------
	tft_draw_line(DWIDTH-CCENTER,DHEIGHT-CBEGIN,DWIDTH-CCENTER,DHEIGHT-CEND,WHITE);
	tft_draw_line(DWIDTH-CBEGIN,DHEIGHT-CCENTER,DWIDTH-CEND,DHEIGHT-CCENTER,WHITE);
	calibration=1;
	while(calibration);
	POINT_STRUCT p2 = touch_get_last_point();
	_x2=p2.x;
	_y2=p2.y;
	tft_fill_rectangle(DWIDTH-CBEGIN,DHEIGHT-CBEGIN,DWIDTH-CEND,DHEIGHT-CEND,BLACK);

	//-----------------Third Point--------------------
	tft_draw_line(CCENTER,DHEIGHT-CBEGIN,CCENTER,DHEIGHT-CEND,WHITE);
	tft_draw_line(CBEGIN,DHEIGHT-CCENTER,CEND,DHEIGHT-CCENTER,WHITE);
		calibration=1;
	while(calibration);
	POINT_STRUCT p3 = touch_get_last_point();
	_x1+=p3.x; //Add(!) values. We'll build the average later
	_y2+=p3.y;
	tft_fill_rectangle(CBEGIN,DHEIGHT-CBEGIN,CEND,DHEIGHT-CEND,BLACK);

	//------------------4. Point---------------------
	tft_draw_line(DWIDTH-CCENTER,CBEGIN,DWIDTH-CCENTER,CEND,WHITE);
	tft_draw_line(DWIDTH-CBEGIN,CCENTER,DWIDTH-CEND,CCENTER,WHITE);
	calibration=1;
	while(calibration);
	POINT_STRUCT p4 = touch_get_last_point();
	_x2+=p4.x;
	_y1+=p4.y;
	tft_fill_rectangle(DWIDTH-CBEGIN,CBEGIN,DWIDTH-CEND,CEND,BLACK);
	//-------------------Calculation---------------------
	_x1++; //Add 1 and divide by 2 later = +0.5 (for correct rounding)
	_y1++;
	_x2++;
	_y2++;
	_x1>>=1; //Divide by 2
	_y1>>=1;
	_x2>>=1;
	_y2>>=1;
	dx = (_x2-_x1);	//Build the Difference
	dy = (_y2-_y1);

	touch_set_calibration_valules(_x1,dx,_y1,dy);
	tft_print_line(50,50,WHITE,BLACK,0,"Calibration Done. Press anywhere");

	calibration=1;
	while(calibration);
	gui_screen_back();

}

static void leave(void* screen) {

}

static void update(void* screen) {

}


static SCREEN_STRUCT screen = {
	enter,
	leave,
	update
};


SCREEN_STRUCT* get_screen_calibrate() {
	return &screen;
}