1+ #include <avr/pgmspace.h>
12#include <Servo.h>
23#include <EEPROM.h>
34#include <math.h>
@@ -8,29 +9,29 @@ const int VITESSE=0; // Pause en ms après un mouvement
89const int ANGLE_MIN = 5 ; // si angle2 < ANGLE_MIN collision avant-bras avec bras
910const int MIN_US = 550 , MAX_US = 2350 ; // Commande servo en us (tester 700-2300)
1011const int COR_X = 5 , COR_Y = 12 ; // Corrections x,y
11- double COR_S1 = 16.8 , COR_S2 = -3.4 ; // Correction angle servos en degrés
12- const double SHIFT_S1_ANGLE = 7.5 ;
13- const double MIN_X = -130 ;
14- const double MAX_X = 130 ;
15- const double MIN_Y = 10 ;
16- const double MAX_Y = 205 ;
12+ float COR_S1 = 16.8 , COR_S2 = -3.4 ; // Correction angle servos en degrés
13+ const float SHIFT_S1_ANGLE = 7.5 ;
14+ const float MIN_X = -130 ;
15+ const float MAX_X = 130 ;
16+ const float MIN_Y = 10 ;
17+ const float MAX_Y = 205 ;
1718
1819// VARIABLES
1920Servo s1 , s2 ; // s1: épaule (en A), s2: coude (en B)
20- double lg1 = 149 , lg2 = 130 ; // longueur des bras (mm) lg1 = AB (bras), lg2 = BC (avant-bras)
21- double angle1 , angle2 ; // position servos en degrés de s1 et s2
22- double old1 , old2 ; // position précédente des angles
23- double pas = 0.5 ; // distance souhaitée en mm entre 2 points
24- double par = M_PI /180 ; // angle en radians entre deux calculs de points (1°)
21+ float lg1 = 149 , lg2 = 130 ; // longueur des bras (mm) lg1 = AB (bras), lg2 = BC (avant-bras)
22+ float angle1 , angle2 ; // position servos en degrés de s1 et s2
23+ float old1 , old2 ; // position précédente des angles
24+ float pas = 0.5 ; // distance souhaitée en mm entre 2 points
25+ float par = M_PI /180 ; // angle en radians entre deux calculs de points (1°)
2526bool microsec = true; // Mode précis (0.1°) si true
2627bool debug = true; // Affiche les déplacements dans le moniteur série
2728
28- void log (char msg [], double t , double x , double y ){
29+ void log (char msg [], float t , float x , float y ){
2930 Serial .print (msg );Serial .print (" - t:" );Serial .print (t );Serial .print (":(" );Serial .print (x );
3031 Serial .print ("," ); Serial .print (y );Serial .println (")" );
3132}
3233
33- void log (double x , double y ){
34+ void log (float x , float y ){
3435 Serial .print ("angles: S1:" );Serial .print (angle1 );Serial .print (" S2:" );Serial .println (angle2 );
3536 Serial .print (" (x,y) : (" );Serial .print (x );Serial .print ("," );Serial .print (y );Serial .println (")\n" );
3637}
@@ -55,7 +56,6 @@ void lectureCorrectif(){
5556 Serial .print ("EEPROM:Epaule=" );Serial .print (epaule );Serial .print (", Coude=" );Serial .print (coude );
5657 Serial .print (", Cor en us : (" );Serial .print (cor_epaule );Serial .print ("," );Serial .print (cor_coude );
5758 Serial .print ("), Cor en degrés : (" );Serial .print (COR_S1 );Serial .print ("," );Serial .print (COR_S2 ); Serial .print (")" );
58- Serial .println ("ok" );Serial .println ("ok" );Serial .println ("ok" );Serial .println ("ok" );Serial .println ("ok" );Serial .println ("ok" );
59-
59+ // Serial.println("ok");Serial.println("ok");Serial.println("ok");Serial.println("ok");Serial.println("ok");Serial.println("ok");
6060}
6161
0 commit comments