Mirrors_Framework/grblHAL
1
0
Fork 0
mirror of https://github.com/grblHAL/core.git synced 2026-09-22 19:43:43 +08:00
Code Issues Actions Packages Projects Releases Wiki Activity

Add ability to insert parameters in MSG comments

Browse Source
This commit is contained in:
skasti
2024-09-25 06:31:34 +02:00
parent 3ef6763cec
commit d480ccaf51
1 changed files with 39 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
gcode.c
+39 -3
View File
@@ -595,13 +595,49 @@ char *gc_normalize_block (char *block, char **message)
size_t len = s1 - comment - 4;
if(message && *message == NULL && !strncmp(comment, "(MSG,", 5) && (*message = malloc(len))) {
float value;
char *s3;
uint_fast8_t char_counter = 0;
len = 0;
comment += 5;
// Trim leading spaces
while(*comment == ' ') {
while(*comment == ' ')
comment++;
len--;
// Calculate length of substituted string
while((c = comment[char_counter++])) {
if(c == '#') {
char_counter--;
if(read_parameter(comment, &char_counter, &value) == Status_OK)
len += strlen(trim_float(ftoa(value, ngc_float_decimals())));
else
len += 3; // "N/A"
} else
len++;
}
// Perform substitution
if((s3 = *message = malloc(len + 1))) {
*s3 = '\0';
char_counter = 0;
while((c = comment[char_counter++])) {
if(c == '#') {
char_counter--;
if(read_parameter(comment, &char_counter, &value) == Status_OK)
strcat(s3, trim_float(ftoa(value, ngc_float_decimals())));
else
strcat(s3, "N/A");
s3 = strchr(s3, '\0');
} else {
*s3++ = c;
*s3 = '\0';
}
}
}
memcpy(*message, comment, len);
}
#if NGC_EXPRESSIONS_ENABLE