maglev_timer.cc

Go to the documentation of this file.

#include "maglev_timer.h"
#include <string.h>



maglev_timer::maglev_timer(const char * mod_name) : cd_control_module(mod_name)
{
        plog("maglev_timer\n");
}

void maglev_timer::initialize_data()
{
        double control_period = 0.005;
    control_period_command_ref = create_data( NULL, "control_period_command", sd_type_double, "s", "Control period" , &control_period ); 

        mark_command( control_period_command_ref );

        // Request events
        request_event_notification( CD_SYSTEM_GROUP, CD_SIMULATION_STEP_EVENT, 1 );
}

void maglev_timer::initialize()
{
        jD0                                     = -1.0;         
        met_last                        =  0.0;         
        control_time_last       =  0.0;         
        perctol                         =  0.02;        
}

void maglev_timer::handle_event(int code)
{
        if (code == 1)
        {
                trigger_event(NULL,"INIT_TRIGGER");
                
                double control_period;
                
                bool valid = value_as_type(control_period_command_ref, sd_type_double, &control_period);
                
                // Get Mission Elapsed Time
                double met = get_met();
                
                if( !valid )
                {
                        plog("control_period_command not valid.\n");
                        return;
                }
                
                // EXECUTE THESE MODULES IN ORDER EVERY CONTROL_PERIOD
                if( met-control_time_last >= control_period*(1-perctol) )
                {       
                        trigger_event(NULL,"MAGLEV_CONTROL_TRIGGER");
                        
                        control_time_last = met;
                }
        }
}

double maglev_timer::get_met()
{
        ds_date dd = current_time();
        if( jD0<0 ){ jD0 = dd.jd(); }
        return (dd.jd()-jD0)*86400.0;
}


cd_control_module *maglev_timer_builder(const char *name)
{
    return new maglev_timer(name);
}