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