update

2 years ago · 2222b7c652
1 changed files with 2 additions and 2 deletions
--- a/components/xy_robot_ctrl_module/xy_robot_ctrl_module.cpp
+++ b/components/xy_robot_ctrl_module/xy_robot_ctrl_module.cpp
@ -566,8 +566,8 @@ void XYRobotCtrlModule::forward_kinematics(int32_t x, int32_t y, int32_t& m1pos,
    m1pos = ((x + y) / 2);
    m2pos = ((y - x) / 2);
  } else {
-    m1pos = (x - y) / 2;
-    m2pos = (x + y) / 2;
+    m1pos = (x + y) / 2;
+    m2pos = (x - y) / 2;
  }
 }