1 files changed, 203 insertions, 0 deletions
diff --git a/Position/Position.pde b/Position/Position.pde
new file mode 100644
index 0000000..38967d7
--- /dev/null
+++ b/Position/Position.pde
@@ -0,0 +1,203 @@
+// 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)));
+    
+  }*/
+}
+