You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
132 lines
3.7 KiB
C++
132 lines
3.7 KiB
C++
/**
|
|
* Marlin 3D Printer Firmware
|
|
* Copyright (C) 2016 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|
*
|
|
* Based on Sprinter and grbl.
|
|
* Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
*/
|
|
|
|
#include "../../inc/MarlinConfig.h"
|
|
|
|
#include "../gcode.h"
|
|
#include "../../module/motion.h"
|
|
#include "../../module/stepper.h"
|
|
|
|
#if ENABLED(M114_DETAIL)
|
|
|
|
void report_xyze(const float pos[], const uint8_t n = 4, const uint8_t precision = 3) {
|
|
char str[12];
|
|
for (uint8_t i = 0; i < n; i++) {
|
|
SERIAL_CHAR(' ');
|
|
SERIAL_CHAR(axis_codes[i]);
|
|
SERIAL_CHAR(':');
|
|
SERIAL_PROTOCOL(dtostrf(pos[i], 8, precision, str));
|
|
}
|
|
SERIAL_EOL();
|
|
}
|
|
|
|
inline void report_xyz(const float pos[]) { report_xyze(pos, 3); }
|
|
|
|
void report_current_position_detail() {
|
|
|
|
stepper.synchronize();
|
|
|
|
SERIAL_PROTOCOLPGM("\nLogical:");
|
|
const float logical[XYZ] = {
|
|
LOGICAL_X_POSITION(current_position[X_AXIS]),
|
|
LOGICAL_Y_POSITION(current_position[Y_AXIS]),
|
|
LOGICAL_Z_POSITION(current_position[Z_AXIS])
|
|
};
|
|
report_xyz(logical);
|
|
|
|
SERIAL_PROTOCOLPGM("Raw: ");
|
|
report_xyz(current_position);
|
|
|
|
float leveled[XYZ] = { current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS] };
|
|
|
|
#if PLANNER_LEVELING
|
|
SERIAL_PROTOCOLPGM("Leveled:");
|
|
planner.apply_leveling(leveled);
|
|
report_xyz(leveled);
|
|
|
|
SERIAL_PROTOCOLPGM("UnLevel:");
|
|
float unleveled[XYZ] = { leveled[X_AXIS], leveled[Y_AXIS], leveled[Z_AXIS] };
|
|
planner.unapply_leveling(unleveled);
|
|
report_xyz(unleveled);
|
|
#endif
|
|
|
|
#if IS_KINEMATIC
|
|
#if IS_SCARA
|
|
SERIAL_PROTOCOLPGM("ScaraK: ");
|
|
#else
|
|
SERIAL_PROTOCOLPGM("DeltaK: ");
|
|
#endif
|
|
inverse_kinematics(leveled); // writes delta[]
|
|
report_xyz(delta);
|
|
#endif
|
|
|
|
SERIAL_PROTOCOLPGM("Stepper:");
|
|
LOOP_XYZE(i) {
|
|
SERIAL_CHAR(' ');
|
|
SERIAL_CHAR(axis_codes[i]);
|
|
SERIAL_CHAR(':');
|
|
SERIAL_PROTOCOL(stepper.position((AxisEnum)i));
|
|
}
|
|
SERIAL_EOL();
|
|
|
|
#if IS_SCARA
|
|
const float deg[XYZ] = {
|
|
stepper.get_axis_position_degrees(A_AXIS),
|
|
stepper.get_axis_position_degrees(B_AXIS)
|
|
};
|
|
SERIAL_PROTOCOLPGM("Degrees:");
|
|
report_xyze(deg, 2);
|
|
#endif
|
|
|
|
SERIAL_PROTOCOLPGM("FromStp:");
|
|
get_cartesian_from_steppers(); // writes cartes[XYZ] (with forward kinematics)
|
|
const float from_steppers[XYZE] = { cartes[X_AXIS], cartes[Y_AXIS], cartes[Z_AXIS], stepper.get_axis_position_mm(E_AXIS) };
|
|
report_xyze(from_steppers);
|
|
|
|
const float diff[XYZE] = {
|
|
from_steppers[X_AXIS] - leveled[X_AXIS],
|
|
from_steppers[Y_AXIS] - leveled[Y_AXIS],
|
|
from_steppers[Z_AXIS] - leveled[Z_AXIS],
|
|
from_steppers[E_AXIS] - current_position[E_AXIS]
|
|
};
|
|
SERIAL_PROTOCOLPGM("Differ: ");
|
|
report_xyze(diff);
|
|
}
|
|
|
|
#endif // M114_DETAIL
|
|
|
|
/**
|
|
* M114: Report current position to host
|
|
*/
|
|
void GcodeSuite::M114() {
|
|
|
|
#if ENABLED(M114_DETAIL)
|
|
if (parser.seen('D')) {
|
|
report_current_position_detail();
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
stepper.synchronize();
|
|
report_current_position();
|
|
}
|