|
|
|
@@ -27,29 +27,61 @@
|
|
|
|
|
For the most part, these functions primarily are called from protocol.c methods. If a
|
|
|
|
|
different style feedback is desired (i.e. JSON), then a user can change these following
|
|
|
|
|
methods to accomodate their needs.
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ESP32 Notes:
|
|
|
|
|
|
|
|
|
|
Major rewrite to fix issues with BlueTooth. As described here there is a
|
|
|
|
|
when you try to send data a single byte at a time using SerialBT.write(...).
|
|
|
|
|
https://github.com/espressif/arduino-esp32/issues/1537
|
|
|
|
|
|
|
|
|
|
A solution is to send messages as a string using SerialBT.print(...). Use
|
|
|
|
|
a short delay after each send. Therefore this file needed to be rewritten
|
|
|
|
|
to work that way. AVR Grbl was written to be super efficient to give it
|
|
|
|
|
good performance. This is far less efficient, but the ESP32 can handle it.
|
|
|
|
|
Do not use this version of the file with AVR Grbl.
|
|
|
|
|
|
|
|
|
|
ESP32 discussion here ... https://github.com/bdring/Grbl_Esp32/issues/3
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include "grbl.h"
|
|
|
|
|
|
|
|
|
|
#define printPgmString Serial.print
|
|
|
|
|
#define PSTR
|
|
|
|
|
#define printString Serial.print
|
|
|
|
|
|
|
|
|
|
// Internal report utilities to reduce flash with repetitive tasks turned into functions.
|
|
|
|
|
void report_util_setting_prefix(uint8_t n) { serial_write('$'); print_uint8_base10(n); serial_write('='); }
|
|
|
|
|
static void report_util_line_feed() { printPgmString(PSTR("\r\n")); }
|
|
|
|
|
static void report_util_feedback_line_feed() { serial_write(']'); report_util_line_feed(); }
|
|
|
|
|
static void report_util_gcode_modes_G() { printPgmString(PSTR(" G")); }
|
|
|
|
|
static void report_util_gcode_modes_M() { printPgmString(PSTR(" M")); }
|
|
|
|
|
// static void report_util_comment_line_feed() { serial_write(')'); report_util_line_feed(); }
|
|
|
|
|
static void report_util_axis_values(float *axis_value) {
|
|
|
|
|
// this is a generic send function that everything should use, so interfaces could be added (Bluetooth, etc)
|
|
|
|
|
void grbl_send(char *text)
|
|
|
|
|
{
|
|
|
|
|
#ifdef ENABLE_BLUETOOTH
|
|
|
|
|
if (SerialBT.hasClient())
|
|
|
|
|
{
|
|
|
|
|
SerialBT.print(text);
|
|
|
|
|
//delay(10); // possible fix for dropped characters
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
Serial.print(text);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// formats axis values into a string and returns that string in rpt
|
|
|
|
|
static void report_util_axis_values(float *axis_value, char *rpt) {
|
|
|
|
|
uint8_t idx;
|
|
|
|
|
char axisVal[10];
|
|
|
|
|
|
|
|
|
|
rpt[0] = '\0';
|
|
|
|
|
|
|
|
|
|
for (idx=0; idx<N_AXIS; idx++) {
|
|
|
|
|
printFloat_CoordValue(axis_value[idx]);
|
|
|
|
|
if (idx < (N_AXIS-1)) { serial_write(','); }
|
|
|
|
|
sprintf(axisVal, "%4.3f", axis_value[idx]);
|
|
|
|
|
strcat(rpt, axisVal);
|
|
|
|
|
|
|
|
|
|
if (idx < (N_AXIS-1))
|
|
|
|
|
{
|
|
|
|
|
strcat(rpt, ",");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void get_state(char *foo)
|
|
|
|
|
{
|
|
|
|
|
// pad them to same length
|
|
|
|
@@ -62,67 +94,8 @@ void get_state(char *foo)
|
|
|
|
|
case STATE_CHECK_MODE: strcpy(foo," Check"); break;
|
|
|
|
|
case STATE_SAFETY_DOOR: strcpy(foo," Door "); break;
|
|
|
|
|
default:strcpy(foo," ? "); break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
static void report_util_setting_string(uint8_t n) {
|
|
|
|
|
serial_write(' ');
|
|
|
|
|
serial_write('(');
|
|
|
|
|
switch(n) {
|
|
|
|
|
case 0: printPgmString(PSTR("stp pulse")); break;
|
|
|
|
|
case 1: printPgmString(PSTR("idl delay")); break;
|
|
|
|
|
case 2: printPgmString(PSTR("stp inv")); break;
|
|
|
|
|
case 3: printPgmString(PSTR("dir inv")); break;
|
|
|
|
|
case 4: printPgmString(PSTR("stp en inv")); break;
|
|
|
|
|
case 5: printPgmString(PSTR("lim inv")); break;
|
|
|
|
|
case 6: printPgmString(PSTR("prb inv")); break;
|
|
|
|
|
case 10: printPgmString(PSTR("rpt")); break;
|
|
|
|
|
case 11: printPgmString(PSTR("jnc dev")); break;
|
|
|
|
|
case 12: printPgmString(PSTR("arc tol")); break;
|
|
|
|
|
case 13: printPgmString(PSTR("rpt inch")); break;
|
|
|
|
|
case 20: printPgmString(PSTR("sft lim")); break;
|
|
|
|
|
case 21: printPgmString(PSTR("hrd lim")); break;
|
|
|
|
|
case 22: printPgmString(PSTR("hm cyc")); break;
|
|
|
|
|
case 23: printPgmString(PSTR("hm dir inv")); break;
|
|
|
|
|
case 24: printPgmString(PSTR("hm feed")); break;
|
|
|
|
|
case 25: printPgmString(PSTR("hm seek")); break;
|
|
|
|
|
case 26: printPgmString(PSTR("hm delay")); break;
|
|
|
|
|
case 27: printPgmString(PSTR("hm pulloff")); break;
|
|
|
|
|
case 30: printPgmString(PSTR("rpm max")); break;
|
|
|
|
|
case 31: printPgmString(PSTR("rpm min")); break;
|
|
|
|
|
case 32: printPgmString(PSTR("laser")); break;
|
|
|
|
|
default:
|
|
|
|
|
n -= AXIS_SETTINGS_START_VAL;
|
|
|
|
|
uint8_t idx = 0;
|
|
|
|
|
while (n >= AXIS_SETTINGS_INCREMENT) {
|
|
|
|
|
n -= AXIS_SETTINGS_INCREMENT;
|
|
|
|
|
idx++;
|
|
|
|
|
}
|
|
|
|
|
serial_write(n+'x');
|
|
|
|
|
switch (idx) {
|
|
|
|
|
case 0: printPgmString(PSTR(":stp/mm")); break;
|
|
|
|
|
case 1: printPgmString(PSTR(":mm/min")); break;
|
|
|
|
|
case 2: printPgmString(PSTR(":mm/s^2")); break;
|
|
|
|
|
case 3: printPgmString(PSTR(":mm max")); break;
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
report_util_comment_line_feed();
|
|
|
|
|
}
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
static void report_util_uint8_setting(uint8_t n, int val) {
|
|
|
|
|
report_util_setting_prefix(n);
|
|
|
|
|
print_uint8_base10(val);
|
|
|
|
|
report_util_line_feed(); // report_util_setting_string(n);
|
|
|
|
|
}
|
|
|
|
|
static void report_util_float_setting(uint8_t n, float val, uint8_t n_decimal) {
|
|
|
|
|
report_util_setting_prefix(n);
|
|
|
|
|
printFloat(val,n_decimal);
|
|
|
|
|
report_util_line_feed(); // report_util_setting_string(n);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Handles the primary confirmation protocol response for streaming interfaces and human-feedback.
|
|
|
|
|
// For every incoming line, this method responds with an 'ok' for a successful command or an
|
|
|
|
@@ -132,13 +105,16 @@ static void report_util_float_setting(uint8_t n, float val, uint8_t n_decimal) {
|
|
|
|
|
// responses.
|
|
|
|
|
void report_status_message(uint8_t status_code)
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
char status[15];
|
|
|
|
|
|
|
|
|
|
switch(status_code) {
|
|
|
|
|
case STATUS_OK: // STATUS_OK
|
|
|
|
|
printPgmString(PSTR("ok\r\n")); break;
|
|
|
|
|
grbl_send("ok\r\n");
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
printPgmString(PSTR("error:"));
|
|
|
|
|
print_uint8_base10(status_code);
|
|
|
|
|
report_util_line_feed();
|
|
|
|
|
sprintf(status, "error:%d\r\n", status_code);
|
|
|
|
|
grbl_send(status);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -147,15 +123,14 @@ void report_status_message(uint8_t status_code)
|
|
|
|
|
// Prints alarm messages.
|
|
|
|
|
void report_alarm_message(uint8_t alarm_code)
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("ALARM:"));
|
|
|
|
|
print_uint8_base10(alarm_code);
|
|
|
|
|
report_util_line_feed();
|
|
|
|
|
char alarm[10];
|
|
|
|
|
|
|
|
|
|
sprintf(alarm, "ALARM:%d\r\n", alarm_code);
|
|
|
|
|
grbl_send(alarm);
|
|
|
|
|
|
|
|
|
|
delay_ms(500); // Force delay to ensure message clears serial write buffer.
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Prints feedback messages. This serves as a centralized method to provide additional
|
|
|
|
|
// user feedback for things that are not of the status/alarm message protocol. These are
|
|
|
|
|
// messages such as setup warnings, switch toggling, and how to exit alarms.
|
|
|
|
@@ -163,45 +138,53 @@ void report_alarm_message(uint8_t alarm_code)
|
|
|
|
|
// is installed, the message number codes are less than zero.
|
|
|
|
|
void report_feedback_message(uint8_t message_code)
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("[MSG:"));
|
|
|
|
|
char msg[40];
|
|
|
|
|
|
|
|
|
|
strcpy(msg, "[MSG:");
|
|
|
|
|
|
|
|
|
|
switch(message_code) {
|
|
|
|
|
case MESSAGE_CRITICAL_EVENT:
|
|
|
|
|
printPgmString(PSTR("Reset to continue")); break;
|
|
|
|
|
strcat(msg, "Reset to continue"); break;
|
|
|
|
|
case MESSAGE_ALARM_LOCK:
|
|
|
|
|
printPgmString(PSTR("'$H'|'$X' to unlock")); break;
|
|
|
|
|
strcat(msg, "'$H'|'$X' to unlock"); break;
|
|
|
|
|
case MESSAGE_ALARM_UNLOCK:
|
|
|
|
|
printPgmString(PSTR("Caution: Unlocked")); break;
|
|
|
|
|
strcat(msg, "Caution: Unlocked"); break;
|
|
|
|
|
case MESSAGE_ENABLED:
|
|
|
|
|
printPgmString(PSTR("Enabled")); break;
|
|
|
|
|
strcat(msg, "Enabled"); break;
|
|
|
|
|
case MESSAGE_DISABLED:
|
|
|
|
|
printPgmString(PSTR("Disabled")); break;
|
|
|
|
|
strcat(msg, "Disabled"); break;
|
|
|
|
|
case MESSAGE_SAFETY_DOOR_AJAR:
|
|
|
|
|
printPgmString(PSTR("Check Door")); break;
|
|
|
|
|
strcat(msg, "Check Door"); break;
|
|
|
|
|
case MESSAGE_CHECK_LIMITS:
|
|
|
|
|
printPgmString(PSTR("Check Limits")); break;
|
|
|
|
|
strcat(msg, "Check Limits"); break;
|
|
|
|
|
case MESSAGE_PROGRAM_END:
|
|
|
|
|
printPgmString(PSTR("Pgm End")); break;
|
|
|
|
|
strcat(msg, "Pgm End"); break;
|
|
|
|
|
case MESSAGE_RESTORE_DEFAULTS:
|
|
|
|
|
printPgmString(PSTR("Restoring defaults")); break;
|
|
|
|
|
strcat(msg, "Restoring defaults"); break;
|
|
|
|
|
case MESSAGE_SPINDLE_RESTORE:
|
|
|
|
|
printPgmString(PSTR("Restoring spindle")); break;
|
|
|
|
|
strcat(msg, "Restoring spindle"); break;
|
|
|
|
|
case MESSAGE_SLEEP_MODE:
|
|
|
|
|
printPgmString(PSTR("Sleeping")); break;
|
|
|
|
|
}
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
strcat(msg, "Sleeping"); break;
|
|
|
|
|
}
|
|
|
|
|
strcat(msg, "]\r\n");
|
|
|
|
|
|
|
|
|
|
grbl_send(msg);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Welcome message
|
|
|
|
|
void report_init_message()
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("\r\nGrbl " GRBL_VERSION " ['$' for help]\r\n"));
|
|
|
|
|
grbl_send("\r\nGrbl " GRBL_VERSION " ['$' for help]\r\n");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Grbl help message
|
|
|
|
|
void report_grbl_help() {
|
|
|
|
|
printPgmString(PSTR("[HLP:$$ $# $G $I $N $x=val $Nx=line $J=line $SLP $C $X $H ~ ! ? ctrl-x]\r\n"));
|
|
|
|
|
#ifdef VERBOSE_HELP
|
|
|
|
|
void report_grbl_help() {
|
|
|
|
|
grbl_send("[HLP:$$ $# $G $I $N $x=val $Nx=line $J=line $SLP $C $X $H ~ ! ? ctrl-x]\r\n");
|
|
|
|
|
#ifdef VERBOSE_HELP
|
|
|
|
|
#ifdef ENABLE_BLUETOOTH
|
|
|
|
|
return; // to much data for BT until fixed
|
|
|
|
|
#endif
|
|
|
|
|
settings_help();
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
@@ -211,253 +194,326 @@ void report_grbl_help() {
|
|
|
|
|
// NOTE: The numbering scheme here must correlate to storing in settings.c
|
|
|
|
|
void report_grbl_settings() {
|
|
|
|
|
// Print Grbl settings.
|
|
|
|
|
report_util_uint8_setting(0,settings.pulse_microseconds);
|
|
|
|
|
report_util_uint8_setting(1,settings.stepper_idle_lock_time);
|
|
|
|
|
report_util_uint8_setting(2,settings.step_invert_mask);
|
|
|
|
|
report_util_uint8_setting(3,settings.dir_invert_mask);
|
|
|
|
|
report_util_uint8_setting(4,bit_istrue(settings.flags,BITFLAG_INVERT_ST_ENABLE));
|
|
|
|
|
report_util_uint8_setting(5,bit_istrue(settings.flags,BITFLAG_INVERT_LIMIT_PINS));
|
|
|
|
|
report_util_uint8_setting(6,bit_istrue(settings.flags,BITFLAG_INVERT_PROBE_PIN));
|
|
|
|
|
report_util_uint8_setting(10,settings.status_report_mask);
|
|
|
|
|
report_util_float_setting(11,settings.junction_deviation,N_DECIMAL_SETTINGVALUE);
|
|
|
|
|
report_util_float_setting(12,settings.arc_tolerance,N_DECIMAL_SETTINGVALUE);
|
|
|
|
|
report_util_uint8_setting(13,bit_istrue(settings.flags,BITFLAG_REPORT_INCHES));
|
|
|
|
|
report_util_uint8_setting(20,bit_istrue(settings.flags,BITFLAG_SOFT_LIMIT_ENABLE));
|
|
|
|
|
report_util_uint8_setting(21,bit_istrue(settings.flags,BITFLAG_HARD_LIMIT_ENABLE));
|
|
|
|
|
report_util_uint8_setting(22,bit_istrue(settings.flags,BITFLAG_HOMING_ENABLE));
|
|
|
|
|
report_util_uint8_setting(23,settings.homing_dir_mask);
|
|
|
|
|
char setting[20];
|
|
|
|
|
char rpt[800];
|
|
|
|
|
|
|
|
|
|
report_util_float_setting(24,settings.homing_feed_rate,N_DECIMAL_SETTINGVALUE);
|
|
|
|
|
report_util_float_setting(25,settings.homing_seek_rate,N_DECIMAL_SETTINGVALUE);
|
|
|
|
|
report_util_uint8_setting(26,settings.homing_debounce_delay);
|
|
|
|
|
report_util_float_setting(27,settings.homing_pulloff,N_DECIMAL_SETTINGVALUE);
|
|
|
|
|
report_util_float_setting(30,settings.rpm_max,N_DECIMAL_RPMVALUE);
|
|
|
|
|
report_util_float_setting(31,settings.rpm_min,N_DECIMAL_RPMVALUE);
|
|
|
|
|
rpt[0] = '\0';
|
|
|
|
|
|
|
|
|
|
sprintf(setting, "$0=%d\r\n", settings.pulse_microseconds); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$1=%d\r\n", settings.stepper_idle_lock_time); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$2=%d\r\n", settings.step_invert_mask); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$3=%d\r\n", settings.dir_invert_mask); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$4=%d\r\n", bit_istrue(settings.flags,BITFLAG_INVERT_ST_ENABLE)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$5=%d\r\n", bit_istrue(settings.flags,BITFLAG_INVERT_LIMIT_PINS)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$6=%d\r\n", bit_istrue(settings.flags,BITFLAG_INVERT_PROBE_PIN)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$10=%d\r\n", settings.status_report_mask); strcat(rpt, setting);
|
|
|
|
|
|
|
|
|
|
sprintf(setting, "$11=%4.3f\r\n", settings.junction_deviation); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$12=%4.3f\r\n", settings.arc_tolerance); strcat(rpt, setting);
|
|
|
|
|
|
|
|
|
|
sprintf(setting, "$13=%d\r\n", bit_istrue(settings.flags,BITFLAG_REPORT_INCHES)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$20=%d\r\n", bit_istrue(settings.flags,BITFLAG_SOFT_LIMIT_ENABLE)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$21=%d\r\n", bit_istrue(settings.flags,BITFLAG_HARD_LIMIT_ENABLE)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$22=%d\r\n", bit_istrue(settings.flags,BITFLAG_HOMING_ENABLE)); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$23=%d\r\n", settings.homing_dir_mask); strcat(rpt, setting);
|
|
|
|
|
|
|
|
|
|
sprintf(setting, "$24=%4.3f\r\n", settings.homing_feed_rate); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$25=%4.3f\r\n", settings.homing_seek_rate); strcat(rpt, setting);
|
|
|
|
|
|
|
|
|
|
sprintf(setting, "$26=%d\r\n", settings.homing_debounce_delay); strcat(rpt, setting);
|
|
|
|
|
|
|
|
|
|
sprintf(setting, "$27=%4.3f\r\n", settings.homing_pulloff); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$30=%4.3f\r\n", settings.rpm_max); strcat(rpt, setting);
|
|
|
|
|
sprintf(setting, "$31=%4.3f\r\n", settings.rpm_min); strcat(rpt, setting);
|
|
|
|
|
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
report_util_uint8_setting(32,bit_istrue(settings.flags,BITFLAG_LASER_MODE));
|
|
|
|
|
sprintf(setting, "$32=%d\r\n", bit_istrue(settings.flags,BITFLAG_LASER_MODE)); strcat(rpt, setting);
|
|
|
|
|
#else
|
|
|
|
|
report_util_uint8_setting(32,0);
|
|
|
|
|
strcat(rpt, "$32=0\r\n");
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// Print axis settings
|
|
|
|
|
uint8_t idx, set_idx;
|
|
|
|
|
uint8_t val = AXIS_SETTINGS_START_VAL;
|
|
|
|
|
for (set_idx=0; set_idx<AXIS_N_SETTINGS; set_idx++) {
|
|
|
|
|
for (idx=0; idx<N_AXIS; idx++) {
|
|
|
|
|
switch (set_idx) {
|
|
|
|
|
case 0: report_util_float_setting(val+idx,settings.steps_per_mm[idx],N_DECIMAL_SETTINGVALUE); break;
|
|
|
|
|
case 1: report_util_float_setting(val+idx,settings.max_rate[idx],N_DECIMAL_SETTINGVALUE); break;
|
|
|
|
|
case 2: report_util_float_setting(val+idx,settings.acceleration[idx]/(60*60),N_DECIMAL_SETTINGVALUE); break;
|
|
|
|
|
case 3: report_util_float_setting(val+idx,-settings.max_travel[idx],N_DECIMAL_SETTINGVALUE); break;
|
|
|
|
|
case 0: sprintf(setting, "$%d=%4.3f\r\n", val+idx, settings.steps_per_mm[idx]); strcat(rpt, setting); break;
|
|
|
|
|
case 1: sprintf(setting, "$%d=%4.3f\r\n", val+idx, settings.max_rate[idx]); strcat(rpt, setting); break;
|
|
|
|
|
case 2: sprintf(setting, "$%d=%4.3f\r\n", val+idx, settings.acceleration[idx]/(60*60)); strcat(rpt, setting); break;
|
|
|
|
|
case 3: sprintf(setting, "$%d=%4.3f\r\n", val+idx, -settings.max_travel[idx]); strcat(rpt, setting); break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
val += AXIS_SETTINGS_INCREMENT;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
grbl_send(rpt);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Prints current probe parameters. Upon a probe command, these parameters are updated upon a
|
|
|
|
|
// successful probe or upon a failed probe with the G38.3 without errors command (if supported).
|
|
|
|
|
// These values are retained until Grbl is power-cycled, whereby they will be re-zeroed.
|
|
|
|
|
void report_probe_parameters()
|
|
|
|
|
{
|
|
|
|
|
// Report in terms of machine position.
|
|
|
|
|
printPgmString(PSTR("[PRB:"));
|
|
|
|
|
float print_position[N_AXIS];
|
|
|
|
|
// Report in terms of machine position.
|
|
|
|
|
float print_position[N_AXIS];
|
|
|
|
|
char probe_rpt[50]; // the probe report we are building here
|
|
|
|
|
char temp[30];
|
|
|
|
|
|
|
|
|
|
strcpy(probe_rpt, "[PRB:"); // initialize the string with the first characters
|
|
|
|
|
|
|
|
|
|
// get the machine position and put them into a string and append to the probe report
|
|
|
|
|
system_convert_array_steps_to_mpos(print_position,sys_probe_position);
|
|
|
|
|
report_util_axis_values(print_position);
|
|
|
|
|
serial_write(':');
|
|
|
|
|
print_uint8_base10(sys.probe_succeeded);
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
report_util_axis_values(print_position, temp);
|
|
|
|
|
strcat(probe_rpt, temp);
|
|
|
|
|
|
|
|
|
|
// add the success indicator and add closing characters
|
|
|
|
|
sprintf(temp, ":%d]\r\n", sys.probe_succeeded);
|
|
|
|
|
strcat(probe_rpt, temp);
|
|
|
|
|
|
|
|
|
|
grbl_send(probe_rpt); // send the report
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Prints Grbl NGC parameters (coordinate offsets, probing)
|
|
|
|
|
void report_ngc_parameters()
|
|
|
|
|
{
|
|
|
|
|
float coord_data[N_AXIS];
|
|
|
|
|
uint8_t coord_select;
|
|
|
|
|
char temp[50];
|
|
|
|
|
char ngc_rpt[400];
|
|
|
|
|
|
|
|
|
|
ngc_rpt[0] = '\0';
|
|
|
|
|
|
|
|
|
|
for (coord_select = 0; coord_select <= SETTING_INDEX_NCOORD; coord_select++) {
|
|
|
|
|
if (!(settings_read_coord_data(coord_select,coord_data))) {
|
|
|
|
|
report_status_message(STATUS_SETTING_READ_FAIL);
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
printPgmString(PSTR("[G"));
|
|
|
|
|
strcat(ngc_rpt, "[G");
|
|
|
|
|
switch (coord_select) {
|
|
|
|
|
case 6: printPgmString(PSTR("28")); break;
|
|
|
|
|
case 7: printPgmString(PSTR("30")); break;
|
|
|
|
|
default: print_uint8_base10(coord_select+54); break; // G54-G59
|
|
|
|
|
}
|
|
|
|
|
serial_write(':');
|
|
|
|
|
report_util_axis_values(coord_data);
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
case 6: strcat(ngc_rpt, "28"); break;
|
|
|
|
|
case 7: strcat(ngc_rpt, "30"); break;
|
|
|
|
|
default:
|
|
|
|
|
sprintf(temp, "%d", coord_select+54);
|
|
|
|
|
strcat(ngc_rpt, temp);
|
|
|
|
|
break; // G54-G59
|
|
|
|
|
}
|
|
|
|
|
strcat(ngc_rpt, ":");
|
|
|
|
|
report_util_axis_values(coord_data, temp);
|
|
|
|
|
strcat(ngc_rpt, temp);
|
|
|
|
|
strcat(ngc_rpt, "]\r\n");
|
|
|
|
|
}
|
|
|
|
|
printPgmString(PSTR("[G92:")); // Print G92,G92.1 which are not persistent in memory
|
|
|
|
|
report_util_axis_values(gc_state.coord_offset);
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
printPgmString(PSTR("[TLO:")); // Print tool length offset value
|
|
|
|
|
printFloat_CoordValue(gc_state.tool_length_offset);
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
report_probe_parameters(); // Print probe parameters. Not persistent in memory.
|
|
|
|
|
|
|
|
|
|
strcat(ngc_rpt, "[G92:"); // Print G92,G92.1 which are not persistent in memory
|
|
|
|
|
report_util_axis_values(gc_state.coord_offset, temp);
|
|
|
|
|
strcat(ngc_rpt, temp);
|
|
|
|
|
strcat(ngc_rpt, "]\r\n");
|
|
|
|
|
strcat(ngc_rpt, "[TLO:"); // Print tool length offset value
|
|
|
|
|
|
|
|
|
|
if (bit_istrue(settings.flags,BITFLAG_REPORT_INCHES)) {
|
|
|
|
|
sprintf(temp, "%4.3f]\r\n", gc_state.tool_length_offset * INCH_PER_MM);
|
|
|
|
|
} else {
|
|
|
|
|
sprintf(temp, "%4.3f]\r\n", gc_state.tool_length_offset);
|
|
|
|
|
}
|
|
|
|
|
strcat(ngc_rpt, temp);
|
|
|
|
|
|
|
|
|
|
grbl_send(ngc_rpt);
|
|
|
|
|
|
|
|
|
|
report_probe_parameters(); // TDO ======================= Print probe parameters. Not persistent in memory.
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Print current gcode parser mode state
|
|
|
|
|
void report_gcode_modes()
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("[GC:G"));
|
|
|
|
|
char temp[20];
|
|
|
|
|
char modes_rpt[75];
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
strcpy(modes_rpt, "[GC:G");
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (gc_state.modal.motion >= MOTION_MODE_PROBE_TOWARD) {
|
|
|
|
|
printPgmString(PSTR("38."));
|
|
|
|
|
print_uint8_base10(gc_state.modal.motion - (MOTION_MODE_PROBE_TOWARD-2));
|
|
|
|
|
sprintf(temp, "38.%d", gc_state.modal.motion - (MOTION_MODE_PROBE_TOWARD-2));
|
|
|
|
|
} else {
|
|
|
|
|
print_uint8_base10(gc_state.modal.motion);
|
|
|
|
|
sprintf(temp, "%d", gc_state.modal.motion);
|
|
|
|
|
}
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_G();
|
|
|
|
|
print_uint8_base10(gc_state.modal.coord_select+54);
|
|
|
|
|
sprintf(temp, " G%d", gc_state.modal.coord_select+54);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
sprintf(temp, " G%d", gc_state.modal.plane_select+17);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_G();
|
|
|
|
|
print_uint8_base10(gc_state.modal.plane_select+17);
|
|
|
|
|
sprintf(temp, " G%d", 21-gc_state.modal.units);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_G();
|
|
|
|
|
print_uint8_base10(21-gc_state.modal.units);
|
|
|
|
|
sprintf(temp, " G%d", gc_state.modal.distance+90);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_G();
|
|
|
|
|
print_uint8_base10(gc_state.modal.distance+90);
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_G();
|
|
|
|
|
print_uint8_base10(94-gc_state.modal.feed_rate);
|
|
|
|
|
sprintf(temp, " G%d", 94-gc_state.modal.feed_rate);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (gc_state.modal.program_flow) {
|
|
|
|
|
report_util_gcode_modes_M();
|
|
|
|
|
//report_util_gcode_modes_M();
|
|
|
|
|
switch (gc_state.modal.program_flow) {
|
|
|
|
|
case PROGRAM_FLOW_PAUSED : serial_write('0'); break;
|
|
|
|
|
case PROGRAM_FLOW_PAUSED : strcat(modes_rpt, " M0"); //serial_write('0'); break;
|
|
|
|
|
// case PROGRAM_FLOW_OPTIONAL_STOP : serial_write('1'); break; // M1 is ignored and not supported.
|
|
|
|
|
case PROGRAM_FLOW_COMPLETED_M2 :
|
|
|
|
|
case PROGRAM_FLOW_COMPLETED_M30 :
|
|
|
|
|
print_uint8_base10(gc_state.modal.program_flow);
|
|
|
|
|
sprintf(temp, " M%d", gc_state.modal.program_flow);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_M();
|
|
|
|
|
|
|
|
|
|
switch (gc_state.modal.spindle) {
|
|
|
|
|
case SPINDLE_ENABLE_CW : serial_write('3'); break;
|
|
|
|
|
case SPINDLE_ENABLE_CCW : serial_write('4'); break;
|
|
|
|
|
case SPINDLE_DISABLE : serial_write('5'); break;
|
|
|
|
|
case SPINDLE_ENABLE_CW : strcat(modes_rpt, " M3"); break;
|
|
|
|
|
case SPINDLE_ENABLE_CCW : strcat(modes_rpt, " M4"); break;
|
|
|
|
|
case SPINDLE_DISABLE : strcat(modes_rpt, " M5"); break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
report_util_gcode_modes_M();
|
|
|
|
|
//report_util_gcode_modes_M();
|
|
|
|
|
#ifdef ENABLE_M7
|
|
|
|
|
if (gc_state.modal.coolant) { // Note: Multiple coolant states may be active at the same time.
|
|
|
|
|
if (gc_state.modal.coolant & PL_COND_FLAG_COOLANT_MIST) { serial_write('7'); }
|
|
|
|
|
if (gc_state.modal.coolant & PL_COND_FLAG_COOLANT_FLOOD) { serial_write('8'); }
|
|
|
|
|
} else { serial_write('9'); }
|
|
|
|
|
if (gc_state.modal.coolant & PL_COND_FLAG_COOLANT_MIST) { strcat(modes_rpt, " M7"); }
|
|
|
|
|
if (gc_state.modal.coolant & PL_COND_FLAG_COOLANT_FLOOD) { strcat(modes_rpt, " M8"); }
|
|
|
|
|
} else { strcat(modes_rpt, " M9"); }
|
|
|
|
|
#else
|
|
|
|
|
if (gc_state.modal.coolant) { serial_write('8'); }
|
|
|
|
|
else { serial_write('9'); }
|
|
|
|
|
if (gc_state.modal.coolant) { strcat(modes_rpt, " M8"); }
|
|
|
|
|
else { strcat(modes_rpt, " M9"); }
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
printPgmString(PSTR(" T"));
|
|
|
|
|
print_uint8_base10(gc_state.tool);
|
|
|
|
|
sprintf(temp, " T%d", gc_state.tool);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
printPgmString(PSTR(" F"));
|
|
|
|
|
printFloat_RateValue(gc_state.feed_rate);
|
|
|
|
|
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
printPgmString(PSTR(" S"));
|
|
|
|
|
printFloat(gc_state.spindle_speed,N_DECIMAL_RPMVALUE);
|
|
|
|
|
sprintf(temp, " F%4.3f", gc_state.feed_rate);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
sprintf(temp, " S%4.3f", gc_state.spindle_speed);
|
|
|
|
|
strcat(modes_rpt, temp);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
strcat(modes_rpt, "]\r\n");
|
|
|
|
|
|
|
|
|
|
grbl_send(modes_rpt);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Prints specified startup line
|
|
|
|
|
void report_startup_line(uint8_t n, char *line)
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("$N"));
|
|
|
|
|
print_uint8_base10(n);
|
|
|
|
|
serial_write('=');
|
|
|
|
|
printString(line);
|
|
|
|
|
report_util_line_feed();
|
|
|
|
|
char temp[80];
|
|
|
|
|
|
|
|
|
|
sprintf(temp, "$N%d=%s\r\n", n, line);
|
|
|
|
|
|
|
|
|
|
grbl_send(temp);
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void report_execute_startup_message(char *line, uint8_t status_code)
|
|
|
|
|
{
|
|
|
|
|
serial_write('>');
|
|
|
|
|
printString(line);
|
|
|
|
|
serial_write(':');
|
|
|
|
|
report_status_message(status_code);
|
|
|
|
|
char temp[80];
|
|
|
|
|
|
|
|
|
|
sprintf(temp, ">%s:", line);
|
|
|
|
|
grbl_send(temp);
|
|
|
|
|
|
|
|
|
|
report_status_message(status_code); // TODO ======================================
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Prints build info line
|
|
|
|
|
void report_build_info(char *line)
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("[VER:" GRBL_VERSION "." GRBL_VERSION_BUILD ":"));
|
|
|
|
|
printString(line);
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
printPgmString(PSTR("[OPT:")); // Generate compile-time build option list
|
|
|
|
|
char build_info[50];
|
|
|
|
|
|
|
|
|
|
strcpy(build_info, "[VER:" GRBL_VERSION "." GRBL_VERSION_BUILD ":");
|
|
|
|
|
strcat(build_info, line);
|
|
|
|
|
strcat(build_info, "]\r\n[OPT:");
|
|
|
|
|
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
serial_write('V');
|
|
|
|
|
strcat(build_info,"V");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef USE_LINE_NUMBERS
|
|
|
|
|
serial_write('N');
|
|
|
|
|
strcat(build_info,"N");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef ENABLE_M7
|
|
|
|
|
serial_write('M');
|
|
|
|
|
strcat(build_info,"M");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef COREXY
|
|
|
|
|
serial_write('C');
|
|
|
|
|
strcat(build_info,"C");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef PARKING_ENABLE
|
|
|
|
|
serial_write('P');
|
|
|
|
|
strcat(build_info,"P");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef HOMING_FORCE_SET_ORIGIN
|
|
|
|
|
serial_write('Z');
|
|
|
|
|
strcat(build_info,"Z");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef HOMING_SINGLE_AXIS_COMMANDS
|
|
|
|
|
serial_write('H');
|
|
|
|
|
strcat(build_info,"H");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef LIMITS_TWO_SWITCHES_ON_AXES
|
|
|
|
|
serial_write('L');
|
|
|
|
|
strcat(build_info,"L");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef ALLOW_FEED_OVERRIDE_DURING_PROBE_CYCLES
|
|
|
|
|
serial_write('A');
|
|
|
|
|
strcat(build_info,"A");
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef ENABLE_BLUETOOTH
|
|
|
|
|
strcat(build_info,"B");
|
|
|
|
|
#endif
|
|
|
|
|
#ifndef ENABLE_RESTORE_EEPROM_WIPE_ALL // NOTE: Shown when disabled.
|
|
|
|
|
serial_write('*');
|
|
|
|
|
strcat(build_info,"*");
|
|
|
|
|
#endif
|
|
|
|
|
#ifndef ENABLE_RESTORE_EEPROM_DEFAULT_SETTINGS // NOTE: Shown when disabled.
|
|
|
|
|
serial_write('$');
|
|
|
|
|
strcat(build_info,"$");
|
|
|
|
|
#endif
|
|
|
|
|
#ifndef ENABLE_RESTORE_EEPROM_CLEAR_PARAMETERS // NOTE: Shown when disabled.
|
|
|
|
|
serial_write('#');
|
|
|
|
|
strcat(build_info,"#");
|
|
|
|
|
#endif
|
|
|
|
|
#ifndef ENABLE_BUILD_INFO_WRITE_COMMAND // NOTE: Shown when disabled.
|
|
|
|
|
serial_write('I');
|
|
|
|
|
strcat(build_info,"I");
|
|
|
|
|
#endif
|
|
|
|
|
#ifndef FORCE_BUFFER_SYNC_DURING_EEPROM_WRITE // NOTE: Shown when disabled.
|
|
|
|
|
serial_write('E');
|
|
|
|
|
strcat(build_info,"E");
|
|
|
|
|
#endif
|
|
|
|
|
#ifndef FORCE_BUFFER_SYNC_DURING_WCO_CHANGE // NOTE: Shown when disabled.
|
|
|
|
|
serial_write('W');
|
|
|
|
|
strcat(build_info,"W");
|
|
|
|
|
#endif
|
|
|
|
|
// NOTE: Compiled values, like override increments/max/min values, may be added at some point later.
|
|
|
|
|
// These will likely have a comma delimiter to separate them.
|
|
|
|
|
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
|
|
|
|
|
strcat(build_info,"]\r\n");
|
|
|
|
|
grbl_send(build_info);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Prints the character string line Grbl has received from the user, which has been pre-parsed,
|
|
|
|
|
// and has been sent into protocol_execute_line() routine to be executed by Grbl.
|
|
|
|
|
void report_echo_line_received(char *line)
|
|
|
|
|
{
|
|
|
|
|
printPgmString(PSTR("[echo: ")); printString(line);
|
|
|
|
|
report_util_feedback_line_feed();
|
|
|
|
|
char temp[80];
|
|
|
|
|
|
|
|
|
|
sprintf(temp, "[echo: %s]\r\n", line);
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//--------------------------------------------- Converted up to here ---------------------------------------------------------------------
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Prints real-time data. This function grabs a real-time snapshot of the stepper subprogram
|
|
|
|
|
// and the actual location of the CNC machine. Users may change the following function to their
|
|
|
|
@@ -470,42 +526,46 @@ void report_realtime_status()
|
|
|
|
|
int32_t current_position[N_AXIS]; // Copy current state of the system position variable
|
|
|
|
|
memcpy(current_position,sys_position,sizeof(sys_position));
|
|
|
|
|
float print_position[N_AXIS];
|
|
|
|
|
|
|
|
|
|
char status[200];
|
|
|
|
|
char temp[50];
|
|
|
|
|
|
|
|
|
|
system_convert_array_steps_to_mpos(print_position,current_position);
|
|
|
|
|
|
|
|
|
|
// Report current machine state and sub-states
|
|
|
|
|
serial_write('<');
|
|
|
|
|
// Report current machine state and sub-states
|
|
|
|
|
strcpy(status, "<");
|
|
|
|
|
switch (sys.state) {
|
|
|
|
|
case STATE_IDLE: printPgmString(("Idle")); break;
|
|
|
|
|
case STATE_CYCLE: printPgmString(PSTR("Run")); break;
|
|
|
|
|
case STATE_IDLE: strcat(status, "Idle"); break;
|
|
|
|
|
case STATE_CYCLE: strcat(status, "Run"); break;
|
|
|
|
|
case STATE_HOLD:
|
|
|
|
|
|
|
|
|
|
if (!(sys.suspend & SUSPEND_JOG_CANCEL)) {
|
|
|
|
|
printPgmString(PSTR("Hold:"));
|
|
|
|
|
if (sys.suspend & SUSPEND_HOLD_COMPLETE) { serial_write('0'); } // Ready to resume
|
|
|
|
|
else { serial_write('1'); } // Actively holding
|
|
|
|
|
strcat(status, "Hold:");
|
|
|
|
|
if (sys.suspend & SUSPEND_HOLD_COMPLETE) { strcat(status, "0"); } // Ready to resume
|
|
|
|
|
else { strcat(status, "1"); } // Actively holding
|
|
|
|
|
break;
|
|
|
|
|
} // Continues to print jog state during jog cancel.
|
|
|
|
|
case STATE_JOG: printPgmString(PSTR("Jog")); break;
|
|
|
|
|
case STATE_HOMING: printPgmString(PSTR("Home")); break;
|
|
|
|
|
case STATE_ALARM: printPgmString(PSTR("Alarm")); break;
|
|
|
|
|
case STATE_CHECK_MODE: printPgmString(PSTR("Check")); break;
|
|
|
|
|
case STATE_JOG: strcat(status, "Jog"); break;
|
|
|
|
|
case STATE_HOMING: strcat(status, "Home"); break;
|
|
|
|
|
case STATE_ALARM: strcat(status, "Alarm"); break;
|
|
|
|
|
case STATE_CHECK_MODE: strcat(status, "Check"); break;
|
|
|
|
|
case STATE_SAFETY_DOOR:
|
|
|
|
|
printPgmString(PSTR("Door:"));
|
|
|
|
|
strcat(status, "Door:");
|
|
|
|
|
if (sys.suspend & SUSPEND_INITIATE_RESTORE) {
|
|
|
|
|
serial_write('3'); // Restoring
|
|
|
|
|
strcat(status, "3"); // Restoring
|
|
|
|
|
} else {
|
|
|
|
|
if (sys.suspend & SUSPEND_RETRACT_COMPLETE) {
|
|
|
|
|
if (sys.suspend & SUSPEND_SAFETY_DOOR_AJAR) {
|
|
|
|
|
serial_write('1'); // Door ajar
|
|
|
|
|
strcat(status, "1"); // Door ajar
|
|
|
|
|
} else {
|
|
|
|
|
serial_write('0');
|
|
|
|
|
strcat(status, "0");
|
|
|
|
|
} // Door closed and ready to resume
|
|
|
|
|
} else {
|
|
|
|
|
serial_write('2'); // Retracting
|
|
|
|
|
strcat(status, "2"); // Retracting
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
case STATE_SLEEP: printPgmString(PSTR("Sleep")); break;
|
|
|
|
|
case STATE_SLEEP: strcat(status, "Sleep"); break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
float wco[N_AXIS];
|
|
|
|
@@ -523,19 +583,18 @@ void report_realtime_status()
|
|
|
|
|
|
|
|
|
|
// Report machine position
|
|
|
|
|
if (bit_istrue(settings.status_report_mask,BITFLAG_RT_STATUS_POSITION_TYPE)) {
|
|
|
|
|
printPgmString(PSTR("|MPos:"));
|
|
|
|
|
strcat(status, "|MPos:");
|
|
|
|
|
} else {
|
|
|
|
|
printPgmString(PSTR("|WPos:"));
|
|
|
|
|
strcat(status, "|WPos:");
|
|
|
|
|
}
|
|
|
|
|
report_util_axis_values(print_position);
|
|
|
|
|
report_util_axis_values(print_position, temp);
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
|
|
|
|
|
// Returns planner and serial read buffer states.
|
|
|
|
|
#ifdef REPORT_FIELD_BUFFER_STATE
|
|
|
|
|
if (bit_istrue(settings.status_report_mask,BITFLAG_RT_STATUS_BUFFER_STATE)) {
|
|
|
|
|
printPgmString(PSTR("|Bf:"));
|
|
|
|
|
print_uint8_base10(plan_get_block_buffer_available());
|
|
|
|
|
serial_write(',');
|
|
|
|
|
print_uint8_base10(serial_get_rx_buffer_available());
|
|
|
|
|
if (bit_istrue(settings.status_report_mask,BITFLAG_RT_STATUS_BUFFER_STATE)) {
|
|
|
|
|
sprintf(temp, "|Bf:%d,%d", plan_get_block_buffer_available(), serial_get_rx_buffer_available());
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
@@ -546,8 +605,8 @@ void report_realtime_status()
|
|
|
|
|
if (cur_block != NULL) {
|
|
|
|
|
uint32_t ln = cur_block->line_number;
|
|
|
|
|
if (ln > 0) {
|
|
|
|
|
printPgmString(PSTR("|Ln:"));
|
|
|
|
|
printInteger(ln);
|
|
|
|
|
sprintf(temp, "|Ln:%d", ln);
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
@@ -555,14 +614,13 @@ void report_realtime_status()
|
|
|
|
|
|
|
|
|
|
// Report realtime feed speed
|
|
|
|
|
#ifdef REPORT_FIELD_CURRENT_FEED_SPEED
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
printPgmString(PSTR("|FS:"));
|
|
|
|
|
printFloat_RateValue(st_get_realtime_rate());
|
|
|
|
|
serial_write(',');
|
|
|
|
|
printFloat(sys.spindle_speed,N_DECIMAL_RPMVALUE);
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
sprintf(temp, "|FS:%4.3f,%4.3f", st_get_realtime_rate(), sys.spindle_speed);
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
#else
|
|
|
|
|
printPgmString(PSTR("|F:"));
|
|
|
|
|
printFloat_RateValue(st_get_realtime_rate());
|
|
|
|
|
|
|
|
|
|
sprintf(temp, "|F:%4.3f", st_get_realtime_rate());
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
#endif
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
@@ -570,30 +628,30 @@ void report_realtime_status()
|
|
|
|
|
uint8_t lim_pin_state = limits_get_state();
|
|
|
|
|
uint8_t ctrl_pin_state = system_control_get_state();
|
|
|
|
|
uint8_t prb_pin_state = probe_get_state();
|
|
|
|
|
if (lim_pin_state | ctrl_pin_state | prb_pin_state) {
|
|
|
|
|
printPgmString(PSTR("|Pn:"));
|
|
|
|
|
if (prb_pin_state) { serial_write('P'); }
|
|
|
|
|
if (lim_pin_state | ctrl_pin_state | prb_pin_state) {
|
|
|
|
|
strcat(status, "|Pn:");
|
|
|
|
|
if (prb_pin_state) { strcat(status, "P"); }
|
|
|
|
|
if (lim_pin_state) {
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(X_AXIS))) { serial_write('X'); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(Y_AXIS))) { serial_write('Y'); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(Z_AXIS))) { serial_write('Z'); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(X_AXIS))) { strcat(status, "X"); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(Y_AXIS))) { strcat(status, "Y"); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(Z_AXIS))) { strcat(status, "Z"); }
|
|
|
|
|
#ifdef A_AXIS
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(A_AXIS))) { serial_write('A'); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(A_AXIS))) { strcat(status, "A"); }
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef B_AXIS
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(B_AXIS))) { serial_write('B'); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(B_AXIS))) { strcat(status, "B"); }
|
|
|
|
|
#endif
|
|
|
|
|
#ifdef C_AXIS
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(C_AXIS))) { serial_write('C'); }
|
|
|
|
|
if (bit_istrue(lim_pin_state,bit(C_AXIS))) { strcat(status, "C"); }
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
if (ctrl_pin_state) {
|
|
|
|
|
#ifdef ENABLE_SAFETY_DOOR_INPUT_PIN
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_SAFETY_DOOR)) { serial_write('D'); }
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_SAFETY_DOOR)) { strcat(status, "D"); }
|
|
|
|
|
#endif
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_RESET)) { serial_write('R'); }
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_FEED_HOLD)) { serial_write('H'); }
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_CYCLE_START)) { serial_write('S'); }
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_RESET)) { strcat(status, "R"); }
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_FEED_HOLD)) { strcat(status, "H"); }
|
|
|
|
|
if (bit_istrue(ctrl_pin_state,CONTROL_PIN_INDEX_CYCLE_START)) { strcat(status, "S"); }
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
@@ -605,8 +663,9 @@ void report_realtime_status()
|
|
|
|
|
sys.report_wco_counter = (REPORT_WCO_REFRESH_BUSY_COUNT-1); // Reset counter for slow refresh
|
|
|
|
|
} else { sys.report_wco_counter = (REPORT_WCO_REFRESH_IDLE_COUNT-1); }
|
|
|
|
|
if (sys.report_ovr_counter == 0) { sys.report_ovr_counter = 1; } // Set override on next report.
|
|
|
|
|
printPgmString(PSTR("|WCO:"));
|
|
|
|
|
report_util_axis_values(wco);
|
|
|
|
|
strcat(status, "|WCO:");
|
|
|
|
|
report_util_axis_values(wco, temp);
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
@@ -615,41 +674,39 @@ void report_realtime_status()
|
|
|
|
|
else {
|
|
|
|
|
if (sys.state & (STATE_HOMING | STATE_CYCLE | STATE_HOLD | STATE_JOG | STATE_SAFETY_DOOR)) {
|
|
|
|
|
sys.report_ovr_counter = (REPORT_OVR_REFRESH_BUSY_COUNT-1); // Reset counter for slow refresh
|
|
|
|
|
} else { sys.report_ovr_counter = (REPORT_OVR_REFRESH_IDLE_COUNT-1); }
|
|
|
|
|
printPgmString(PSTR("|Ov:"));
|
|
|
|
|
print_uint8_base10(sys.f_override);
|
|
|
|
|
serial_write(',');
|
|
|
|
|
print_uint8_base10(sys.r_override);
|
|
|
|
|
serial_write(',');
|
|
|
|
|
print_uint8_base10(sys.spindle_speed_ovr);
|
|
|
|
|
} else { sys.report_ovr_counter = (REPORT_OVR_REFRESH_IDLE_COUNT-1); }
|
|
|
|
|
sprintf(temp, "|Ov:%d,%d,%d", sys.f_override, sys.r_override, sys.spindle_speed_ovr);
|
|
|
|
|
strcat(status, temp);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t sp_state = spindle_get_state();
|
|
|
|
|
uint8_t cl_state = coolant_get_state();
|
|
|
|
|
if (sp_state || cl_state) {
|
|
|
|
|
printPgmString(PSTR("|A:"));
|
|
|
|
|
strcat(status, "|A:");
|
|
|
|
|
if (sp_state) { // != SPINDLE_STATE_DISABLE
|
|
|
|
|
#ifdef VARIABLE_SPINDLE
|
|
|
|
|
#ifdef USE_SPINDLE_DIR_AS_ENABLE_PIN
|
|
|
|
|
serial_write('S'); // CW
|
|
|
|
|
strcat(status, "S"); // CW
|
|
|
|
|
#else
|
|
|
|
|
if (sp_state == SPINDLE_STATE_CW) { serial_write('S'); } // CW
|
|
|
|
|
else { serial_write('C'); } // CCW
|
|
|
|
|
if (sp_state == SPINDLE_STATE_CW) { strcat(status, "S"); } // CW
|
|
|
|
|
else { strcat(status, "C"); } // CCW
|
|
|
|
|
#endif
|
|
|
|
|
#else
|
|
|
|
|
if (sp_state & SPINDLE_STATE_CW) { serial_write('S'); } // CW
|
|
|
|
|
else { serial_write('C'); } // CCW
|
|
|
|
|
if (sp_state & SPINDLE_STATE_CW) { strcat(status, "S"); } // CW
|
|
|
|
|
else { strcat(status, "C"); } // CCW
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
if (cl_state & COOLANT_STATE_FLOOD) { serial_write('F'); }
|
|
|
|
|
if (cl_state & COOLANT_STATE_FLOOD) { strcat(status, "F"); }
|
|
|
|
|
#ifdef ENABLE_M7
|
|
|
|
|
if (cl_state & COOLANT_STATE_MIST) { serial_write('M'); }
|
|
|
|
|
if (cl_state & COOLANT_STATE_MIST) { strcat(status, "M"); }
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
serial_write('>');
|
|
|
|
|
report_util_line_feed();
|
|
|
|
|
strcat(status, ">\r\n");
|
|
|
|
|
|
|
|
|
|
grbl_send(status);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void report_realtime_steps()
|
|
|
|
|