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