modelec/controle-moteurs
1
0
Fork 0
mirror of https://github.com/modelec/controle-moteurs.git synced 2026-01-18 16:27:33 +01:00
Code Issues Packages Projects Releases Wiki Activity

Update asservissement.ino

Browse Source
This commit is contained in:
enchantuer
2024-04-15 18:27:45 +02:00
committed by GitHub
parent 2a6c1e539c
commit 551f42e8e6
1 changed files with 10 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
asservissement/asservissement.ino
View File

@@ -243,6 +243,11 @@ void loop() {
} else {
//mouvement
if (cmd=='G' or cmd=='T') {
Serial.print(X);
Serial.print(",");
Serial.print(Y);
Serial.print(",");
Serial.print(Z*100);
// distance à la cible
dc = sqrt((Xt-X)*(Xt-X)+(Yt-Y)*(Yt-Y));
Idc += dc;
@@ -337,6 +342,11 @@ void loop() {
//rotation
}else if(cmd=='R') {
Serial.print(X);
Serial.print(",");
Serial.print(Y);
Serial.print(",");
Serial.print(Z*100);
dc=0;
cmdD = 0;