Commit | Line | Data |
---|---|---|
df27a6a3 | 1 | /* |
4cff3ded AW |
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. | |
df27a6a3 | 5 | You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>. |
4cff3ded AW |
6 | */ |
7 | ||
4cff3ded | 8 | #include "libs/Kernel.h" |
88443c6b | 9 | |
4cff3ded | 10 | #include "modules/tools/laser/Laser.h" |
65d97468 | 11 | #include "modules/tools/spindle/Spindle.h" |
14ecdbd7 | 12 | #include "modules/tools/extruder/ExtruderMaker.h" |
3c132bd0 | 13 | #include "modules/tools/temperaturecontrol/TemperatureControlPool.h" |
201bcb94 | 14 | #include "modules/tools/endstops/Endstops.h" |
88443c6b | 15 | #include "modules/tools/zprobe/ZProbe.h" |
ed866a4b | 16 | #include "modules/tools/scaracal/SCARAcal.h" |
c48757a7 | 17 | #include "RotaryDeltaCalibration.h" |
cc1d3b1f | 18 | #include "modules/tools/switch/SwitchPool.h" |
abe97b79 | 19 | #include "modules/tools/temperatureswitch/TemperatureSwitch.h" |
13320983 | 20 | #include "modules/tools/drillingcycles/Drillingcycles.h" |
89b1a6eb | 21 | #include "FilamentDetector.h" |
3eca6882 | 22 | #include "MotorDriverControl.h" |
88443c6b | 23 | |
3fceb8eb | 24 | #include "modules/robot/Conveyor.h" |
4eb9c745 | 25 | #include "modules/utils/simpleshell/SimpleShell.h" |
cf44cb59 | 26 | #include "modules/utils/configurator/Configurator.h" |
0e8b102e | 27 | #include "modules/utils/currentcontrol/CurrentControl.h" |
1cf49da1 | 28 | #include "modules/utils/player/Player.h" |
35e7b158 | 29 | #include "modules/utils/killbutton/KillButton.h" |
4a679a75 | 30 | #include "modules/utils/PlayLed/PlayLed.h" |
35089dc7 | 31 | #include "modules/utils/panel/Panel.h" |
d4ee6ee2 | 32 | #include "libs/Network/uip/Network.h" |
61134a65 | 33 | #include "Config.h" |
7af0714f | 34 | #include "checksumm.h" |
8d54c34c | 35 | #include "ConfigValue.h" |
dc3542cf | 36 | #include "StepTicker.h" |
b772a11c | 37 | #include "SlowTicker.h" |
35089dc7 | 38 | |
2487f50b | 39 | // #include "libs/ChaNFSSD/SDFileSystem.h" |
4eb9c745 AW |
40 | #include "libs/nuts_bolts.h" |
41 | #include "libs/utils.h" | |
4cff3ded | 42 | |
40c831b8 MM |
43 | // Debug |
44 | #include "libs/SerialMessage.h" | |
a39e1557 | 45 | |
7c3c5e0f MM |
46 | #include "libs/USBDevice/USB.h" |
47 | #include "libs/USBDevice/USBMSD/USBMSD.h" | |
48 | #include "libs/USBDevice/USBMSD/SDCard.h" | |
49 | #include "libs/USBDevice/USBSerial/USBSerial.h" | |
9f0f2c8f | 50 | #include "libs/USBDevice/DFU.h" |
246fd409 | 51 | #include "libs/SDFAT.h" |
61134a65 | 52 | #include "StreamOutputPool.h" |
17c89e4d | 53 | #include "ToolManager.h" |
246fd409 | 54 | |
073b1698 MM |
55 | #include "libs/Watchdog.h" |
56 | ||
582559c6 | 57 | #include "version.h" |
61134a65 | 58 | #include "system_LPC17xx.h" |
8b261cdc | 59 | #include "platform_memory.h" |
582559c6 | 60 | |
a2f7633f JM |
61 | #include "mbed.h" |
62 | ||
764b2de4 | 63 | #define second_usb_serial_enable_checksum CHECKSUM("second_usb_serial_enable") |
82d1ceb3 | 64 | #define disable_msd_checksum CHECKSUM("msd_disable") |
f431d45c | 65 | #define dfu_enable_checksum CHECKSUM("dfu_enable") |
55a2f359 | 66 | #define watchdog_timeout_checksum CHECKSUM("watchdog_timeout") |
764b2de4 | 67 | |
073b1698 | 68 | |
d337942a | 69 | // USB Stuff |
5c84acba | 70 | SDCard sd __attribute__ ((section ("AHBSRAM0"))) (P0_9, P0_8, P0_7, P0_6); // this selects SPI1 as the sdcard as it is on Smoothieboard |
82414cb2 | 71 | //SDCard sd(P0_18, P0_17, P0_15, P0_16); // this selects SPI0 as the sdcard |
eaf7b7eb | 72 | //SDCard sd(P0_18, P0_17, P0_15, P2_8); // this selects SPI0 as the sdcard witrh a different sd select |
82414cb2 | 73 | |
5c84acba JM |
74 | USB u __attribute__ ((section ("AHBSRAM0"))); |
75 | USBSerial usbserial __attribute__ ((section ("AHBSRAM0"))) (&u); | |
45509e68 JM |
76 | #ifndef DISABLEMSD |
77 | USBMSD msc __attribute__ ((section ("AHBSRAM0"))) (&u, &sd); | |
78 | #else | |
8c6d9683 | 79 | USBMSD *msc= NULL; |
45509e68 | 80 | #endif |
7c3c5e0f | 81 | |
5c84acba | 82 | SDFAT mounter __attribute__ ((section ("AHBSRAM0"))) ("sd", &sd); |
a39e1557 | 83 | |
ca3a28b4 MM |
84 | GPIO leds[5] = { |
85 | GPIO(P1_18), | |
86 | GPIO(P1_19), | |
87 | GPIO(P1_20), | |
88 | GPIO(P1_21), | |
89 | GPIO(P4_28) | |
90 | }; | |
a39e1557 | 91 | |
9e089978 | 92 | // debug pins, only used if defined in src/makefile |
9e089978 JM |
93 | #ifdef STEPTICKER_DEBUG_PIN |
94 | GPIO stepticker_debug_pin(STEPTICKER_DEBUG_PIN); | |
95 | #endif | |
96 | ||
8a1a44cb | 97 | void init() { |
2a1089e1 AW |
98 | |
99 | // Default pins to low status | |
100 | for (int i = 0; i < 5; i++){ | |
ca3a28b4 | 101 | leds[i].output(); |
82d1ceb3 | 102 | leds[i]= 0; |
ca3a28b4 MM |
103 | } |
104 | ||
9e089978 JM |
105 | #ifdef STEPTICKER_DEBUG_PIN |
106 | stepticker_debug_pin.output(); | |
107 | stepticker_debug_pin= 0; | |
108 | #endif | |
109 | ||
4464301d | 110 | Kernel* kernel = new Kernel(); |
a39e1557 | 111 | |
577414f6 | 112 | kernel->streams->printf("Smoothie Running @%ldMHz\r\n", SystemCoreClock / 1000000); |
582559c6 JM |
113 | Version version; |
114 | kernel->streams->printf(" Build version %s, Build date %s\r\n", version.get_build(), version.get_build_date()); | |
599cb4bd JM |
115 | #ifdef CNC |
116 | kernel->streams->printf(" CNC Build\r\n"); | |
117 | #endif | |
4cff3ded | 118 | |
f431d45c | 119 | bool sdok= (sd.disk_initialize() == 0); |
bb270b88 JM |
120 | if(!sdok) kernel->streams->printf("SDCard failed to initialize\r\n"); |
121 | ||
122 | #ifdef NONETWORK | |
123 | kernel->streams->printf("NETWORK is disabled\r\n"); | |
124 | #endif | |
f431d45c | 125 | |
45509e68 | 126 | #ifdef DISABLEMSD |
82d1ceb3 | 127 | // attempt to be able to disable msd in config |
f431d45c | 128 | if(sdok && !kernel->config->value( disable_msd_checksum )->by_default(false)->as_bool()){ |
8c6d9683 JM |
129 | // HACK to zero the memory USBMSD uses as it and its objects seem to not initialize properly in the ctor |
130 | size_t n= sizeof(USBMSD); | |
131 | void *v = AHB0.alloc(n); | |
132 | memset(v, 0, n); // clear the allocated memory | |
133 | msc= new(v) USBMSD(&u, &sd); // allocate object using zeroed memory | |
134 | }else{ | |
135 | msc= NULL; | |
136 | kernel->streams->printf("MSD is disabled\r\n"); | |
137 | } | |
45509e68 | 138 | #endif |
82d1ceb3 | 139 | |
82d1ceb3 | 140 | |
2a1089e1 | 141 | // Create and add main modules |
f6898df1 | 142 | kernel->add_module( new(AHB0) Player() ); |
df930a5f | 143 | |
8b261cdc JM |
144 | kernel->add_module( new(AHB0) CurrentControl() ); |
145 | kernel->add_module( new(AHB0) KillButton() ); | |
146 | kernel->add_module( new(AHB0) PlayLed() ); | |
147 | kernel->add_module( new(AHB0) Endstops() ); | |
2beffcf3 | 148 | |
24584878 | 149 | |
df930a5f | 150 | // these modules can be completely disabled in the Makefile by adding to EXCLUDE_MODULES |
24584878 JM |
151 | #ifndef NO_TOOLS_SWITCH |
152 | SwitchPool *sp= new SwitchPool(); | |
153 | sp->load_tools(); | |
154 | delete sp; | |
155 | #endif | |
df930a5f | 156 | #ifndef NO_TOOLS_EXTRUDER |
ec6fde0b | 157 | // NOTE this must be done first before Temperature control so ToolManager can handle Tn before temperaturecontrol module does |
24584878 JM |
158 | ExtruderMaker *em= new ExtruderMaker(); |
159 | em->load_tools(); | |
160 | delete em; | |
df930a5f | 161 | #endif |
c7689006 | 162 | #ifndef NO_TOOLS_TEMPERATURECONTROL |
ec6fde0b | 163 | // Note order is important here must be after extruder so Tn as a parameter will get executed first |
24584878 JM |
164 | TemperatureControlPool *tp= new TemperatureControlPool(); |
165 | tp->load_tools(); | |
bab4e1bd | 166 | delete tp; |
c7689006 | 167 | #endif |
df930a5f JM |
168 | #ifndef NO_TOOLS_LASER |
169 | kernel->add_module( new Laser() ); | |
170 | #endif | |
65d97468 PA |
171 | #ifndef NO_TOOLS_SPINDLE |
172 | kernel->add_module( new Spindle() ); | |
173 | #endif | |
df930a5f | 174 | #ifndef NO_UTILS_PANEL |
8b261cdc | 175 | kernel->add_module( new(AHB0) Panel() ); |
df930a5f | 176 | #endif |
88443c6b | 177 | #ifndef NO_TOOLS_ZPROBE |
8b261cdc | 178 | kernel->add_module( new(AHB0) ZProbe() ); |
88443c6b | 179 | #endif |
ed866a4b | 180 | #ifndef NO_TOOLS_SCARACAL |
8b261cdc | 181 | kernel->add_module( new(AHB0) SCARAcal() ); |
ed866a4b | 182 | #endif |
c48757a7 JM |
183 | #ifndef NO_TOOLS_ROTARYDELTACALIBRATION |
184 | kernel->add_module( new RotaryDeltaCalibration() ); | |
185 | #endif | |
df930a5f | 186 | #ifndef NONETWORK |
d4ee6ee2 | 187 | kernel->add_module( new Network() ); |
df930a5f | 188 | #endif |
1dc339ee | 189 | #ifndef NO_TOOLS_TEMPERATURESWITCH |
bab4e1bd | 190 | // Must be loaded after TemperatureControl |
1dc339ee | 191 | kernel->add_module( new TemperatureSwitch() ); |
192 | #endif | |
13320983 SM |
193 | #ifndef NO_TOOLS_DRILLINGCYCLES |
194 | kernel->add_module( new Drillingcycles() ); | |
b4a89b87 | 195 | #endif |
89b1a6eb JM |
196 | #ifndef NO_TOOLS_FILAMENTDETECTOR |
197 | kernel->add_module( new FilamentDetector() ); | |
198 | #endif | |
9b013d84 | 199 | #ifndef NO_UTILS_MOTORDRIVERCONTROL |
fc320ac5 | 200 | kernel->add_module( new MotorDriverControl(0) ); |
3eca6882 | 201 | #endif |
4a679a75 | 202 | // Create and initialize USB stuff |
7c3c5e0f | 203 | u.init(); |
8a004d38 | 204 | |
45509e68 | 205 | #ifdef DISABLEMSD |
8c6d9683 JM |
206 | if(sdok && msc != NULL){ |
207 | kernel->add_module( msc ); | |
208 | } | |
45509e68 JM |
209 | #else |
210 | kernel->add_module( &msc ); | |
211 | #endif | |
b813be45 | 212 | |
7c3c5e0f | 213 | kernel->add_module( &usbserial ); |
764b2de4 | 214 | if( kernel->config->value( second_usb_serial_enable_checksum )->by_default(false)->as_bool() ){ |
f431d45c JM |
215 | kernel->add_module( new(AHB0) USBSerial(&u) ); |
216 | } | |
217 | ||
218 | if( kernel->config->value( dfu_enable_checksum )->by_default(false)->as_bool() ){ | |
219 | kernel->add_module( new(AHB0) DFU(&u)); | |
f6193cbd | 220 | } |
55a2f359 | 221 | |
f6193cbd JM |
222 | // 10 second watchdog timeout (or config as seconds) |
223 | float t= kernel->config->value( watchdog_timeout_checksum )->by_default(10.0F)->as_number(); | |
224 | if(t > 0.1F) { | |
225 | // NOTE setting WDT_RESET with the current bootloader would leave it in DFU mode which would be suboptimal | |
226 | kernel->add_module( new Watchdog(t*1000000, WDT_MRI)); // WDT_RESET)); | |
227 | kernel->streams->printf("Watchdog enabled for %f seconds\n", t); | |
55a2f359 | 228 | }else{ |
f6193cbd | 229 | kernel->streams->printf("WARNING Watchdog is disabled\n"); |
764b2de4 | 230 | } |
55a2f359 | 231 | |
f6193cbd | 232 | |
7c3c5e0f MM |
233 | kernel->add_module( &u ); |
234 | ||
8b261cdc JM |
235 | // memory before cache is cleared |
236 | //SimpleShell::print_mem(kernel->streams); | |
237 | ||
a4bfde91 JM |
238 | // clear up the config cache to save some memory |
239 | kernel->config->config_cache_clear(); | |
240 | ||
73706276 | 241 | if(kernel->is_using_leds()) { |
a3be54e3 | 242 | // set some leds to indicate status... led0 init done, led1 mainloop running, led2 idle loop running, led3 sdcard ok |
21320fc6 | 243 | leds[0]= 1; // indicate we are done with init |
a3be54e3 | 244 | leds[3]= sdok?1:0; // 4th led indicates sdcard is available (TODO maye should indicate config was found) |
21320fc6 | 245 | } |
82d1ceb3 | 246 | |
33e4cc02 JM |
247 | if(sdok) { |
248 | // load config override file if present | |
249 | // NOTE only Mxxx commands that set values should be put in this file. The file is generated by M500 | |
250 | FILE *fp= fopen(kernel->config_override_filename(), "r"); | |
251 | if(fp != NULL) { | |
252 | char buf[132]; | |
253 | kernel->streams->printf("Loading config override file: %s...\n", kernel->config_override_filename()); | |
254 | while(fgets(buf, sizeof buf, fp) != NULL) { | |
255 | kernel->streams->printf(" %s", buf); | |
256 | if(buf[0] == ';') continue; // skip the comments | |
257 | struct SerialMessage message= {&(StreamOutput::NullStream), buf}; | |
258 | kernel->call_event(ON_CONSOLE_LINE_RECEIVED, &message); | |
259 | } | |
260 | kernel->streams->printf("config override file executed\n"); | |
261 | fclose(fp); | |
262 | } | |
263 | } | |
dc3542cf | 264 | |
b772a11c | 265 | // start the timers and interrupts |
dc3542cf | 266 | THEKERNEL->step_ticker->start(); |
b772a11c | 267 | THEKERNEL->slow_ticker->start(); |
8a1a44cb JM |
268 | } |
269 | ||
270 | int main() | |
271 | { | |
272 | init(); | |
33e4cc02 | 273 | |
82d1ceb3 | 274 | uint16_t cnt= 0; |
2a1089e1 | 275 | // Main loop |
4cff3ded | 276 | while(1){ |
73706276 | 277 | if(THEKERNEL->is_using_leds()) { |
21320fc6 JM |
278 | // flash led 2 to show we are alive |
279 | leds[1]= (cnt++ & 0x1000) ? 1 : 0; | |
280 | } | |
8a1a44cb JM |
281 | THEKERNEL->call_event(ON_MAIN_LOOP); |
282 | THEKERNEL->call_event(ON_IDLE); | |
4cff3ded | 283 | } |
4cff3ded | 284 | } |