#2663 - Added handling of gcode lines M401 and M402 for Repetier flavour to GCodeAnalyzer
This commit is contained in:
parent
b60b44ed5e
commit
699319cd86
@ -126,6 +126,7 @@ void GCodeAnalyzer::reset()
|
||||
_set_start_position(DEFAULT_START_POSITION);
|
||||
_set_start_extrusion(DEFAULT_START_EXTRUSION);
|
||||
_reset_axes_position();
|
||||
_reset_cached_position();
|
||||
|
||||
m_moves_map.clear();
|
||||
m_extruder_offsets.clear();
|
||||
@ -262,6 +263,16 @@ void GCodeAnalyzer::_process_gcode_line(GCodeReader&, const GCodeReader::GCodeLi
|
||||
_processM108orM135(line);
|
||||
break;
|
||||
}
|
||||
case 401: // Repetier: Store x, y and z position
|
||||
{
|
||||
_processM401(line);
|
||||
break;
|
||||
}
|
||||
case 402: // Repetier: Go to stored position
|
||||
{
|
||||
_processM402(line);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
break;
|
||||
@ -433,12 +444,6 @@ void GCodeAnalyzer::_processM83(const GCodeReader::GCodeLine& line)
|
||||
_set_e_local_positioning_type(Relative);
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_processM600(const GCodeReader::GCodeLine& line)
|
||||
{
|
||||
m_state.cur_cp_color_id++;
|
||||
_set_cp_color_id(m_state.cur_cp_color_id);
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_processM108orM135(const GCodeReader::GCodeLine& line)
|
||||
{
|
||||
// These M-codes are used by MakerWare and Sailfish to change active tool.
|
||||
@ -458,6 +463,66 @@ void GCodeAnalyzer::_processM108orM135(const GCodeReader::GCodeLine& line)
|
||||
}
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_processM401(const GCodeReader::GCodeLine& line)
|
||||
{
|
||||
if (m_gcode_flavor != gcfRepetier)
|
||||
return;
|
||||
|
||||
for (unsigned char a = 0; a <= 3; ++a)
|
||||
{
|
||||
_set_cached_position(a, _get_axis_position((EAxis)a));
|
||||
}
|
||||
_set_cached_position(4, _get_feedrate());
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_processM402(const GCodeReader::GCodeLine& line)
|
||||
{
|
||||
if (m_gcode_flavor != gcfRepetier)
|
||||
return;
|
||||
|
||||
// see for reference:
|
||||
// https://github.com/repetier/Repetier-Firmware/blob/master/src/ArduinoAVR/Repetier/Printer.cpp
|
||||
// void Printer::GoToMemoryPosition(bool x, bool y, bool z, bool e, float feed)
|
||||
|
||||
bool has_xyz = !(line.has_x() || line.has_y() || line.has_z());
|
||||
|
||||
float p = FLT_MAX;
|
||||
for (unsigned char a = X; a <= Z; ++a)
|
||||
{
|
||||
if (has_xyz || line.has(a))
|
||||
{
|
||||
p = _get_cached_position(a);
|
||||
if (p != FLT_MAX)
|
||||
_set_axis_position((EAxis)a, p);
|
||||
}
|
||||
}
|
||||
|
||||
p = _get_cached_position(E);
|
||||
if (p != FLT_MAX)
|
||||
_set_axis_position(E, p);
|
||||
|
||||
p = FLT_MAX;
|
||||
if (!line.has_value(4, p))
|
||||
p = _get_cached_position(4);
|
||||
|
||||
if (p != FLT_MAX)
|
||||
_set_feedrate(p);
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_reset_cached_position()
|
||||
{
|
||||
for (unsigned char a = 0; a <= 4; ++a)
|
||||
{
|
||||
m_state.cached_position[a] = FLT_MAX;
|
||||
}
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_processM600(const GCodeReader::GCodeLine& line)
|
||||
{
|
||||
m_state.cur_cp_color_id++;
|
||||
_set_cp_color_id(m_state.cur_cp_color_id);
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_processT(const std::string& cmd)
|
||||
{
|
||||
if (cmd.length() > 1)
|
||||
@ -668,6 +733,17 @@ const Vec3d& GCodeAnalyzer::_get_start_position() const
|
||||
return m_state.start_position;
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_set_cached_position(unsigned char axis, float position)
|
||||
{
|
||||
if ((0 <= axis) || (axis <= 4))
|
||||
m_state.cached_position[axis] = position;
|
||||
}
|
||||
|
||||
float GCodeAnalyzer::_get_cached_position(unsigned char axis) const
|
||||
{
|
||||
return ((0 <= axis) || (axis <= 4)) ? m_state.cached_position[axis] : FLT_MAX;
|
||||
}
|
||||
|
||||
void GCodeAnalyzer::_set_start_extrusion(float extrusion)
|
||||
{
|
||||
m_state.start_extrusion = extrusion;
|
||||
|
@ -96,6 +96,7 @@ private:
|
||||
EPositioningType e_local_positioning_type;
|
||||
Metadata data;
|
||||
Vec3d start_position = Vec3d::Zero();
|
||||
float cached_position[5]{ FLT_MAX, FLT_MAX, FLT_MAX, FLT_MAX, FLT_MAX };
|
||||
float start_extrusion;
|
||||
float position[Num_Axis];
|
||||
unsigned int cur_cp_color_id = 0;
|
||||
@ -170,6 +171,12 @@ private:
|
||||
// Set tool (MakerWare and Sailfish flavor)
|
||||
void _processM108orM135(const GCodeReader::GCodeLine& line);
|
||||
|
||||
// Repetier: Store x, y and z position
|
||||
void _processM401(const GCodeReader::GCodeLine& line);
|
||||
|
||||
// Repetier: Go to stored position
|
||||
void _processM402(const GCodeReader::GCodeLine& line);
|
||||
|
||||
// Set color change
|
||||
void _processM600(const GCodeReader::GCodeLine& line);
|
||||
|
||||
@ -232,6 +239,11 @@ private:
|
||||
void _set_start_position(const Vec3d& position);
|
||||
const Vec3d& _get_start_position() const;
|
||||
|
||||
void _set_cached_position(unsigned char axis, float position);
|
||||
float _get_cached_position(unsigned char axis) const;
|
||||
|
||||
void _reset_cached_position();
|
||||
|
||||
void _set_start_extrusion(float extrusion);
|
||||
float _get_start_extrusion() const;
|
||||
float _get_delta_extrusion() const;
|
||||
|
Loading…
Reference in New Issue
Block a user