Merge branch 'master' into edge

[clinton/Smoothieware.git] / src / libs / Kernel.cpp

/*  
      This file is part of Smoothie (http://smoothieware.org/). The motion control part is heavily based on Grbl (https://github.com/simen/grbl).
      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.
      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.
      You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>. 
*/

using namespace std;
#include <vector>
#include "libs/Kernel.h"
#include "libs/Module.h"
#include "libs/Config.h"
#include "mbed.h"
#include "libs/nuts_bolts.h"

#include "modules/communication/SerialConsole.h"
#include "modules/communication/GcodeDispatch.h"
#include "modules/robot/Planner.h"
#include "modules/robot/Robot.h"
#include "modules/robot/Stepper.h"

// List of callback functions, ordered as their corresponding events
const ModuleCallback kernel_callback_functions[NUMBER_OF_DEFINED_EVENTS] = { 
        &Module::on_main_loop, 
        &Module::on_console_line_received,
        &Module::on_gcode_received, 
        &Module::on_stepper_wake_up,
        &Module::on_gcode_execute,
        &Module::on_speed_change,
        &Module::on_block_begin,
        &Module::on_block_end
};

#define baud_rate_setting_ckeckusm 10922

// The kernel is the central point in Smoothie : it stores modules, and handles event calls
Kernel::Kernel(){
    
    // Config first, because we need the baud_rate setting before we start serial 
    this->config         = new Config();
    // Serial second, because the other modules might want to say something
    this->serial         = new SerialConsole(USBTX, USBRX, this->config->get(baud_rate_setting_ckeckusm));

    this->add_module( this->config );
    this->add_module( this->serial );
   
    // Core modules 
    this->gcode_dispatch = new GcodeDispatch();
    this->robot          = new Robot();
    this->stepper        = new Stepper();
    this->planner        = new Planner();

    this->add_module( this->gcode_dispatch );
    this->add_module( this->robot );
    this->add_module( this->stepper );
    this->add_module( this->planner );

}

void Kernel::add_module(Module* module){
    module->kernel = this;
    module->on_module_loaded();
}

void Kernel::register_for_event(unsigned int id_event, Module* module){
    this->hooks[id_event].push_back(module);
}

void Kernel::call_event(unsigned int id_event){
    for(unsigned int i=0; i < this->hooks[id_event].size(); i++){
        (this->hooks[id_event][i]->*kernel_callback_functions[id_event])(this);
    }
}

void Kernel::call_event(unsigned int id_event, void * argument){
    for(unsigned int i=0; i < this->hooks[id_event].size(); i++){
        (this->hooks[id_event][i]->*kernel_callback_functions[id_event])(argument);
    }
}