1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38
|
struct StrucPosBra
{
unsigned int Servo1;
unsigned int Servo2;
unsigned int Servo3;
unsigned int Servo4;
unsigned int Servo5;
unsigned int Servo6;
unsigned int Divers1;
unsigned int Divers2;
unsigned int Divers3;
unsigned int Divers4;
};
StrucPosBra PosOld= {0,0,0,0,0,0,1000,0,0,0};
StrucPosBra PosBra;
setup
position (0,100);
void position (byte a, int vitesse) {
Serial.println ("Dans fonction position *-*-*");
EEPROM.get ((a * NbOcPos * 10), PosBra); // car 2 octets *10 par position
Serial.println (PosBra.Servo1);
Serial.println (PosOld.Servo1);
Serial.println ("*-*-*");
Serial.println (PosBra.Divers1);
Serial.println (PosOld.Divers1);
Serial.println ("*-*-*");
Serial.println ((PosOld.Servo1)-(PosBra.Servo1));
Serial.println (abs(PosOld.Servo1-PosBra.Servo1));
} |