// longeur/largeur du tableau. changer a votre convenance ;)
int Lx=900; //default: 900
int Ly=600; //default: 600

import processing.serial.*;

Serial monPortamoi;
Serial monPortamoi2;
Serial monPortamoi3;
Serial monPortamoi4;

int x;
int y;
int clicX;
int clicY;

int coeff=10; // <1 multiplie, >1 divise, 1 inchangé.

float l1=0;
float l2;
float l3;
float l4;


float savel1=540;
float savel2=540;
float savel3=540;
float savel4=540;

float calcull1;
float calcull3;

void setup()
{
  size(Lx+500,Ly); //taille du tableau. a definir plus haut
  println(Serial.list());
  String arduinoPort = Serial.list()[1];
  //String arduinoPort2 = Serial.list()[0];
  String arduinoPort3 = Serial.list()[0];
  //String arduinoPort4 = Serial.list()[1];
  monPortamoi = new Serial(this, arduinoPort, 9600);
  //monPortamoi2 = new Serial(this, arduinoPort2, 9600);
  monPortamoi3 = new Serial(this, arduinoPort3, 9600);
  //monPortamoi4 = new Serial(this, arduinoPort4, 9600);
}




void draw()
{
  background(0); //fond noir
  fill(0,0,0); //remplir en noir
  stroke(0,200,200); //contour bleu
  rect(Lx,0,200,Ly); //boite
  rect(Lx,0,200,180); //boite
  //ellipse(x, height-y, 10,10);
  ellipse(x, mouseY, 10,10);
  
  x=mouseX; //x=position x de la souris
  y=height-mouseY; // y=hauteur-position y de la souris
  x=constrain(x,0,Lx); //contrainte de la souris. pour pas qu'elle ne se ballade dans les stats
  //traçage des lignes l1 l2 l3 l4
  line(0,0,x,height-y);
  line(Lx,Ly,x,height-y);
  line(Lx,0,x,height-y);
  line(0,Ly,x,height-y);
  
  
  
  
  
texte();  
}

void mouseClicked ()
{
  if( mouseX<Lx) // la souris est à gauche du bandeau
    {
      calculLongeurs();
      calculDeplacement();
      
      savel1=l1;
      savel2=l2;
      savel3=l3;
      savel4=l4;
      
      clicX=x;
      clicY=y;
      
      envoiMessageXbee();
    }
}  

void texte()
{
  fill(255,255,255);
  //affichage X et Y
  text("X= "+x, Lx+40,50);
  text("Y= "+y, Lx+120,50);
  //affichage 
  text("L1= "+nf(l1,3,2), Lx+40,130);
  text("L2= "+nf(l2,3,2), Lx+40,140);
  text("L3= "+nf(l3,3,2), Lx+40,150);
  text("L4= "+nf(l4,3,2), Lx+40,160);
  
  //affichage du nom des cables a proximité de ceux ci
  text("L2", x-100, height-y-100);
  text("L4", x+100, height-y+100);
  text("L3", x+100, height-y-100);
  text("L1", x-100, height-y+100);
}

void calculLongeurs()
{
  l1=sqrt( sq(x) + sq(y) );
  l2=sqrt( sq(x) + sq(Ly-y) );
  l3=sqrt( sq(Lx-x) + sq(Ly-y) );
  l4=sqrt( sq(Lx-x) + sq(y) );
}

void calculDeplacement()
{
  println(coeff);
  calcull1=(l1-savel1)/coeff;
  print("l1= ");
  println(calcull1);
  calcull3=(l3-savel3)/coeff;
  print("l3= ");
  println(calcull3);
}




void envoiMessageXbee()
{
  /*******************MESSAGE TREUIL1*******************************/
  if (calcull1>0)
  {
   monPortamoi.write("cmdH"+int(calcull1)+"\r");
    print("envoi message : ");
    println("cmdH"+int(calcull1));
    

  }
  if (calcull1<0)
  {
    monPortamoi.write("cmdT"+int(abs(calcull1))+"\r");
    print("envoi message : ");
    println("cmdT"+int(abs(calcull1)));
    
  }
  /*******************MESSAGE TREUIL2******************************* /
  if (calcull2>0)
  {
    monPortamoi2.write("cmdH"+int(calcull2)+"\r");
    print("envoi message : ");
    println("cmdH"+int(calcull2));
    

  }
  if (calcull2<0)
  {
    monPortamoi2.write("cmdT"+int(abs(calcull2))+"\r");
    print("envoi message : ");
    println("cmdT"+int(abs(calcull2)));
    
  }
  /*******************MESSAGE TREUIL3*******************************/
 if (calcull3>0)
  {
    monPortamoi3.write("cmdH"+int(calcull3)+"\r");
    print("envoi message : ");
    println("cmdH"+int(calcull3));
    

  }
  if (calcull3<0)
  {
    monPortamoi3.write("cmdT"+int(abs(calcull3))+"\r");
    print("envoi message : ");
    println("cmdT"+int(abs(calcull3)));
    
  }
  /*******************MESSAGE TREUIL4******************************* /
  if (calcull4>0)
  {
    monPortamoi4.write("cmdH"+int(calcull4)+"\r");
    print("envoi message : ");
    println("cmdH"+int(calcull4));
    

  }
  if (calcull4<0)
  {
    monPortamoi4.write("cmdT"+int(abs(calcull4))+"\r");
    print("envoi message : ");
    println("cmdT"+int(abs(calcull4)));
    
  }*/
}