zerozipp/robot
1
0
Fork 0
Code Activity

update

Browse Source
This commit is contained in:
ZeroZipp
2026-01-14 12:24:16 +01:00
parent 7b345395c2
commit 41f4c6aafb
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
include/robot.hpp
View File

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