provide checksum script to easily generate config checksum values

[clinton/Smoothieware.git] / src / modules / robot / arm_solutions / CartesianSolution.cpp

#include "CartesianSolution.h"
#include <math.h>

CartesianSolution::CartesianSolution(Config* passed_config) : config(passed_config){
    this->alpha_steps_per_mm = this->config->value(alpha_steps_per_mm_checksum)->as_number();
    this->beta_steps_per_mm  = this->config->value( beta_steps_per_mm_checksum)->as_number();
    this->gamma_steps_per_mm = this->config->value(gamma_steps_per_mm_checksum)->as_number();
}

void CartesianSolution::millimeters_to_steps( double millimeters[], int steps[] ){
    steps[ALPHA_STEPPER] = lround( millimeters[X_AXIS] * this->alpha_steps_per_mm );
    steps[BETA_STEPPER ] = lround( millimeters[Y_AXIS] * this->beta_steps_per_mm );
    steps[GAMMA_STEPPER] = lround( millimeters[Z_AXIS] * this->gamma_steps_per_mm );
}

void CartesianSolution::steps_to_millimeters( int steps[], double millimeters[] ){
    millimeters[ALPHA_STEPPER] = steps[X_AXIS] / this->alpha_steps_per_mm;
    millimeters[BETA_STEPPER ] = steps[Y_AXIS] / this->beta_steps_per_mm;
    millimeters[GAMMA_STEPPER] = steps[X_AXIS] / this->gamma_steps_per_mm;
}