src/modules/robot/arm_solutions/CartesianSolution.cpp

   1 #include "CartesianSolution.h"
   2 #include <math.h>
   3
   4 void CartesianSolution::cartesian_to_actuator( float cartesian_mm[], float actuator_mm[] ){
   5     actuator_mm[ALPHA_STEPPER] = cartesian_mm[X_AXIS];
   6     actuator_mm[BETA_STEPPER ] = cartesian_mm[Y_AXIS];
   7     actuator_mm[GAMMA_STEPPER] = cartesian_mm[Z_AXIS];
   8 }
   9
  10 void CartesianSolution::actuator_to_cartesian( float actuator_mm[], float cartesian_mm[] ){
  11     cartesian_mm[ALPHA_STEPPER] = actuator_mm[X_AXIS];
  12     cartesian_mm[BETA_STEPPER ] = actuator_mm[Y_AXIS];
  13     cartesian_mm[GAMMA_STEPPER] = actuator_mm[Z_AXIS];
  14 }