1
0
This commit is contained in:
2026-01-14 12:24:16 +01:00
parent 7b345395c2
commit 41f4c6aafb

View File

@@ -20,9 +20,9 @@ class Robot {
/* Rotate with according speeds */
const int m = max(max(d1, d2), d3);
arm1.update(tArm1, 2 * (m / d1));
arm2.update(tArm2, 2 * (m / d2));
yaw.update(tYaw, 2 * (m / d3));
arm1.update(tArm1, 4 * (m / d1));
arm2.update(tArm2, 4 * (m / d2));
yaw.update(tYaw, 4 * (m / d3));
/* Is destination reached */
return arm1.angle() == tArm1