Merge pull request #288 from MaslowCNC/fix-triangular-kinematics

Recompute cordinates of motors if machine geometry changes
MaslowCNC · Aug 24, 2017 · b3eb92e · b3eb92e
2 parents f1f9f7e + dd5668f
commit b3eb92e
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/cnc_ctrl_v1/Kinematics.cpp b/cnc_ctrl_v1/Kinematics.cpp
@@ -45,6 +45,9 @@ void Kinematics::recomputeGeometry(){
     Theta = atan(2*s/l);
     Psi1 = Theta - Phi;
     Psi2 = Theta + Phi;
+
+    _xCordOfMotor = D/2;
+    _yCordOfMotor = halfHeight + motorOffsetY;
 
 }