
#include "PA9.h"


PA_StylusPosition PA_StylusPos[20000];

PA_RecoValues PA_Reco;

char PA_RecoShape[16];

u8 PA_UseGraffiti = true;

u8 PA_CustomReco = 0; // number of custom shapes
PA_FormType PA_CustomShape[200];

PA_RecoInfos PA_RecoInfo;

PA_FormType PA_Graffiti[PA_RECOTESTS] = {
	{' ', "AAAAAAAAAAAAAAA"},	   
    {'a', "FGGGGGFB;:;;;;;"},
    {'b', "JJJJJIGC>:8=<62"},
    {'c', "01234689;<>?@BC"},
    {'d', "=995KJIFB?=;853"},
    {'e', "1236;>@136;=?@A"},
    {'f', "121111399998779"},  
    {'g', "235689;=@CFIJEA"},
	{'h', "8999999;HFEA><:"},
	{'i', "999999999999999"},
    {'j', "999999998653100"},
    {'k', "654320NIDCA?==="},  
    {'l', "999999988<AA@@@"},
	{'m', "HGGEA<;EFDA=;99"},
	{'n', "HHHIE<;;;<GIHHH"},
    {'o', "4689;<?BDFHKMO0"},
    {'p', "<KJIIIHGEB>;853"},  
    {'q', "4679<?CDFHKMJBA"},
	{'r', "999IIIIGC?:53<="},	
	{'s', "0235:>?>>;73100"},
    {'t', "AAAA@@@;8999999"},
    {'u', "899:;<>ACEGHHIH"},  
    {'v', ";;:::::?FGGHHGF"},
  	{'w', "::;=BA<<@CDEFGH"},		
    {'x', ";;;;;;;;;;;;;;;"},  
    {'y', ">;=AFF899974OIF"},
	{'z', ">A@@>843348?@AA"},
	{PA_BACKSPACE, "000000000000000"},
	{PA_ENTER, "555555555555555"},
//	{'?', "FCA@><8655799::"},
	{'.', "LLLLLLLLLLLLLLL"}	
};		



extern inline void PA_AddStylusPos(u8 x, u8 y){
   if (!((x == PA_StylusPos[PA_Reco.nvalues-1].x) && (y == PA_StylusPos[PA_Reco.nvalues-1].y))){
	   PA_StylusPos[PA_Reco.nvalues].x = x;
	   PA_StylusPos[PA_Reco.nvalues].y = y;  
	   PA_Reco.nvalues++;
	}		
}   


void PA_StylusLine(u8 x1, u8 y1, u8 x2, u8 y2){
  int i,dx,dy,sdx,sdy,dxabs,dyabs,x,y,px,py;

  dx=x2-x1;      /* the horizontal distance of the line */
  dy=y2-y1;      /* the vertical distance of the line */
  dxabs = dx;
  sdx = 1;
  if (dx < 0) {
	  dxabs = -dx;
	  sdx = -1;
  }
  dyabs = dy;
  sdy = 1;
  if (dy < 0) {
	  dyabs = -dy;
	  sdy = -1;
  }

  x=dyabs>>1;
  y=dxabs>>1;
  px=x1;
  py=y1;
  
PA_AddStylusPos(px, py);


  if (dxabs>=dyabs) {
    for(i=0;i<dxabs;i++)  {
      y+=dyabs;
      if (y>=dxabs)  {
        y-=dxabs;
        py+=sdy;
      }
      px+=sdx;
      PA_AddStylusPos(px, py);
    }
  }
  else {
    for(i=0;i<dyabs;i++) {
      x+=dxabs;
      if (x>=dyabs)  {
        x-=dyabs;
        px+=sdx;
      }
      py+=sdy;
      PA_AddStylusPos(px, py);
    }
  }
}


#define PA_ShapeAddPoint(i, value){\
	points[i] = PA_StylusPos[value];\
	if (points[i].x < PA_RecoInfo.minX) PA_RecoInfo.minX = points[i].x;\
	else if (points[i].x > PA_RecoInfo.maxX) PA_RecoInfo.maxX = points[i].x;\
	if (points[i].y < PA_RecoInfo.minY) PA_RecoInfo.minY = points[i].y;\
	else if (points[i].y > PA_RecoInfo.maxY) PA_RecoInfo.maxY = points[i].y;	}




