Anonymous

#define css_enable 1
#define css_factor 12*6.28*20
#define css_min    100
#define css_offset 1
    if(css_enable) {
        double pos = fabs(emcmotStatus->carte_pos_cmd.tran.x - css_offset);
        double temp_speed;
        if(pos > 0)
            temp_speed = css_factor / pos;
        else
            temp_speed = emcmotStatus->spindle.speed;
            
        if(temp_speed < css_min)
            temp_speed = css_min;
            
        if(temp_speed > emcmotStatus->spindle.speed)
            temp_speed = emcmotStatus->spindle.speed;
            
        *(emcmot_hal_data->spindle_speed_out) = temp_speed * emcmotStatus->net_spindle_scale;
    } else {
        *(emcmot_hal_data->spindle_speed_out) = emcmotStatus->spindle.speed * emcmotStatus->net_spindle_scale;
    }