2 This file is part of Smoothie (http://smoothieware.org/). The motion control part is heavily based on Grbl (https://github.com/simen/grbl).
3 Smoothie is free software: you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation, either version 3 of the License, or (at your option) any later version.
4 Smoothie is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.
5 You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>.
9 #include "SimpleShell.h"
10 #include "libs/Kernel.h"
11 #include "libs/nuts_bolts.h"
12 #include "libs/utils.h"
13 #include "libs/SerialMessage.h"
14 #include "libs/StreamOutput.h"
15 #include "modules/robot/Conveyor.h"
16 #include "DirHandle.h"
19 #include "PublicDataRequest.h"
20 #include "AppendFileStream.h"
21 #include "FileStream.h"
22 #include "checksumm.h"
23 #include "PublicData.h"
25 //#include "StepTicker.h"
27 #include "modules/tools/temperaturecontrol/TemperatureControlPublicAccess.h"
28 #include "modules/robot/RobotPublicAccess.h"
29 #include "NetworkPublicAccess.h"
30 #include "platform_memory.h"
31 #include "SwitchPublicAccess.h"
33 #include "Thermistor.h"
35 #include "system_LPC17xx.h"
38 extern unsigned int g_maximumHeapAddress
;
45 extern "C" uint32_t __end__
;
46 extern "C" uint32_t __malloc_free_list
;
47 extern "C" uint32_t _sbrk(int size
);
49 // command lookup table
50 const SimpleShell::ptentry_t
SimpleShell::commands_table
[] = {
51 {"ls", SimpleShell::ls_command
},
52 {"cd", SimpleShell::cd_command
},
53 {"pwd", SimpleShell::pwd_command
},
54 {"cat", SimpleShell::cat_command
},
55 {"rm", SimpleShell::rm_command
},
56 {"mv", SimpleShell::mv_command
},
57 {"upload", SimpleShell::upload_command
},
58 {"reset", SimpleShell::reset_command
},
59 {"dfu", SimpleShell::dfu_command
},
60 {"break", SimpleShell::break_command
},
61 {"help", SimpleShell::help_command
},
62 {"?", SimpleShell::help_command
},
63 {"version", SimpleShell::version_command
},
64 {"mem", SimpleShell::mem_command
},
65 {"get", SimpleShell::get_command
},
66 {"set_temp", SimpleShell::set_temp_command
},
67 {"switch", SimpleShell::switch_command
},
68 {"net", SimpleShell::net_command
},
69 {"load", SimpleShell::load_command
},
70 {"save", SimpleShell::save_command
},
71 {"remount", SimpleShell::remount_command
},
72 {"calc_thermistor", SimpleShell::calc_thermistor_command
},
78 int SimpleShell::reset_delay_secs
= 0;
80 // Adam Greens heap walk from http://mbed.org/forum/mbed/topic/2701/?page=4#comment-22556
81 static uint32_t heapWalk(StreamOutput
*stream
, bool verbose
)
83 uint32_t chunkNumber
= 1;
84 // The __end__ linker symbol points to the beginning of the heap.
85 uint32_t chunkCurr
= (uint32_t)&__end__
;
86 // __malloc_free_list is the head pointer to newlib-nano's link list of free chunks.
87 uint32_t freeCurr
= __malloc_free_list
;
88 // Calling _sbrk() with 0 reserves no more memory but it returns the current top of heap.
89 uint32_t heapEnd
= _sbrk(0);
91 uint32_t freeSize
= 0;
92 uint32_t usedSize
= 0;
94 stream
->printf("Used Heap Size: %lu\n", heapEnd
- chunkCurr
);
96 // Walk through the chunks until we hit the end of the heap.
97 while (chunkCurr
< heapEnd
) {
98 // Assume the chunk is in use. Will update later.
100 // The first 32-bit word in a chunk is the size of the allocation. newlib-nano over allocates by 8 bytes.
101 // 4 bytes for this 32-bit chunk size and another 4 bytes to allow for 8 byte-alignment of returned pointer.
102 uint32_t chunkSize
= *(uint32_t *)chunkCurr
;
103 // The start of the next chunk is right after the end of this one.
104 uint32_t chunkNext
= chunkCurr
+ chunkSize
;
106 // The free list is sorted by address.
107 // Check to see if we have found the next free chunk in the heap.
108 if (chunkCurr
== freeCurr
) {
109 // Chunk is free so flag it as such.
111 // The second 32-bit word in a free chunk is a pointer to the next free chunk (again sorted by address).
112 freeCurr
= *(uint32_t *)(freeCurr
+ 4);
115 // Skip past the 32-bit size field in the chunk header.
117 // 8-byte align the data pointer.
118 chunkCurr
= (chunkCurr
+ 7) & ~7;
119 // newlib-nano over allocates by 8 bytes, 4 bytes for the 32-bit chunk size and another 4 bytes to allow for 8
120 // byte-alignment of the returned pointer.
123 stream
->printf(" Chunk: %lu Address: 0x%08lX Size: %lu %s\n", chunkNumber
, chunkCurr
, chunkSize
, isChunkFree
? "CHUNK FREE" : "");
125 if (isChunkFree
) freeSize
+= chunkSize
;
126 else usedSize
+= chunkSize
;
128 chunkCurr
= chunkNext
;
131 stream
->printf("Allocated: %lu, Free: %lu\r\n", usedSize
, freeSize
);
136 void SimpleShell::on_module_loaded()
138 this->register_for_event(ON_CONSOLE_LINE_RECEIVED
);
139 this->register_for_event(ON_GCODE_RECEIVED
);
140 this->register_for_event(ON_SECOND_TICK
);
142 reset_delay_secs
= 0;
145 void SimpleShell::on_second_tick(void *)
147 // we are timing out for the reset
148 if (reset_delay_secs
> 0) {
149 if (--reset_delay_secs
== 0) {
155 void SimpleShell::on_gcode_received(void *argument
)
157 Gcode
*gcode
= static_cast<Gcode
*>(argument
);
158 string args
= get_arguments(gcode
->get_command());
161 if (gcode
->m
== 20) { // list sd card
162 gcode
->mark_as_taken();
163 gcode
->stream
->printf("Begin file list\r\n");
164 ls_command("/sd", gcode
->stream
);
165 gcode
->stream
->printf("End file list\r\n");
167 } else if (gcode
->m
== 30) { // remove file
168 gcode
->mark_as_taken();
169 rm_command("/sd/" + args
, gcode
->stream
);
171 } else if(gcode
->m
== 501) { // load config override
172 gcode
->mark_as_taken();
174 load_command("/sd/config-override", gcode
->stream
);
176 load_command("/sd/config-override." + args
, gcode
->stream
);
179 } else if(gcode
->m
== 504) { // save to specific config override file
180 gcode
->mark_as_taken();
182 save_command("/sd/config-override", gcode
->stream
);
184 save_command("/sd/config-override." + args
, gcode
->stream
);
190 bool SimpleShell::parse_command(const char *cmd
, string args
, StreamOutput
*stream
)
192 for (const ptentry_t
*p
= commands_table
; p
->command
!= NULL
; ++p
) {
193 if (strncasecmp(cmd
, p
->command
, strlen(p
->command
)) == 0) {
194 p
->func(args
, stream
);
202 // When a new line is received, check if it is a command, and if it is, act upon it
203 void SimpleShell::on_console_line_received( void *argument
)
205 SerialMessage new_message
= *static_cast<SerialMessage
*>(argument
);
207 // ignore comments and blank lines and if this is a G code then also ignore it
208 char first_char
= new_message
.message
[0];
209 if(strchr(";( \n\rGMTN", first_char
) != NULL
) return;
211 string possible_command
= new_message
.message
;
213 //new_message.stream->printf("Received %s\r\n", possible_command.c_str());
214 string cmd
= shift_parameter(possible_command
);
216 // find command and execute it
217 parse_command(cmd
.c_str(), possible_command
, new_message
.stream
);
220 // Act upon an ls command
221 // Convert the first parameter into an absolute path, then list the files in that path
222 void SimpleShell::ls_command( string parameters
, StreamOutput
*stream
)
225 while(!parameters
.empty()) {
226 string s
= shift_parameter( parameters
);
227 if(s
.front() == '-') {
231 if(!parameters
.empty()) {
233 path
.append(parameters
);
239 path
= absolute_from_relative(path
);
243 d
= opendir(path
.c_str());
245 while ((p
= readdir(d
)) != NULL
) {
246 stream
->printf("%s", lc(string(p
->d_name
)).c_str());
249 } else if(opts
.find("-s", 0, 2) != string::npos
) {
250 stream
->printf(" %d", p
->d_fsize
);
252 stream
->printf("\r\n");
256 stream
->printf("Could not open directory %s\r\n", path
.c_str());
260 extern SDFAT mounter
;
262 void SimpleShell::remount_command( string parameters
, StreamOutput
*stream
)
265 stream
->printf("remounted\r\n");
269 void SimpleShell::rm_command( string parameters
, StreamOutput
*stream
)
271 const char *fn
= absolute_from_relative(shift_parameter( parameters
)).c_str();
273 if (s
!= 0) stream
->printf("Could not delete %s \r\n", fn
);
277 void SimpleShell::mv_command( string parameters
, StreamOutput
*stream
)
279 string from
= absolute_from_relative(shift_parameter( parameters
));
280 string to
= absolute_from_relative(shift_parameter(parameters
));
281 int s
= rename(from
.c_str(), to
.c_str());
282 if (s
!= 0) stream
->printf("Could not rename %s to %s\r\n", from
.c_str(), to
.c_str());
283 else stream
->printf("renamed %s to %s\r\n", from
.c_str(), to
.c_str());
286 // Change current absolute path to provided path
287 void SimpleShell::cd_command( string parameters
, StreamOutput
*stream
)
289 string folder
= absolute_from_relative( parameters
);
292 d
= opendir(folder
.c_str());
294 stream
->printf("Could not open directory %s \r\n", folder
.c_str() );
296 THEKERNEL
->current_path
= folder
;
301 // Responds with the present working directory
302 void SimpleShell::pwd_command( string parameters
, StreamOutput
*stream
)
304 stream
->printf("%s\r\n", THEKERNEL
->current_path
.c_str());
307 // Output the contents of a file, first parameter is the filename, second is the limit ( in number of lines to output )
308 void SimpleShell::cat_command( string parameters
, StreamOutput
*stream
)
310 // Get parameters ( filename and line limit )
311 string filename
= absolute_from_relative(shift_parameter( parameters
));
312 string limit_paramater
= shift_parameter( parameters
);
314 if ( limit_paramater
!= "" ) {
316 limit
= strtol(limit_paramater
.c_str(), &e
, 10);
317 if (e
<= limit_paramater
.c_str())
322 FILE *lp
= fopen(filename
.c_str(), "r");
324 stream
->printf("File not found: %s\r\n", filename
.c_str());
331 // Print each line of the file
332 while ((c
= fgetc (lp
)) != EOF
) {
333 buffer
.append((char *)&c
, 1);
334 if ( char(c
) == '\n' || ++linecnt
> 80) {
336 stream
->puts(buffer
.c_str());
338 if(linecnt
> 80) linecnt
= 0;
340 if ( newlines
== limit
) {
347 void SimpleShell::upload_command( string parameters
, StreamOutput
*stream
)
349 // this needs to be a hack. it needs to read direct from serial and not allow on_main_loop run until done
350 // NOTE this will block all operation until the upload is complete, so do not do while printing
351 if(!THEKERNEL
->conveyor
->is_queue_empty()) {
352 stream
->printf("upload not allowed while printing or busy\n");
356 // open file to upload to
357 string upload_filename
= absolute_from_relative( parameters
);
358 FILE *fd
= fopen(upload_filename
.c_str(), "w");
360 stream
->printf("uploading to file: %s, send control-D or control-Z to finish\r\n", upload_filename
.c_str());
362 stream
->printf("failed to open file: %s.\r\n", upload_filename
.c_str());
367 bool uploading
= true;
369 if(!stream
->ready()) {
370 // we need to kick things or they die
371 THEKERNEL
->call_event(ON_IDLE
);
375 char c
= stream
->_getc();
376 if( c
== 4 || c
== 26) { // ctrl-D or ctrl-Z
380 stream
->printf("uploaded %d bytes\n", cnt
);
384 // write character to file
386 if(fputc(c
, fd
) != c
) {
387 // error writing to file
388 stream
->printf("error writing to file. ignoring all characters until EOF\r\n");
394 if ((cnt
%400) == 0) {
395 // HACK ALERT to get around fwrite corruption close and re open for append
397 fd
= fopen(upload_filename
.c_str(), "a");
402 // we got an error so ignore everything until EOF
405 if(stream
->ready()) {
408 THEKERNEL
->call_event(ON_IDLE
);
411 } while(c
!= 4 && c
!= 26);
414 // loads the specified config-override file
415 void SimpleShell::load_command( string parameters
, StreamOutput
*stream
)
417 // Get parameters ( filename )
418 string filename
= absolute_from_relative(parameters
);
419 if(filename
== "/") {
420 filename
= THEKERNEL
->config_override_filename();
423 FILE *fp
= fopen(filename
.c_str(), "r");
426 stream
->printf("Loading config override file: %s...\n", filename
.c_str());
427 while(fgets(buf
, sizeof buf
, fp
) != NULL
) {
428 stream
->printf(" %s", buf
);
429 if(buf
[0] == ';') continue; // skip the comments
430 struct SerialMessage message
= {&(StreamOutput::NullStream
), buf
};
431 THEKERNEL
->call_event(ON_CONSOLE_LINE_RECEIVED
, &message
);
433 stream
->printf("config override file executed\n");
437 stream
->printf("File not found: %s\n", filename
.c_str());
441 // saves the specified config-override file
442 void SimpleShell::save_command( string parameters
, StreamOutput
*stream
)
444 // Get parameters ( filename )
445 string filename
= absolute_from_relative(parameters
);
446 if(filename
== "/") {
447 filename
= THEKERNEL
->config_override_filename();
450 //remove(filename.c_str()); // seems to cause a hang every now and then
452 FileStream
fs(filename
.c_str());
453 fs
.printf("; DO NOT EDIT THIS FILE\n");
454 // this also will truncate the existing file instead of deleting it
457 // replace stream with one that writes to config-override file
458 AppendFileStream
*gs
= new AppendFileStream(filename
.c_str());
459 // if(!gs->is_open()) {
460 // stream->printf("Unable to open File %s for write\n", filename.c_str());
464 // issue a M500 which will store values in the file stream
465 Gcode
*gcode
= new Gcode("M500", gs
);
466 THEKERNEL
->call_event(ON_GCODE_RECEIVED
, gcode
);
470 stream
->printf("Settings Stored to %s\r\n", filename
.c_str());
474 void SimpleShell::mem_command( string parameters
, StreamOutput
*stream
)
476 bool verbose
= shift_parameter( parameters
).find_first_of("Vv") != string::npos
;
477 unsigned long heap
= (unsigned long)_sbrk(0);
478 unsigned long m
= g_maximumHeapAddress
- heap
;
479 stream
->printf("Unused Heap: %lu bytes\r\n", m
);
481 uint32_t f
= heapWalk(stream
, verbose
);
482 stream
->printf("Total Free RAM: %lu bytes\r\n", m
+ f
);
484 stream
->printf("Free AHB0: %lu, AHB1: %lu\r\n", AHB0
.free(), AHB1
.free());
491 static uint32_t getDeviceType()
493 #define IAP_LOCATION 0x1FFF1FF1
496 typedef void (*IAP
)(uint32_t *, uint32_t *);
497 IAP iap
= (IAP
) IAP_LOCATION
;
502 iap(command
, result
);
509 // get network config
510 void SimpleShell::net_command( string parameters
, StreamOutput
*stream
)
513 bool ok
= PublicData::get_value( network_checksum
, get_ipconfig_checksum
, &returned_data
);
515 char *str
= (char *)returned_data
;
516 stream
->printf("%s\r\n", str
);
520 stream
->printf("No network detected\n");
524 // print out build version
525 void SimpleShell::version_command( string parameters
, StreamOutput
*stream
)
528 uint32_t dev
= getDeviceType();
529 const char *mcu
= (dev
& 0x00100000) ? "LPC1769" : "LPC1768";
530 stream
->printf("Build version: %s, Build date: %s, MCU: %s, System Clock: %ldMHz\r\n", vers
.get_build(), vers
.get_build_date(), mcu
, SystemCoreClock
/ 1000000);
534 void SimpleShell::reset_command( string parameters
, StreamOutput
*stream
)
536 stream
->printf("Smoothie out. Peace. Rebooting in 5 seconds...\r\n");
537 reset_delay_secs
= 5; // reboot in 5 seconds
540 // go into dfu boot mode
541 void SimpleShell::dfu_command( string parameters
, StreamOutput
*stream
)
543 stream
->printf("Entering boot mode...\r\n");
547 // Break out into the MRI debugging system
548 void SimpleShell::break_command( string parameters
, StreamOutput
*stream
)
550 stream
->printf("Entering MRI debug mode...\r\n");
554 // used to test out the get public data events
555 void SimpleShell::get_command( string parameters
, StreamOutput
*stream
)
557 string what
= shift_parameter( parameters
);
560 if (what
== "temp") {
561 string type
= shift_parameter( parameters
);
562 bool ok
= PublicData::get_value( temperature_control_checksum
, get_checksum(type
), current_temperature_checksum
, &returned_data
);
565 struct pad_temperature temp
= *static_cast<struct pad_temperature
*>(returned_data
);
566 stream
->printf("%s temp: %f/%f @%d\r\n", type
.c_str(), temp
.current_temperature
, temp
.target_temperature
, temp
.pwm
);
568 stream
->printf("%s is not a known temperature device\r\n", type
.c_str());
571 } else if (what
== "pos") {
572 bool ok
= PublicData::get_value( robot_checksum
, current_position_checksum
, &returned_data
);
575 float *pos
= static_cast<float *>(returned_data
);
576 stream
->printf("Position X: %f, Y: %f, Z: %f\r\n", pos
[0], pos
[1], pos
[2]);
579 stream
->printf("get pos command failed\r\n");
584 // used to test out the get public data events
585 void SimpleShell::set_temp_command( string parameters
, StreamOutput
*stream
)
587 string type
= shift_parameter( parameters
);
588 string temp
= shift_parameter( parameters
);
589 float t
= temp
.empty() ? 0.0 : strtof(temp
.c_str(), NULL
);
590 bool ok
= PublicData::set_value( temperature_control_checksum
, get_checksum(type
), &t
);
593 stream
->printf("%s temp set to: %3.1f\r\n", type
.c_str(), t
);
595 stream
->printf("%s is not a known temperature device\r\n", type
.c_str());
599 void SimpleShell::calc_thermistor_command( string parameters
, StreamOutput
*stream
)
601 string s
= shift_parameter( parameters
);
603 // see if we have -sn as first argument
604 if(s
.find("-s", 0, 2) != string::npos
) {
605 // save the results to thermistor n
606 saveto
= strtol(s
.substr(2).c_str(), nullptr, 10);
611 std::vector
<float> trl
= parse_number_list(parameters
.c_str());
612 if(trl
.size() == 6) {
613 // calculate the coefficients
615 std::tie(c1
, c2
, c3
) = Thermistor::calculate_steinhart_hart_coefficients(trl
[0], trl
[1], trl
[2], trl
[3], trl
[4], trl
[5]);
616 stream
->printf("Steinhart Hart coefficients: I%1.18f J%1.18f K%1.18f\n", c1
, c2
, c3
);
618 stream
->printf(" Paste the above in the M305 S0 command, then save with M500\n");
621 int n
= snprintf(buf
, sizeof(buf
), "M305 S%d I%1.18f J%1.18f K%1.18f", saveto
, c1
, c2
, c3
);
623 Gcode
gcode(g
, &(StreamOutput::NullStream
));
624 THEKERNEL
->call_event(ON_GCODE_RECEIVED
, &gcode
);
625 stream
->printf(" Setting Thermistor %d to those settings, save with M500\n", saveto
);
630 stream
->printf("Usage: calc_thermistor T1,R1,T2,R2,T3,R3\n");
634 // used to test out the get public data events for switch
635 void SimpleShell::switch_command( string parameters
, StreamOutput
*stream
)
637 string type
= shift_parameter( parameters
);
638 string value
= shift_parameter( parameters
);
640 if(value
== "on" || value
== "off") {
641 bool b
= value
== "on";
642 ok
= PublicData::set_value( switch_checksum
, get_checksum(type
), state_checksum
, &b
);
644 float v
= strtof(value
.c_str(), NULL
);
645 ok
= PublicData::set_value( switch_checksum
, get_checksum(type
), value_checksum
, &v
);
648 stream
->printf("switch %s set to: %s\r\n", type
.c_str(), value
.c_str());
650 stream
->printf("%s is not a known switch device\r\n", type
.c_str());
654 void SimpleShell::help_command( string parameters
, StreamOutput
*stream
)
656 stream
->printf("Commands:\r\n");
657 stream
->printf("version\r\n");
658 stream
->printf("mem [-v]\r\n");
659 stream
->printf("ls [-s] [folder]\r\n");
660 stream
->printf("cd folder\r\n");
661 stream
->printf("pwd\r\n");
662 stream
->printf("cat file [limit]\r\n");
663 stream
->printf("rm file\r\n");
664 stream
->printf("mv file newfile\r\n");
665 stream
->printf("remount\r\n");
666 stream
->printf("play file [-v]\r\n");
667 stream
->printf("progress - shows progress of current play\r\n");
668 stream
->printf("abort - abort currently playing file\r\n");
669 stream
->printf("reset - reset smoothie\r\n");
670 stream
->printf("dfu - enter dfu boot loader\r\n");
671 stream
->printf("break - break into debugger\r\n");
672 stream
->printf("config-get [<configuration_source>] <configuration_setting>\r\n");
673 stream
->printf("config-set [<configuration_source>] <configuration_setting> <value>\r\n");
674 stream
->printf("get temp [bed|hotend]\r\n");
675 stream
->printf("set_temp bed|hotend 185\r\n");
676 stream
->printf("get pos\r\n");
677 stream
->printf("net\r\n");
678 stream
->printf("load [file] - loads a configuration override file from soecified name or config-override\r\n");
679 stream
->printf("save [file] - saves a configuration override file as specified filename or as config-override\r\n");
680 stream
->printf("upload filename - saves a stream of text to the named file\r\n");
681 stream
->printf("calc_thermistor [-s0] T1,R1,T2,R2,T3,R3 - calculate the Steinhart Hart coefficients for a thermistor\r\n");