char PA_AnalyzeShape(void){
   s32 i;
   for (i = 0; i < 32; i++) PA_OutputSimpleText(1, 0, i, "             ");
   
   PA_StylusPosition points[17];
   for (i = 0; i < 16; i++){
      PA_ShapeAddPoint(i, (PA_Reco.nvalues*i)>>4)
	}   
	PA_ShapeAddPoint(16, PA_Reco.nvalues-1)
    //points[16] = PA_StylusPos[PA_Reco.nvalues-1];
	PA_RecoInfo.endX = PA_StylusPos[PA_Reco.nvalues-1].x; // last values
	PA_RecoInfo.endY = PA_StylusPos[PA_Reco.nvalues-1].y; // last values
	PA_RecoInfo.Length = PA_Reco.nvalues; // Total length
	PA_RecoInfo.Angle = PA_GetAngle(points[0].x, points[0].y, points[16].x, points[16].y);

//Better values		
	if (PA_RecoInfo.minX > 1) PA_RecoInfo.minX-=2;
	if (PA_RecoInfo.maxX <254) PA_RecoInfo.maxX+=2;	
	if (PA_RecoInfo.minY > 1) PA_RecoInfo.minY-=2;
	if (PA_RecoInfo.maxY <190) PA_RecoInfo.maxY+=2;	
	
	u16 angles[15];
	for (i = 0; i < 15; i++) angles[i] = PA_GetAngle(points[i+2].x, points[i+2].y, points[i].x, points[i].y);
	
	for (i = 0; i < 15; i++) PA_RecoShape[i] = '0' + (((angles[i]+16)&511)>>4);
	PA_RecoShape[15] = 0;
	//PA_OutputText(1, 2, 23, PA_RecoShape);
	
	u8 letter = 0; // 0 par défaut
	s32 diff = 65000; // Diff max par défaut	
	
	u8 j;
	
	if(PA_UseGraffiti){
		for (j = 0; j < PA_RECOTESTS; j++){
		   s32 tempvalue = 0;
			s32 tempdiff = 0;
			for (i = 0; i < 15; i++) {
			   tempvalue = (PA_RecoShape[i]-PA_Graffiti[j].code[i])&31;
			   tempvalue -= (tempvalue >> 4)<<5; // normalise
			   if (tempvalue < 0) tempvalue = -tempvalue;
			   tempdiff += tempvalue; // value
			}
			
			if (tempdiff < diff){ // Nouvelle lettre !
				diff = tempdiff;
				letter = PA_Graffiti[j].letter;
			}			
		}	
	}
	if (PA_CustomReco > 0){
		for (j = 0; j < PA_CustomReco; j++){
		   s32 tempvalue = 0;
			s32 tempdiff = 0;
			for (i = 0; i < 15; i++) {
			   tempvalue = (PA_RecoShape[i]-PA_CustomShape[j].code[i])&31;
			   tempvalue -= (tempvalue >> 4)<<5; // normalise
			   if (tempvalue < 0) tempvalue = -tempvalue;
			   tempdiff += tempvalue; // value
			}
			
			if (tempdiff < diff){ // Nouvelle lettre !
				diff = tempdiff;
				letter = PA_CustomShape[j].letter;
			}			
		}		
	
	}
	
	return letter;
}   



char PA_CheckLetter(void){
	   if(Stylus.Newpress){
			PA_Reco.nvalues = 0; // Start over again
			PA_Reco.oldn = 0;
			PA_Reco.veryold = 0;
			
			PA_RecoInfo.startX = PA_StylusPos[PA_Reco.nvalues].x = Stylus.X; // start values
			PA_RecoInfo.startY = PA_StylusPos[PA_Reco.nvalues].y = Stylus.Y;  
			PA_RecoInfo.minX = PA_RecoInfo.maxX = PA_RecoInfo.startX;
			PA_RecoInfo.minY = PA_RecoInfo.maxY = PA_RecoInfo.startY;			
  			PA_Reco.nvalues++;
		}
		else if(Stylus.Held) {
			PA_StylusLine(PA_StylusPos[PA_Reco.nvalues-1].x, PA_StylusPos[PA_Reco.nvalues-1].y, Stylus.X, Stylus.Y);
			
		}

		      
		if(Stylus.Released){ // Start analyzing...
			PA_Reco.nvalues = PA_Reco.veryold;
			return PA_AnalyzeShape();
		}	
		PA_Reco.veryold = PA_Reco.oldn;
		PA_Reco.oldn = PA_Reco.nvalues;
		return 0;
}		








