2017-04-26 12:24:31 +00:00
|
|
|
#include "GCodeReader.hpp"
|
|
|
|
#include <boost/algorithm/string/classification.hpp>
|
|
|
|
#include <boost/algorithm/string/split.hpp>
|
2020-09-09 13:03:51 +00:00
|
|
|
#if ENABLE_GCODE_VIEWER
|
|
|
|
#include <boost/nowide/fstream.hpp>
|
|
|
|
#endif // ENABLE_GCODE_VIEWER
|
2017-04-26 12:24:31 +00:00
|
|
|
#include <fstream>
|
|
|
|
#include <iostream>
|
2019-01-17 12:49:10 +00:00
|
|
|
#include <iomanip>
|
2017-04-26 12:24:31 +00:00
|
|
|
|
2018-01-03 16:29:49 +00:00
|
|
|
#include <Shiny/Shiny.h>
|
|
|
|
|
2017-04-26 12:24:31 +00:00
|
|
|
namespace Slic3r {
|
|
|
|
|
2017-10-17 14:01:18 +00:00
|
|
|
void GCodeReader::apply_config(const GCodeConfig &config)
|
|
|
|
{
|
|
|
|
m_config = config;
|
|
|
|
m_extrusion_axis = m_config.get_extrusion_axis()[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
void GCodeReader::apply_config(const DynamicPrintConfig &config)
|
2017-04-26 12:24:31 +00:00
|
|
|
{
|
2017-06-30 15:05:58 +00:00
|
|
|
m_config.apply(config, true);
|
|
|
|
m_extrusion_axis = m_config.get_extrusion_axis()[0];
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
|
|
|
|
2018-01-03 16:29:49 +00:00
|
|
|
const char* GCodeReader::parse_line_internal(const char *ptr, GCodeLine &gline, std::pair<const char*, const char*> &command)
|
|
|
|
{
|
|
|
|
PROFILE_FUNC();
|
2017-04-26 12:24:31 +00:00
|
|
|
|
|
|
|
// command and args
|
2018-01-03 16:29:49 +00:00
|
|
|
const char *c = ptr;
|
2017-04-26 12:24:31 +00:00
|
|
|
{
|
2018-01-03 16:29:49 +00:00
|
|
|
PROFILE_BLOCK(command_and_args);
|
|
|
|
// Skip the whitespaces.
|
|
|
|
command.first = skip_whitespaces(c);
|
|
|
|
// Skip the command.
|
|
|
|
c = command.second = skip_word(command.first);
|
|
|
|
// Up to the end of line or comment.
|
|
|
|
while (! is_end_of_gcode_line(*c)) {
|
|
|
|
// Skip whitespaces.
|
|
|
|
c = skip_whitespaces(c);
|
|
|
|
if (is_end_of_gcode_line(*c))
|
|
|
|
break;
|
|
|
|
// Check the name of the axis.
|
2020-03-21 09:09:33 +00:00
|
|
|
Axis axis = NUM_AXES_WITH_UNKNOWN;
|
2018-01-03 16:29:49 +00:00
|
|
|
switch (*c) {
|
|
|
|
case 'X': axis = X; break;
|
|
|
|
case 'Y': axis = Y; break;
|
|
|
|
case 'Z': axis = Z; break;
|
|
|
|
case 'F': axis = F; break;
|
|
|
|
default:
|
|
|
|
if (*c == m_extrusion_axis)
|
|
|
|
axis = E;
|
2020-03-21 09:09:33 +00:00
|
|
|
else if (*c >= 'A' && *c <= 'Z')
|
|
|
|
// Unknown axis, but we still want to remember that such a axis was seen.
|
|
|
|
axis = UNKNOWN_AXIS;
|
2018-01-03 16:29:49 +00:00
|
|
|
break;
|
|
|
|
}
|
2020-03-21 09:09:33 +00:00
|
|
|
if (axis != NUM_AXES_WITH_UNKNOWN) {
|
2018-01-03 16:29:49 +00:00
|
|
|
// Try to parse the numeric value.
|
|
|
|
char *pend = nullptr;
|
|
|
|
double v = strtod(++ c, &pend);
|
|
|
|
if (pend != nullptr && is_end_of_word(*pend)) {
|
|
|
|
// The axis value has been parsed correctly.
|
2020-03-21 09:09:33 +00:00
|
|
|
if (axis != UNKNOWN_AXIS)
|
|
|
|
gline.m_axis[int(axis)] = float(v);
|
2018-01-03 16:29:49 +00:00
|
|
|
gline.m_mask |= 1 << int(axis);
|
|
|
|
c = pend;
|
|
|
|
} else
|
|
|
|
// Skip the rest of the word.
|
|
|
|
c = skip_word(c);
|
|
|
|
} else
|
|
|
|
// Skip the rest of the word.
|
|
|
|
c = skip_word(c);
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2018-01-03 16:29:49 +00:00
|
|
|
if (gline.has(E) && m_config.use_relative_e_distances)
|
|
|
|
m_position[E] = 0;
|
|
|
|
|
|
|
|
// Skip the rest of the line.
|
|
|
|
for (; ! is_end_of_line(*c); ++ c);
|
|
|
|
|
|
|
|
// Copy the raw string including the comment, without the trailing newlines.
|
|
|
|
if (c > ptr) {
|
|
|
|
PROFILE_BLOCK(copy_raw_string);
|
|
|
|
gline.m_raw.assign(ptr, c);
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
2018-01-03 16:29:49 +00:00
|
|
|
|
|
|
|
// Skip the trailing newlines.
|
|
|
|
if (*c == '\r')
|
|
|
|
++ c;
|
|
|
|
if (*c == '\n')
|
|
|
|
++ c;
|
|
|
|
|
|
|
|
if (m_verbose)
|
|
|
|
std::cout << gline.m_raw << std::endl;
|
|
|
|
|
|
|
|
return c;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GCodeReader::update_coordinates(GCodeLine &gline, std::pair<const char*, const char*> &command)
|
|
|
|
{
|
|
|
|
PROFILE_FUNC();
|
|
|
|
if (*command.first == 'G') {
|
|
|
|
int cmd_len = int(command.second - command.first);
|
|
|
|
if ((cmd_len == 2 && (command.first[1] == '0' || command.first[1] == '1')) ||
|
|
|
|
(cmd_len == 3 && command.first[1] == '9' && command.first[2] == '2')) {
|
|
|
|
for (size_t i = 0; i < NUM_AXES; ++ i)
|
|
|
|
if (gline.has(Axis(i)))
|
2018-09-10 07:11:49 +00:00
|
|
|
m_position[i] = gline.value(Axis(i));
|
2018-01-03 16:29:49 +00:00
|
|
|
}
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-06-30 15:05:58 +00:00
|
|
|
void GCodeReader::parse_file(const std::string &file, callback_t callback)
|
2017-04-26 12:24:31 +00:00
|
|
|
{
|
2020-09-09 13:03:51 +00:00
|
|
|
#if ENABLE_GCODE_VIEWER
|
|
|
|
boost::nowide::ifstream f(file);
|
|
|
|
#else
|
2017-04-26 12:24:31 +00:00
|
|
|
std::ifstream f(file);
|
2020-09-09 13:03:51 +00:00
|
|
|
#endif // ENABLE_GCODE_VIEWER
|
2017-04-26 12:24:31 +00:00
|
|
|
std::string line;
|
2020-07-29 09:13:48 +00:00
|
|
|
#if ENABLE_GCODE_VIEWER
|
|
|
|
m_parsing_file = true;
|
|
|
|
while (m_parsing_file && std::getline(f, line))
|
|
|
|
#else
|
2017-04-26 12:24:31 +00:00
|
|
|
while (std::getline(f, line))
|
2020-07-29 09:13:48 +00:00
|
|
|
#endif // ENABLE_GCODE_VIEWER
|
2017-04-26 12:24:31 +00:00
|
|
|
this->parse_line(line, callback);
|
|
|
|
}
|
|
|
|
|
2018-08-04 15:38:25 +00:00
|
|
|
bool GCodeReader::GCodeLine::has(char axis) const
|
|
|
|
{
|
|
|
|
const char *c = m_raw.c_str();
|
|
|
|
// Skip the whitespaces.
|
|
|
|
c = skip_whitespaces(c);
|
|
|
|
// Skip the command.
|
|
|
|
c = skip_word(c);
|
|
|
|
// Up to the end of line or comment.
|
|
|
|
while (! is_end_of_gcode_line(*c)) {
|
|
|
|
// Skip whitespaces.
|
|
|
|
c = skip_whitespaces(c);
|
|
|
|
if (is_end_of_gcode_line(*c))
|
|
|
|
break;
|
|
|
|
// Check the name of the axis.
|
|
|
|
if (*c == axis)
|
|
|
|
return true;
|
|
|
|
// Skip the rest of the word.
|
|
|
|
c = skip_word(c);
|
|
|
|
}
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2018-01-03 16:29:49 +00:00
|
|
|
bool GCodeReader::GCodeLine::has_value(char axis, float &value) const
|
2017-04-26 12:24:31 +00:00
|
|
|
{
|
2018-01-03 16:29:49 +00:00
|
|
|
const char *c = m_raw.c_str();
|
|
|
|
// Skip the whitespaces.
|
|
|
|
c = skip_whitespaces(c);
|
|
|
|
// Skip the command.
|
|
|
|
c = skip_word(c);
|
|
|
|
// Up to the end of line or comment.
|
|
|
|
while (! is_end_of_gcode_line(*c)) {
|
|
|
|
// Skip whitespaces.
|
|
|
|
c = skip_whitespaces(c);
|
|
|
|
if (is_end_of_gcode_line(*c))
|
|
|
|
break;
|
|
|
|
// Check the name of the axis.
|
|
|
|
if (*c == axis) {
|
|
|
|
// Try to parse the numeric value.
|
|
|
|
char *pend = nullptr;
|
|
|
|
double v = strtod(++ c, &pend);
|
|
|
|
if (pend != nullptr && is_end_of_word(*pend)) {
|
|
|
|
// The axis value has been parsed correctly.
|
|
|
|
value = float(v);
|
|
|
|
return true;
|
|
|
|
}
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
2018-01-03 16:29:49 +00:00
|
|
|
// Skip the rest of the word.
|
|
|
|
c = skip_word(c);
|
|
|
|
}
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
|
|
|
void GCodeReader::GCodeLine::set(const GCodeReader &reader, const Axis axis, const float new_value, const int decimal_digits)
|
|
|
|
{
|
|
|
|
std::ostringstream ss;
|
|
|
|
ss << std::fixed << std::setprecision(decimal_digits) << new_value;
|
|
|
|
|
|
|
|
char match[3] = " X";
|
|
|
|
if (int(axis) < 3)
|
|
|
|
match[1] += int(axis);
|
|
|
|
else if (axis == F)
|
|
|
|
match[1] = 'F';
|
|
|
|
else {
|
|
|
|
assert(axis == E);
|
|
|
|
match[1] = reader.extrusion_axis();
|
|
|
|
}
|
|
|
|
|
|
|
|
if (this->has(axis)) {
|
|
|
|
size_t pos = m_raw.find(match)+2;
|
|
|
|
size_t end = m_raw.find(' ', pos+1);
|
|
|
|
m_raw = m_raw.replace(pos, end-pos, ss.str());
|
|
|
|
} else {
|
|
|
|
size_t pos = m_raw.find(' ');
|
|
|
|
if (pos == std::string::npos)
|
|
|
|
m_raw += std::string(match) + ss.str();
|
|
|
|
else
|
|
|
|
m_raw = m_raw.replace(pos, 0, std::string(match) + ss.str());
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
2018-01-03 16:29:49 +00:00
|
|
|
m_axis[axis] = new_value;
|
|
|
|
m_mask |= 1 << int(axis);
|
2017-04-26 12:24:31 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
}
|