DMX512_chaser_step.c

/***============================================================================================================================
 * Dependencies inclusion
 * Necessary dependencies should be declared here. Header file should contain as little dependencies declarations as possible
 *=============================================================================================================================*/
 
#include "cueos_config.h"
#if cueOS_CONFIG_NODETYPE == cueOS_NODETYPE_SLAVE_DMX
#include <math.h>
#include "cmsis_os.h"
#include "DMX512_driver.h"
#include "DMX512_chaser_step.h"
 
 
/***============================================================================================================================
 * Private functions definitions
 * These functions are only accessible from within the file's scope
 *=============================================================================================================================*/
 
static void _DMX512_step_fadein(DMX512_chaser_step_s *chaser_step){
    for(uint16_t i=0; i<chaser_step->scene->fixture_preset_count; i++){
        for(uint16_t j=0; j<chaser_step->scene->fixture_presets[i].ch_count; j++){
            uint16_t addr   = chaser_step->scene->fixture_presets[i].fixture->addr + chaser_step->scene->fixture_presets[i].channels[j];
            uint16_t value  = chaser_step->scene->fixture_presets[i].values[j];
            uint32_t time   = ms_chronometer_get_elapsed_ms(&chaser_step->ms_chronometer);
            if(time < chaser_step->fadein_time){
                value = floor(((float)value/(float)chaser_step->fadein_time)*((float)(time)));
            }else{
                chaser_step->state = DMX512_CHASER_STEP_HOLD;
            }
 
            DMX512_driver_set_single(addr, value);
        }
    }
}
 
static void _DMX512_step_hold(DMX512_chaser_step_s *chaser_step){
    if(ms_chronometer_get_elapsed_ms(&chaser_step->ms_chronometer) > chaser_step->hold_time){
        chaser_step->state = DMX512_CHASER_STEP_FADE_OUT;
    }
}
 
static void _DMX512_step_fadeout(DMX512_chaser_step_s *chaser_step){
    for(uint16_t i=0; i<chaser_step->scene->fixture_preset_count; i++){
        for(uint16_t j=0; j<chaser_step->scene->fixture_presets[i].ch_count; j++){
            uint16_t addr   = chaser_step->scene->fixture_presets[i].fixture->addr + chaser_step->scene->fixture_presets[i].channels[j];
            uint16_t value  = chaser_step->scene->fixture_presets[i].values[j];
            uint32_t time   = ms_chronometer_get_elapsed_ms(&chaser_step->ms_chronometer);
            if(time < chaser_step->fadeout_time){
                value = floor(((float)value/(float)chaser_step->fadeout_time)*((float)(time + value)));
            }else{
                chaser_step->state = DMX512_CHASER_STEP_IDLE;
            }
 
            DMX512_driver_set_single(addr, value);
        }
    }
}
 
 
/***============================================================================================================================
 * Public functions definitions
 * These functions can be accessed outside of the file's scope
 *=============================================================================================================================*/
 
DMX512_chaser_step_s DMX512_chaser_step_new(DMX512_scene_s *scene, uint16_t fadein_time, uint16_t fadeout_time, uint16_t hold_time){
 
    DMX512_chaser_step_s chaser_step = DMX512_CHASER_STEP_DEFAULT;
 
    if(scene != NULL){
        chaser_step.scene           = scene;
        chaser_step.fadein_time     = fadein_time;
        chaser_step.fadeout_time    = fadeout_time;
        chaser_step.hold_time       = hold_time;
        chaser_step.status          = DMX512_CHASER_STEP_INITIALISED;
    }
 
    return chaser_step;
 
}
 
void DMX512_chaser_step_manage(DMX512_chaser_step_s *chaser_step){
    switch(chaser_step->state){
        case DMX512_CHASER_STEP_FADE_IN:  _DMX512_step_fadein(chaser_step);     break;
        case DMX512_CHASER_STEP_HOLD:     _DMX512_step_hold(chaser_step);       break;
        case DMX512_CHASER_STEP_FADE_OUT: _DMX512_step_fadeout(chaser_step);    break;
        case DMX512_CHASER_STEP_IDLE:   /*TODO: handle IDLE case ?*/    break;
    }
}
 
void DMX512_chaser_step_start(DMX512_chaser_step_s *chaser_step){
    ms_chronometer_reset(&chaser_step->ms_chronometer);
    chaser_step->state = DMX512_CHASER_STEP_FADE_IN;
}
 
void DMX512_chaser_step_stop(DMX512_chaser_step_s *chaser_step){
    ms_chronometer_reset(&chaser_step->ms_chronometer);
    chaser_step->state = DMX512_CHASER_STEP_IDLE;
}
 
#endif