mirror of
https://github.com/MarlinFirmware/Marlin.git
synced 2024-11-28 14:24:34 +00:00
Merge pull request #8309 from thinkyhead/bf1_fixes_for_117
[1.1] Fix G92 for native workspace
This commit is contained in:
commit
8e18e05d1d
@ -6270,10 +6270,8 @@ void home_all_axes() { gcode_G28(true); }
|
|||||||
* G92: Set current position to given X Y Z E
|
* G92: Set current position to given X Y Z E
|
||||||
*/
|
*/
|
||||||
inline void gcode_G92() {
|
inline void gcode_G92() {
|
||||||
bool didXYZ = false,
|
|
||||||
didE = parser.seenval('E');
|
|
||||||
|
|
||||||
if (!didE) stepper.synchronize();
|
stepper.synchronize();
|
||||||
|
|
||||||
#if ENABLED(CNC_COORDINATE_SYSTEMS)
|
#if ENABLED(CNC_COORDINATE_SYSTEMS)
|
||||||
switch (parser.subcode) {
|
switch (parser.subcode) {
|
||||||
@ -6298,24 +6296,27 @@ inline void gcode_G92() {
|
|||||||
#define IS_G92_0 true
|
#define IS_G92_0 true
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
bool didXYZ = false, didE = false;
|
||||||
|
|
||||||
if (IS_G92_0) LOOP_XYZE(i) {
|
if (IS_G92_0) LOOP_XYZE(i) {
|
||||||
if (parser.seenval(axis_codes[i])) {
|
if (parser.seenval(axis_codes[i])) {
|
||||||
#if IS_SCARA
|
const float v = parser.value_axis_units((AxisEnum)i),
|
||||||
if (i != E_AXIS) didXYZ = true;
|
d = current_position[i] - v;
|
||||||
#else
|
if (d) {
|
||||||
#if HAS_POSITION_SHIFT
|
if (i == E_AXIS) didE = true; else didXYZ = true;
|
||||||
const float p = current_position[i];
|
#if IS_SCARA
|
||||||
#endif
|
current_position[i] = v; // For SCARA just set the position directly
|
||||||
const float v = parser.value_axis_units((AxisEnum)i);
|
#elif HAS_POSITION_SHIFT
|
||||||
|
if (i == E_AXIS)
|
||||||
if (i != E_AXIS) {
|
current_position[E_AXIS] = v; // When using coordinate spaces, only E is set directly
|
||||||
didXYZ = true;
|
else {
|
||||||
#if HAS_POSITION_SHIFT
|
position_shift[i] += d; // Other axes simply offset the coordinate space
|
||||||
position_shift[i] += v - p; // Offset the coordinate space
|
|
||||||
update_software_endstops((AxisEnum)i);
|
update_software_endstops((AxisEnum)i);
|
||||||
#endif
|
}
|
||||||
}
|
#else
|
||||||
#endif
|
current_position[i] = v; // Without workspaces revert to Marlin 1.0 behavior
|
||||||
|
#endif
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user