Michael Spencer / Smoothie

Dependencies:   mbed

Fork of Smoothie by Stéphane Cachat

Committer:
Michael J. Spencer
Date:
Fri Feb 28 18:52:52 2014 -0800
Revision:
2:1df0b61d3b5a
Parent:
0:31e91bb0ef3c
Update to latest Smoothie.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Michael J. Spencer 2:1df0b61d3b5a 1 /*
Michael J. Spencer 2:1df0b61d3b5a 2 This file is part of Smoothie (http://smoothieware.org/). The motion control part is heavily based on Grbl (https://github.com/simen/grbl).
Michael J. Spencer 2:1df0b61d3b5a 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.
Michael J. Spencer 2:1df0b61d3b5a 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.
Michael J. Spencer 2:1df0b61d3b5a 5 You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>.
Michael J. Spencer 2:1df0b61d3b5a 6 */
Michael J. Spencer 2:1df0b61d3b5a 7
Michael J. Spencer 2:1df0b61d3b5a 8
Michael J. Spencer 2:1df0b61d3b5a 9 #include "libs/Kernel.h"
Michael J. Spencer 2:1df0b61d3b5a 10 #include "SimpleShell.h"
Michael J. Spencer 2:1df0b61d3b5a 11 #include "libs/nuts_bolts.h"
Michael J. Spencer 2:1df0b61d3b5a 12 #include "libs/utils.h"
Michael J. Spencer 2:1df0b61d3b5a 13 #include "libs/SerialMessage.h"
Michael J. Spencer 2:1df0b61d3b5a 14 #include "libs/StreamOutput.h"
Michael J. Spencer 2:1df0b61d3b5a 15 #include "modules/robot/Conveyor.h"
Michael J. Spencer 2:1df0b61d3b5a 16 #include "DirHandle.h"
Michael J. Spencer 2:1df0b61d3b5a 17 #include "mri.h"
Michael J. Spencer 2:1df0b61d3b5a 18 #include "version.h"
Michael J. Spencer 2:1df0b61d3b5a 19 #include "PublicDataRequest.h"
Michael J. Spencer 2:1df0b61d3b5a 20 #include "FileStream.h"
Michael J. Spencer 2:1df0b61d3b5a 21
Michael J. Spencer 2:1df0b61d3b5a 22 #include "modules/tools/temperaturecontrol/TemperatureControlPublicAccess.h"
Michael J. Spencer 2:1df0b61d3b5a 23 #include "modules/robot/RobotPublicAccess.h"
Michael J. Spencer 2:1df0b61d3b5a 24 #include "NetworkPublicAccess.h"
Michael J. Spencer 2:1df0b61d3b5a 25 #include "platform_memory.h"
Michael J. Spencer 2:1df0b61d3b5a 26
Michael J. Spencer 2:1df0b61d3b5a 27 extern unsigned int g_maximumHeapAddress;
Michael J. Spencer 2:1df0b61d3b5a 28
Michael J. Spencer 2:1df0b61d3b5a 29 #include <malloc.h>
Michael J. Spencer 2:1df0b61d3b5a 30 #include <mri.h>
Michael J. Spencer 2:1df0b61d3b5a 31 #include <stdio.h>
Michael J. Spencer 2:1df0b61d3b5a 32 #include <stdint.h>
Michael J. Spencer 2:1df0b61d3b5a 33
Michael J. Spencer 2:1df0b61d3b5a 34 extern "C" uint32_t __end__;
Michael J. Spencer 2:1df0b61d3b5a 35 extern "C" uint32_t __malloc_free_list;
Michael J. Spencer 2:1df0b61d3b5a 36 extern "C" uint32_t _sbrk(int size);
Michael J. Spencer 2:1df0b61d3b5a 37
Michael J. Spencer 2:1df0b61d3b5a 38 #define get_temp_command_checksum CHECKSUM("temp")
Michael J. Spencer 2:1df0b61d3b5a 39 #define get_pos_command_checksum CHECKSUM("pos")
Michael J. Spencer 2:1df0b61d3b5a 40
Michael J. Spencer 2:1df0b61d3b5a 41 // command lookup table
Michael J. Spencer 2:1df0b61d3b5a 42 SimpleShell::ptentry_t SimpleShell::commands_table[] = {
Michael J. Spencer 2:1df0b61d3b5a 43 {CHECKSUM("ls"), &SimpleShell::ls_command},
Michael J. Spencer 2:1df0b61d3b5a 44 {CHECKSUM("cd"), &SimpleShell::cd_command},
Michael J. Spencer 2:1df0b61d3b5a 45 {CHECKSUM("pwd"), &SimpleShell::pwd_command},
Michael J. Spencer 2:1df0b61d3b5a 46 {CHECKSUM("cat"), &SimpleShell::cat_command},
Michael J. Spencer 2:1df0b61d3b5a 47 {CHECKSUM("rm"), &SimpleShell::rm_command},
Michael J. Spencer 2:1df0b61d3b5a 48 {CHECKSUM("reset"), &SimpleShell::reset_command},
Michael J. Spencer 2:1df0b61d3b5a 49 {CHECKSUM("dfu"), &SimpleShell::dfu_command},
Michael J. Spencer 2:1df0b61d3b5a 50 {CHECKSUM("break"), &SimpleShell::break_command},
Michael J. Spencer 2:1df0b61d3b5a 51 {CHECKSUM("help"), &SimpleShell::help_command},
Michael J. Spencer 2:1df0b61d3b5a 52 {CHECKSUM("?"), &SimpleShell::help_command},
Michael J. Spencer 2:1df0b61d3b5a 53 {CHECKSUM("version"), &SimpleShell::version_command},
Michael J. Spencer 2:1df0b61d3b5a 54 {CHECKSUM("mem"), &SimpleShell::mem_command},
Michael J. Spencer 2:1df0b61d3b5a 55 {CHECKSUM("get"), &SimpleShell::get_command},
Michael J. Spencer 2:1df0b61d3b5a 56 {CHECKSUM("set_temp"), &SimpleShell::set_temp_command},
Michael J. Spencer 2:1df0b61d3b5a 57 {CHECKSUM("net"), &SimpleShell::net_command},
Michael J. Spencer 2:1df0b61d3b5a 58 {CHECKSUM("load"), &SimpleShell::load_command},
Michael J. Spencer 2:1df0b61d3b5a 59 {CHECKSUM("save"), &SimpleShell::save_command},
Michael J. Spencer 2:1df0b61d3b5a 60
Michael J. Spencer 2:1df0b61d3b5a 61 // unknown command
Michael J. Spencer 2:1df0b61d3b5a 62 {0, NULL}
Michael J. Spencer 2:1df0b61d3b5a 63 };
Michael J. Spencer 2:1df0b61d3b5a 64
Michael J. Spencer 2:1df0b61d3b5a 65 // Adam Greens heap walk from http://mbed.org/forum/mbed/topic/2701/?page=4#comment-22556
Michael J. Spencer 2:1df0b61d3b5a 66 static uint32_t heapWalk(StreamOutput *stream, bool verbose)
Michael J. Spencer 2:1df0b61d3b5a 67 {
Michael J. Spencer 2:1df0b61d3b5a 68 uint32_t chunkNumber = 1;
Michael J. Spencer 2:1df0b61d3b5a 69 // The __end__ linker symbol points to the beginning of the heap.
Michael J. Spencer 2:1df0b61d3b5a 70 uint32_t chunkCurr = (uint32_t)&__end__;
Michael J. Spencer 2:1df0b61d3b5a 71 // __malloc_free_list is the head pointer to newlib-nano's link list of free chunks.
Michael J. Spencer 2:1df0b61d3b5a 72 uint32_t freeCurr = __malloc_free_list;
Michael J. Spencer 2:1df0b61d3b5a 73 // Calling _sbrk() with 0 reserves no more memory but it returns the current top of heap.
Michael J. Spencer 2:1df0b61d3b5a 74 uint32_t heapEnd = _sbrk(0);
Michael J. Spencer 2:1df0b61d3b5a 75 // accumulate totals
Michael J. Spencer 2:1df0b61d3b5a 76 uint32_t freeSize = 0;
Michael J. Spencer 2:1df0b61d3b5a 77 uint32_t usedSize = 0;
Michael J. Spencer 2:1df0b61d3b5a 78
Michael J. Spencer 2:1df0b61d3b5a 79 stream->printf("Used Heap Size: %lu\n", heapEnd - chunkCurr);
Michael J. Spencer 2:1df0b61d3b5a 80
Michael J. Spencer 2:1df0b61d3b5a 81 // Walk through the chunks until we hit the end of the heap.
Michael J. Spencer 2:1df0b61d3b5a 82 while (chunkCurr < heapEnd) {
Michael J. Spencer 2:1df0b61d3b5a 83 // Assume the chunk is in use. Will update later.
Michael J. Spencer 2:1df0b61d3b5a 84 int isChunkFree = 0;
Michael J. Spencer 2:1df0b61d3b5a 85 // The first 32-bit word in a chunk is the size of the allocation. newlib-nano over allocates by 8 bytes.
Michael J. Spencer 2:1df0b61d3b5a 86 // 4 bytes for this 32-bit chunk size and another 4 bytes to allow for 8 byte-alignment of returned pointer.
Michael J. Spencer 2:1df0b61d3b5a 87 uint32_t chunkSize = *(uint32_t *)chunkCurr;
Michael J. Spencer 2:1df0b61d3b5a 88 // The start of the next chunk is right after the end of this one.
Michael J. Spencer 2:1df0b61d3b5a 89 uint32_t chunkNext = chunkCurr + chunkSize;
Michael J. Spencer 2:1df0b61d3b5a 90
Michael J. Spencer 2:1df0b61d3b5a 91 // The free list is sorted by address.
Michael J. Spencer 2:1df0b61d3b5a 92 // Check to see if we have found the next free chunk in the heap.
Michael J. Spencer 2:1df0b61d3b5a 93 if (chunkCurr == freeCurr) {
Michael J. Spencer 2:1df0b61d3b5a 94 // Chunk is free so flag it as such.
Michael J. Spencer 2:1df0b61d3b5a 95 isChunkFree = 1;
Michael J. Spencer 2:1df0b61d3b5a 96 // The second 32-bit word in a free chunk is a pointer to the next free chunk (again sorted by address).
Michael J. Spencer 2:1df0b61d3b5a 97 freeCurr = *(uint32_t *)(freeCurr + 4);
Michael J. Spencer 2:1df0b61d3b5a 98 }
Michael J. Spencer 2:1df0b61d3b5a 99
Michael J. Spencer 2:1df0b61d3b5a 100 // Skip past the 32-bit size field in the chunk header.
Michael J. Spencer 2:1df0b61d3b5a 101 chunkCurr += 4;
Michael J. Spencer 2:1df0b61d3b5a 102 // 8-byte align the data pointer.
Michael J. Spencer 2:1df0b61d3b5a 103 chunkCurr = (chunkCurr + 7) & ~7;
Michael J. Spencer 2:1df0b61d3b5a 104 // newlib-nano over allocates by 8 bytes, 4 bytes for the 32-bit chunk size and another 4 bytes to allow for 8
Michael J. Spencer 2:1df0b61d3b5a 105 // byte-alignment of the returned pointer.
Michael J. Spencer 2:1df0b61d3b5a 106 chunkSize -= 8;
Michael J. Spencer 2:1df0b61d3b5a 107 if (verbose)
Michael J. Spencer 2:1df0b61d3b5a 108 stream->printf(" Chunk: %lu Address: 0x%08lX Size: %lu %s\n", chunkNumber, chunkCurr, chunkSize, isChunkFree ? "CHUNK FREE" : "");
Michael J. Spencer 2:1df0b61d3b5a 109
Michael J. Spencer 2:1df0b61d3b5a 110 if (isChunkFree) freeSize += chunkSize;
Michael J. Spencer 2:1df0b61d3b5a 111 else usedSize += chunkSize;
Michael J. Spencer 2:1df0b61d3b5a 112
Michael J. Spencer 2:1df0b61d3b5a 113 chunkCurr = chunkNext;
Michael J. Spencer 2:1df0b61d3b5a 114 chunkNumber++;
Michael J. Spencer 2:1df0b61d3b5a 115 }
Michael J. Spencer 2:1df0b61d3b5a 116 stream->printf("Allocated: %lu, Free: %lu\r\n", usedSize, freeSize);
Michael J. Spencer 2:1df0b61d3b5a 117 return freeSize;
Michael J. Spencer 2:1df0b61d3b5a 118 }
Michael J. Spencer 2:1df0b61d3b5a 119
Michael J. Spencer 2:1df0b61d3b5a 120
Michael J. Spencer 2:1df0b61d3b5a 121 void SimpleShell::on_module_loaded()
Michael J. Spencer 2:1df0b61d3b5a 122 {
Michael J. Spencer 2:1df0b61d3b5a 123 this->register_for_event(ON_CONSOLE_LINE_RECEIVED);
Michael J. Spencer 2:1df0b61d3b5a 124 this->register_for_event(ON_GCODE_RECEIVED);
Michael J. Spencer 2:1df0b61d3b5a 125 this->register_for_event(ON_SECOND_TICK);
Michael J. Spencer 2:1df0b61d3b5a 126
Michael J. Spencer 2:1df0b61d3b5a 127 this->reset_delay_secs = 0;
Michael J. Spencer 2:1df0b61d3b5a 128 }
Michael J. Spencer 2:1df0b61d3b5a 129
Michael J. Spencer 2:1df0b61d3b5a 130 void SimpleShell::on_second_tick(void *)
Michael J. Spencer 2:1df0b61d3b5a 131 {
Michael J. Spencer 2:1df0b61d3b5a 132 // we are timing out for the reset
Michael J. Spencer 2:1df0b61d3b5a 133 if (this->reset_delay_secs > 0) {
Michael J. Spencer 2:1df0b61d3b5a 134 if (--this->reset_delay_secs == 0) {
Michael J. Spencer 2:1df0b61d3b5a 135 system_reset(false);
Michael J. Spencer 2:1df0b61d3b5a 136 }
Michael J. Spencer 2:1df0b61d3b5a 137 }
Michael J. Spencer 2:1df0b61d3b5a 138 }
Michael J. Spencer 2:1df0b61d3b5a 139
Michael J. Spencer 2:1df0b61d3b5a 140 void SimpleShell::on_gcode_received(void *argument)
Michael J. Spencer 2:1df0b61d3b5a 141 {
Michael J. Spencer 2:1df0b61d3b5a 142 Gcode *gcode = static_cast<Gcode *>(argument);
Michael J. Spencer 2:1df0b61d3b5a 143 string args= get_arguments(gcode->command);
Michael J. Spencer 2:1df0b61d3b5a 144
Michael J. Spencer 2:1df0b61d3b5a 145 if (gcode->has_m) {
Michael J. Spencer 2:1df0b61d3b5a 146 if (gcode->m == 20) { // list sd card
Michael J. Spencer 2:1df0b61d3b5a 147 gcode->mark_as_taken();
Michael J. Spencer 2:1df0b61d3b5a 148 gcode->stream->printf("Begin file list\r\n");
Michael J. Spencer 2:1df0b61d3b5a 149 ls_command("/sd", gcode->stream);
Michael J. Spencer 2:1df0b61d3b5a 150 gcode->stream->printf("End file list\r\n");
Michael J. Spencer 2:1df0b61d3b5a 151
Michael J. Spencer 2:1df0b61d3b5a 152 } else if (gcode->m == 30) { // remove file
Michael J. Spencer 2:1df0b61d3b5a 153 gcode->mark_as_taken();
Michael J. Spencer 2:1df0b61d3b5a 154 rm_command("/sd/" + args, gcode->stream);
Michael J. Spencer 2:1df0b61d3b5a 155
Michael J. Spencer 2:1df0b61d3b5a 156 }else if(gcode->m == 501) { // load config override
Michael J. Spencer 2:1df0b61d3b5a 157 gcode->mark_as_taken();
Michael J. Spencer 2:1df0b61d3b5a 158 if(args.empty()) {
Michael J. Spencer 2:1df0b61d3b5a 159 load_command("/sd/config-override", gcode->stream);
Michael J. Spencer 2:1df0b61d3b5a 160 }else{
Michael J. Spencer 2:1df0b61d3b5a 161 load_command("/sd/config-override." + args, gcode->stream);
Michael J. Spencer 2:1df0b61d3b5a 162 }
Michael J. Spencer 2:1df0b61d3b5a 163
Michael J. Spencer 2:1df0b61d3b5a 164 }else if(gcode->m == 504) { // save to specific config override file
Michael J. Spencer 2:1df0b61d3b5a 165 gcode->mark_as_taken();
Michael J. Spencer 2:1df0b61d3b5a 166 if(args.empty()) {
Michael J. Spencer 2:1df0b61d3b5a 167 save_command("/sd/config-override", gcode->stream);
Michael J. Spencer 2:1df0b61d3b5a 168 }else{
Michael J. Spencer 2:1df0b61d3b5a 169 save_command("/sd/config-override." + args, gcode->stream);
Michael J. Spencer 2:1df0b61d3b5a 170 }
Michael J. Spencer 2:1df0b61d3b5a 171 }
Michael J. Spencer 2:1df0b61d3b5a 172 }
Michael J. Spencer 2:1df0b61d3b5a 173 }
Michael J. Spencer 2:1df0b61d3b5a 174
Michael J. Spencer 2:1df0b61d3b5a 175 bool SimpleShell::parse_command(unsigned short cs, string args, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 176 {
Michael J. Spencer 2:1df0b61d3b5a 177 for (ptentry_t *p = commands_table; p->pfunc != NULL; ++p) {
Michael J. Spencer 2:1df0b61d3b5a 178 if (cs == p->command_cs) {
Michael J. Spencer 2:1df0b61d3b5a 179 PFUNC fnc= p->pfunc;
Michael J. Spencer 2:1df0b61d3b5a 180 (this->*fnc)(args, stream);
Michael J. Spencer 2:1df0b61d3b5a 181 return true;
Michael J. Spencer 2:1df0b61d3b5a 182 }
Michael J. Spencer 2:1df0b61d3b5a 183 }
Michael J. Spencer 2:1df0b61d3b5a 184
Michael J. Spencer 2:1df0b61d3b5a 185 return false;
Michael J. Spencer 2:1df0b61d3b5a 186 }
Michael J. Spencer 2:1df0b61d3b5a 187
Michael J. Spencer 2:1df0b61d3b5a 188 // When a new line is received, check if it is a command, and if it is, act upon it
Michael J. Spencer 2:1df0b61d3b5a 189 void SimpleShell::on_console_line_received( void *argument )
Michael J. Spencer 2:1df0b61d3b5a 190 {
Michael J. Spencer 2:1df0b61d3b5a 191 SerialMessage new_message = *static_cast<SerialMessage *>(argument);
Michael J. Spencer 2:1df0b61d3b5a 192
Michael J. Spencer 2:1df0b61d3b5a 193 // ignore comments
Michael J. Spencer 2:1df0b61d3b5a 194 if (new_message.message[0] == ';') return;
Michael J. Spencer 2:1df0b61d3b5a 195
Michael J. Spencer 2:1df0b61d3b5a 196 string possible_command = new_message.message;
Michael J. Spencer 2:1df0b61d3b5a 197
Michael J. Spencer 2:1df0b61d3b5a 198 //new_message.stream->printf("Received %s\r\n", possible_command.c_str());
Michael J. Spencer 2:1df0b61d3b5a 199
Michael J. Spencer 2:1df0b61d3b5a 200 unsigned short check_sum = get_checksum( possible_command.substr(0, possible_command.find_first_of(" \r\n")) ); // todo: put this method somewhere more convenient
Michael J. Spencer 2:1df0b61d3b5a 201
Michael J. Spencer 2:1df0b61d3b5a 202 // find command and execute it
Michael J. Spencer 2:1df0b61d3b5a 203 parse_command(check_sum, get_arguments(possible_command), new_message.stream);
Michael J. Spencer 2:1df0b61d3b5a 204 }
Michael J. Spencer 2:1df0b61d3b5a 205
Michael J. Spencer 2:1df0b61d3b5a 206 // Act upon an ls command
Michael J. Spencer 2:1df0b61d3b5a 207 // Convert the first parameter into an absolute path, then list the files in that path
Michael J. Spencer 2:1df0b61d3b5a 208 void SimpleShell::ls_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 209 {
Michael J. Spencer 2:1df0b61d3b5a 210 string folder = absolute_from_relative( parameters );
Michael J. Spencer 2:1df0b61d3b5a 211 DIR *d;
Michael J. Spencer 2:1df0b61d3b5a 212 struct dirent *p;
Michael J. Spencer 2:1df0b61d3b5a 213 d = opendir(folder.c_str());
Michael J. Spencer 2:1df0b61d3b5a 214 if (d != NULL) {
Michael J. Spencer 2:1df0b61d3b5a 215 while ((p = readdir(d)) != NULL) {
Michael J. Spencer 2:1df0b61d3b5a 216 stream->printf("%s\r\n", lc(string(p->d_name)).c_str());
Michael J. Spencer 2:1df0b61d3b5a 217 }
Michael J. Spencer 2:1df0b61d3b5a 218 closedir(d);
Michael J. Spencer 2:1df0b61d3b5a 219 } else {
Michael J. Spencer 2:1df0b61d3b5a 220 stream->printf("Could not open directory %s \r\n", folder.c_str());
Michael J. Spencer 2:1df0b61d3b5a 221 }
Michael J. Spencer 2:1df0b61d3b5a 222 }
Michael J. Spencer 2:1df0b61d3b5a 223
Michael J. Spencer 2:1df0b61d3b5a 224 // Delete a file
Michael J. Spencer 2:1df0b61d3b5a 225 void SimpleShell::rm_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 226 {
Michael J. Spencer 2:1df0b61d3b5a 227 const char *fn= absolute_from_relative(shift_parameter( parameters )).c_str();
Michael J. Spencer 2:1df0b61d3b5a 228 int s = remove(fn);
Michael J. Spencer 2:1df0b61d3b5a 229 if (s != 0) stream->printf("Could not delete %s \r\n", fn);
Michael J. Spencer 2:1df0b61d3b5a 230 }
Michael J. Spencer 2:1df0b61d3b5a 231
Michael J. Spencer 2:1df0b61d3b5a 232 // Change current absolute path to provided path
Michael J. Spencer 2:1df0b61d3b5a 233 void SimpleShell::cd_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 234 {
Michael J. Spencer 2:1df0b61d3b5a 235 string folder = absolute_from_relative( parameters );
Michael J. Spencer 2:1df0b61d3b5a 236
Michael J. Spencer 2:1df0b61d3b5a 237 DIR *d;
Michael J. Spencer 2:1df0b61d3b5a 238 d = opendir(folder.c_str());
Michael J. Spencer 2:1df0b61d3b5a 239 if (d == NULL) {
Michael J. Spencer 2:1df0b61d3b5a 240 stream->printf("Could not open directory %s \r\n", folder.c_str() );
Michael J. Spencer 2:1df0b61d3b5a 241 } else {
Michael J. Spencer 2:1df0b61d3b5a 242 THEKERNEL->current_path = folder;
Michael J. Spencer 2:1df0b61d3b5a 243 closedir(d);
Michael J. Spencer 2:1df0b61d3b5a 244 }
Michael J. Spencer 2:1df0b61d3b5a 245 }
Michael J. Spencer 2:1df0b61d3b5a 246
Michael J. Spencer 2:1df0b61d3b5a 247 // Responds with the present working directory
Michael J. Spencer 2:1df0b61d3b5a 248 void SimpleShell::pwd_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 249 {
Michael J. Spencer 2:1df0b61d3b5a 250 stream->printf("%s\r\n", THEKERNEL->current_path.c_str());
Michael J. Spencer 2:1df0b61d3b5a 251 }
Michael J. Spencer 2:1df0b61d3b5a 252
Michael J. Spencer 2:1df0b61d3b5a 253 // Output the contents of a file, first parameter is the filename, second is the limit ( in number of lines to output )
Michael J. Spencer 2:1df0b61d3b5a 254 void SimpleShell::cat_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 255 {
Michael J. Spencer 2:1df0b61d3b5a 256 // Get parameters ( filename and line limit )
Michael J. Spencer 2:1df0b61d3b5a 257 string filename = absolute_from_relative(shift_parameter( parameters ));
Michael J. Spencer 2:1df0b61d3b5a 258 string limit_paramater = shift_parameter( parameters );
Michael J. Spencer 2:1df0b61d3b5a 259 int limit = -1;
Michael J. Spencer 2:1df0b61d3b5a 260 if ( limit_paramater != "" ) {
Michael J. Spencer 2:1df0b61d3b5a 261 char *e = NULL;
Michael J. Spencer 2:1df0b61d3b5a 262 limit = strtol(limit_paramater.c_str(), &e, 10);
Michael J. Spencer 2:1df0b61d3b5a 263 if (e <= limit_paramater.c_str())
Michael J. Spencer 2:1df0b61d3b5a 264 limit = -1;
Michael J. Spencer 2:1df0b61d3b5a 265 }
Michael J. Spencer 2:1df0b61d3b5a 266
Michael J. Spencer 2:1df0b61d3b5a 267 // Open file
Michael J. Spencer 2:1df0b61d3b5a 268 FILE *lp = fopen(filename.c_str(), "r");
Michael J. Spencer 2:1df0b61d3b5a 269 if (lp == NULL) {
Michael J. Spencer 2:1df0b61d3b5a 270 stream->printf("File not found: %s\r\n", filename.c_str());
Michael J. Spencer 2:1df0b61d3b5a 271 return;
Michael J. Spencer 2:1df0b61d3b5a 272 }
Michael J. Spencer 2:1df0b61d3b5a 273 string buffer;
Michael J. Spencer 2:1df0b61d3b5a 274 int c;
Michael J. Spencer 2:1df0b61d3b5a 275 int newlines = 0;
Michael J. Spencer 2:1df0b61d3b5a 276 int linecnt= 0;
Michael J. Spencer 2:1df0b61d3b5a 277 // Print each line of the file
Michael J. Spencer 2:1df0b61d3b5a 278 while ((c = fgetc (lp)) != EOF) {
Michael J. Spencer 2:1df0b61d3b5a 279 buffer.append((char *)&c, 1);
Michael J. Spencer 2:1df0b61d3b5a 280 if ( char(c) == '\n' || ++linecnt > 80) {
Michael J. Spencer 2:1df0b61d3b5a 281 newlines++;
Michael J. Spencer 2:1df0b61d3b5a 282 stream->puts(buffer.c_str());
Michael J. Spencer 2:1df0b61d3b5a 283 buffer.clear();
Michael J. Spencer 2:1df0b61d3b5a 284 if(linecnt > 80) linecnt= 0;
Michael J. Spencer 2:1df0b61d3b5a 285 }
Michael J. Spencer 2:1df0b61d3b5a 286 if ( newlines == limit ) {
Michael J. Spencer 2:1df0b61d3b5a 287 break;
Michael J. Spencer 2:1df0b61d3b5a 288 }
Michael J. Spencer 2:1df0b61d3b5a 289 };
Michael J. Spencer 2:1df0b61d3b5a 290 fclose(lp);
Michael J. Spencer 2:1df0b61d3b5a 291
Michael J. Spencer 2:1df0b61d3b5a 292 }
Michael J. Spencer 2:1df0b61d3b5a 293
Michael J. Spencer 2:1df0b61d3b5a 294 // loads the specified config-override file
Michael J. Spencer 2:1df0b61d3b5a 295 void SimpleShell::load_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 296 {
Michael J. Spencer 2:1df0b61d3b5a 297 // Get parameters ( filename )
Michael J. Spencer 2:1df0b61d3b5a 298 string filename = absolute_from_relative(parameters);
Michael J. Spencer 2:1df0b61d3b5a 299 if(filename == "/") {
Michael J. Spencer 2:1df0b61d3b5a 300 filename = THEKERNEL->config_override_filename();
Michael J. Spencer 2:1df0b61d3b5a 301 }
Michael J. Spencer 2:1df0b61d3b5a 302
Michael J. Spencer 2:1df0b61d3b5a 303 FILE *fp= fopen(filename.c_str(), "r");
Michael J. Spencer 2:1df0b61d3b5a 304 if(fp != NULL) {
Michael J. Spencer 2:1df0b61d3b5a 305 char buf[132];
Michael J. Spencer 2:1df0b61d3b5a 306 stream->printf("Loading config override file: %s...\n", filename.c_str());
Michael J. Spencer 2:1df0b61d3b5a 307 while(fgets(buf, sizeof buf, fp) != NULL) {
Michael J. Spencer 2:1df0b61d3b5a 308 stream->printf(" %s", buf);
Michael J. Spencer 2:1df0b61d3b5a 309 if(buf[0] == ';') continue; // skip the comments
Michael J. Spencer 2:1df0b61d3b5a 310 struct SerialMessage message= {&(StreamOutput::NullStream), buf};
Michael J. Spencer 2:1df0b61d3b5a 311 THEKERNEL->call_event(ON_CONSOLE_LINE_RECEIVED, &message);
Michael J. Spencer 2:1df0b61d3b5a 312 }
Michael J. Spencer 2:1df0b61d3b5a 313 stream->printf("config override file executed\n");
Michael J. Spencer 2:1df0b61d3b5a 314 fclose(fp);
Michael J. Spencer 2:1df0b61d3b5a 315
Michael J. Spencer 2:1df0b61d3b5a 316 }else{
Michael J. Spencer 2:1df0b61d3b5a 317 stream->printf("File not found: %s\n", filename.c_str());
Michael J. Spencer 2:1df0b61d3b5a 318 }
Michael J. Spencer 2:1df0b61d3b5a 319 }
Michael J. Spencer 2:1df0b61d3b5a 320
Michael J. Spencer 2:1df0b61d3b5a 321 // saves the specified config-override file
Michael J. Spencer 2:1df0b61d3b5a 322 void SimpleShell::save_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 323 {
Michael J. Spencer 2:1df0b61d3b5a 324 // Get parameters ( filename )
Michael J. Spencer 2:1df0b61d3b5a 325 string filename = absolute_from_relative(parameters);
Michael J. Spencer 2:1df0b61d3b5a 326 if(filename == "/") {
Michael J. Spencer 2:1df0b61d3b5a 327 filename = THEKERNEL->config_override_filename();
Michael J. Spencer 2:1df0b61d3b5a 328 }
Michael J. Spencer 2:1df0b61d3b5a 329
Michael J. Spencer 2:1df0b61d3b5a 330 // replace stream with one that writes to config-override file
Michael J. Spencer 2:1df0b61d3b5a 331 FileStream *gs = new FileStream(filename.c_str());
Michael J. Spencer 2:1df0b61d3b5a 332 if(!gs->is_open()) {
Michael J. Spencer 2:1df0b61d3b5a 333 stream->printf("Unable to open File %s for write\n", filename.c_str());
Michael J. Spencer 2:1df0b61d3b5a 334 return;
Michael J. Spencer 2:1df0b61d3b5a 335 }
Michael J. Spencer 2:1df0b61d3b5a 336
Michael J. Spencer 2:1df0b61d3b5a 337 // issue a M500 which will store values in the file stream
Michael J. Spencer 2:1df0b61d3b5a 338 Gcode *gcode = new Gcode("M500", gs);
Michael J. Spencer 2:1df0b61d3b5a 339 THEKERNEL->call_event(ON_GCODE_RECEIVED, gcode );
Michael J. Spencer 2:1df0b61d3b5a 340 delete gs;
Michael J. Spencer 2:1df0b61d3b5a 341 delete gcode;
Michael J. Spencer 2:1df0b61d3b5a 342
Michael J. Spencer 2:1df0b61d3b5a 343 stream->printf("Settings Stored to %s\r\n", filename.c_str());
Michael J. Spencer 2:1df0b61d3b5a 344 }
Michael J. Spencer 2:1df0b61d3b5a 345
Michael J. Spencer 2:1df0b61d3b5a 346 // show free memory
Michael J. Spencer 2:1df0b61d3b5a 347 void SimpleShell::mem_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 348 {
Michael J. Spencer 2:1df0b61d3b5a 349 bool verbose = shift_parameter( parameters ).find_first_of("Vv") != string::npos ;
Michael J. Spencer 2:1df0b61d3b5a 350 unsigned long heap = (unsigned long)_sbrk(0);
Michael J. Spencer 2:1df0b61d3b5a 351 unsigned long m = g_maximumHeapAddress - heap;
Michael J. Spencer 2:1df0b61d3b5a 352 stream->printf("Unused Heap: %lu bytes\r\n", m);
Michael J. Spencer 2:1df0b61d3b5a 353
Michael J. Spencer 2:1df0b61d3b5a 354 uint32_t f= heapWalk(stream, verbose);
Michael J. Spencer 2:1df0b61d3b5a 355 stream->printf("Total Free RAM: %lu bytes\r\n", m + f);
Michael J. Spencer 2:1df0b61d3b5a 356
Michael J. Spencer 2:1df0b61d3b5a 357 stream->printf("Free AHB0: %lu, AHB1: %lu\r\n", AHB0.free(), AHB1.free());
Michael J. Spencer 2:1df0b61d3b5a 358 if (verbose)
Michael J. Spencer 2:1df0b61d3b5a 359 {
Michael J. Spencer 2:1df0b61d3b5a 360 AHB0.debug(stream);
Michael J. Spencer 2:1df0b61d3b5a 361 AHB1.debug(stream);
Michael J. Spencer 2:1df0b61d3b5a 362 }
Michael J. Spencer 2:1df0b61d3b5a 363 }
Michael J. Spencer 2:1df0b61d3b5a 364
Michael J. Spencer 2:1df0b61d3b5a 365 static uint32_t getDeviceType()
Michael J. Spencer 2:1df0b61d3b5a 366 {
Michael J. Spencer 2:1df0b61d3b5a 367 #define IAP_LOCATION 0x1FFF1FF1
Michael J. Spencer 2:1df0b61d3b5a 368 uint32_t command[1];
Michael J. Spencer 2:1df0b61d3b5a 369 uint32_t result[5];
Michael J. Spencer 2:1df0b61d3b5a 370 typedef void (*IAP)(uint32_t *, uint32_t *);
Michael J. Spencer 2:1df0b61d3b5a 371 IAP iap = (IAP) IAP_LOCATION;
Michael J. Spencer 2:1df0b61d3b5a 372
Michael J. Spencer 2:1df0b61d3b5a 373 __disable_irq();
Michael J. Spencer 2:1df0b61d3b5a 374
Michael J. Spencer 2:1df0b61d3b5a 375 command[0] = 54;
Michael J. Spencer 2:1df0b61d3b5a 376 iap(command, result);
Michael J. Spencer 2:1df0b61d3b5a 377
Michael J. Spencer 2:1df0b61d3b5a 378 __enable_irq();
Michael J. Spencer 2:1df0b61d3b5a 379
Michael J. Spencer 2:1df0b61d3b5a 380 return result[1];
Michael J. Spencer 2:1df0b61d3b5a 381 }
Michael J. Spencer 2:1df0b61d3b5a 382
Michael J. Spencer 2:1df0b61d3b5a 383 // get network config
Michael J. Spencer 2:1df0b61d3b5a 384 void SimpleShell::net_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 385 {
Michael J. Spencer 2:1df0b61d3b5a 386 void *returned_data;
Michael J. Spencer 2:1df0b61d3b5a 387 bool ok= THEKERNEL->public_data->get_value( network_checksum, get_ipconfig_checksum, &returned_data );
Michael J. Spencer 2:1df0b61d3b5a 388 if(ok) {
Michael J. Spencer 2:1df0b61d3b5a 389 char *str= (char *)returned_data;
Michael J. Spencer 2:1df0b61d3b5a 390 stream->printf("%s\r\n", str);
Michael J. Spencer 2:1df0b61d3b5a 391 free(str);
Michael J. Spencer 2:1df0b61d3b5a 392
Michael J. Spencer 2:1df0b61d3b5a 393 }else{
Michael J. Spencer 2:1df0b61d3b5a 394 stream->printf("No network detected\n");
Michael J. Spencer 2:1df0b61d3b5a 395 }
Michael J. Spencer 2:1df0b61d3b5a 396 }
Michael J. Spencer 2:1df0b61d3b5a 397
Michael J. Spencer 2:1df0b61d3b5a 398 // print out build version
Michael J. Spencer 2:1df0b61d3b5a 399 void SimpleShell::version_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 400 {
Michael J. Spencer 2:1df0b61d3b5a 401 Version vers;
Michael J. Spencer 2:1df0b61d3b5a 402 uint32_t dev = getDeviceType();
Michael J. Spencer 2:1df0b61d3b5a 403 const char *mcu = (dev & 0x00100000) ? "LPC1769" : "LPC1768";
Michael J. Spencer 2:1df0b61d3b5a 404 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);
Michael J. Spencer 2:1df0b61d3b5a 405 }
Michael J. Spencer 2:1df0b61d3b5a 406
Michael J. Spencer 2:1df0b61d3b5a 407 // Reset the system
Michael J. Spencer 2:1df0b61d3b5a 408 void SimpleShell::reset_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 409 {
Michael J. Spencer 2:1df0b61d3b5a 410 stream->printf("Smoothie out. Peace. Rebooting in 5 seconds...\r\n");
Michael J. Spencer 2:1df0b61d3b5a 411 this->reset_delay_secs = 5; // reboot in 5 seconds
Michael J. Spencer 2:1df0b61d3b5a 412 }
Michael J. Spencer 2:1df0b61d3b5a 413
Michael J. Spencer 2:1df0b61d3b5a 414 // go into dfu boot mode
Michael J. Spencer 2:1df0b61d3b5a 415 void SimpleShell::dfu_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 416 {
Michael J. Spencer 2:1df0b61d3b5a 417 stream->printf("Entering boot mode...\r\n");
Michael J. Spencer 2:1df0b61d3b5a 418 system_reset(true);
Michael J. Spencer 2:1df0b61d3b5a 419 }
Michael J. Spencer 2:1df0b61d3b5a 420
Michael J. Spencer 2:1df0b61d3b5a 421 // Break out into the MRI debugging system
Michael J. Spencer 2:1df0b61d3b5a 422 void SimpleShell::break_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 423 {
Michael J. Spencer 2:1df0b61d3b5a 424 stream->printf("Entering MRI debug mode...\r\n");
Michael J. Spencer 2:1df0b61d3b5a 425 __debugbreak();
Michael J. Spencer 2:1df0b61d3b5a 426 }
Michael J. Spencer 2:1df0b61d3b5a 427
Michael J. Spencer 2:1df0b61d3b5a 428 // used to test out the get public data events
Michael J. Spencer 2:1df0b61d3b5a 429 void SimpleShell::get_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 430 {
Michael J. Spencer 2:1df0b61d3b5a 431 int what = get_checksum(shift_parameter( parameters ));
Michael J. Spencer 2:1df0b61d3b5a 432 void *returned_data;
Michael J. Spencer 2:1df0b61d3b5a 433
Michael J. Spencer 2:1df0b61d3b5a 434 if (what == get_temp_command_checksum) {
Michael J. Spencer 2:1df0b61d3b5a 435 string type = shift_parameter( parameters );
Michael J. Spencer 2:1df0b61d3b5a 436 bool ok = THEKERNEL->public_data->get_value( temperature_control_checksum, get_checksum(type), current_temperature_checksum, &returned_data );
Michael J. Spencer 2:1df0b61d3b5a 437
Michael J. Spencer 2:1df0b61d3b5a 438 if (ok) {
Michael J. Spencer 2:1df0b61d3b5a 439 struct pad_temperature temp = *static_cast<struct pad_temperature *>(returned_data);
Michael J. Spencer 2:1df0b61d3b5a 440 stream->printf("%s temp: %f/%f @%d\r\n", type.c_str(), temp.current_temperature, temp.target_temperature, temp.pwm);
Michael J. Spencer 2:1df0b61d3b5a 441 } else {
Michael J. Spencer 2:1df0b61d3b5a 442 stream->printf("%s is not a known temperature device\r\n", type.c_str());
Michael J. Spencer 2:1df0b61d3b5a 443 }
Michael J. Spencer 2:1df0b61d3b5a 444
Michael J. Spencer 2:1df0b61d3b5a 445 } else if (what == get_pos_command_checksum) {
Michael J. Spencer 2:1df0b61d3b5a 446 bool ok = THEKERNEL->public_data->get_value( robot_checksum, current_position_checksum, &returned_data );
Michael J. Spencer 2:1df0b61d3b5a 447
Michael J. Spencer 2:1df0b61d3b5a 448 if (ok) {
Michael J. Spencer 2:1df0b61d3b5a 449 float *pos = static_cast<float *>(returned_data);
Michael J. Spencer 2:1df0b61d3b5a 450 stream->printf("Position X: %f, Y: %f, Z: %f\r\n", pos[0], pos[1], pos[2]);
Michael J. Spencer 2:1df0b61d3b5a 451
Michael J. Spencer 2:1df0b61d3b5a 452 } else {
Michael J. Spencer 2:1df0b61d3b5a 453 stream->printf("get pos command failed\r\n");
Michael J. Spencer 2:1df0b61d3b5a 454 }
Michael J. Spencer 2:1df0b61d3b5a 455 }
Michael J. Spencer 2:1df0b61d3b5a 456 }
Michael J. Spencer 2:1df0b61d3b5a 457
Michael J. Spencer 2:1df0b61d3b5a 458 // used to test out the get public data events
Michael J. Spencer 2:1df0b61d3b5a 459 void SimpleShell::set_temp_command( string parameters, StreamOutput *stream)
Michael J. Spencer 2:1df0b61d3b5a 460 {
Michael J. Spencer 2:1df0b61d3b5a 461 string type = shift_parameter( parameters );
Michael J. Spencer 2:1df0b61d3b5a 462 string temp = shift_parameter( parameters );
Michael J. Spencer 2:1df0b61d3b5a 463 float t = temp.empty() ? 0.0 : strtof(temp.c_str(), NULL);
Michael J. Spencer 2:1df0b61d3b5a 464 bool ok = THEKERNEL->public_data->set_value( temperature_control_checksum, get_checksum(type), &t );
Michael J. Spencer 2:1df0b61d3b5a 465
Michael J. Spencer 2:1df0b61d3b5a 466 if (ok) {
Michael J. Spencer 2:1df0b61d3b5a 467 stream->printf("%s temp set to: %3.1f\r\n", type.c_str(), t);
Michael J. Spencer 2:1df0b61d3b5a 468 } else {
Michael J. Spencer 2:1df0b61d3b5a 469 stream->printf("%s is not a known temperature device\r\n", type.c_str());
Michael J. Spencer 2:1df0b61d3b5a 470 }
Michael J. Spencer 2:1df0b61d3b5a 471 }
Michael J. Spencer 2:1df0b61d3b5a 472
Michael J. Spencer 2:1df0b61d3b5a 473 void SimpleShell::help_command( string parameters, StreamOutput *stream )
Michael J. Spencer 2:1df0b61d3b5a 474 {
Michael J. Spencer 2:1df0b61d3b5a 475 stream->printf("Commands:\r\n");
Michael J. Spencer 2:1df0b61d3b5a 476 stream->printf("version\r\n");
Michael J. Spencer 2:1df0b61d3b5a 477 stream->printf("mem [-v]\r\n");
Michael J. Spencer 2:1df0b61d3b5a 478 stream->printf("ls [folder]\r\n");
Michael J. Spencer 2:1df0b61d3b5a 479 stream->printf("cd folder\r\n");
Michael J. Spencer 2:1df0b61d3b5a 480 stream->printf("pwd\r\n");
Michael J. Spencer 2:1df0b61d3b5a 481 stream->printf("cat file [limit]\r\n");
Michael J. Spencer 2:1df0b61d3b5a 482 stream->printf("rm file\r\n");
Michael J. Spencer 2:1df0b61d3b5a 483 stream->printf("play file [-v]\r\n");
Michael J. Spencer 2:1df0b61d3b5a 484 stream->printf("progress - shows progress of current play\r\n");
Michael J. Spencer 2:1df0b61d3b5a 485 stream->printf("abort - abort currently playing file\r\n");
Michael J. Spencer 2:1df0b61d3b5a 486 stream->printf("reset - reset smoothie\r\n");
Michael J. Spencer 2:1df0b61d3b5a 487 stream->printf("dfu - enter dfu boot loader\r\n");
Michael J. Spencer 2:1df0b61d3b5a 488 stream->printf("break - break into debugger\r\n");
Michael J. Spencer 2:1df0b61d3b5a 489 stream->printf("config-get [<configuration_source>] <configuration_setting>\r\n");
Michael J. Spencer 2:1df0b61d3b5a 490 stream->printf("config-set [<configuration_source>] <configuration_setting> <value>\r\n");
Michael J. Spencer 2:1df0b61d3b5a 491 stream->printf("config-load [<file_name>]\r\n");
Michael J. Spencer 2:1df0b61d3b5a 492 stream->printf("get temp [bed|hotend]\r\n");
Michael J. Spencer 2:1df0b61d3b5a 493 stream->printf("set_temp bed|hotend 185\r\n");
Michael J. Spencer 2:1df0b61d3b5a 494 stream->printf("get pos\r\n");
Michael J. Spencer 2:1df0b61d3b5a 495 stream->printf("net\r\n");
Michael J. Spencer 2:1df0b61d3b5a 496 stream->printf("load [file] - loads a configuration override file from soecified name or config-override\r\n");
Michael J. Spencer 2:1df0b61d3b5a 497 stream->printf("save [file] - saves a configuration override file as specified filename or as config-override\r\n");
Michael J. Spencer 2:1df0b61d3b5a 498 }
Michael J. Spencer 2:1df0b61d3b5a 499