mirror of https://github.com/FOME-Tech/fome-fw.git
62 lines
1.5 KiB
C++
62 lines
1.5 KiB
C++
|
/**
|
||
|
|
* @file alternatorController.cpp
|
||
|
|
* @brief alternator controller - turn alternator off if you do not really need it
|
||
|
|
*
|
||
|
|
* @date Apr 6, 2014
|
||
|
|
* @author Dmitry Sidin
|
||
|
|
* @author Andrey Belomutskiy (c) 2012-2014
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "main.h"
|
||
|
|
#include "rpm_calculator.h"
|
||
|
|
#include "pwm_generator.h"
|
||
|
|
#include "alternatorController.h"
|
||
|
|
#include "pin_repository.h"
|
||
|
|
#include "engine_configuration.h"
|
||
|
|
#include "voltage.h"
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
|
||
|
|
extern board_configuration_s *boardConfiguration;
|
||
|
|
|
||
|
|
#define ALTERNATOR_VALVE_PWM_FREQUENCY 30000
|
||
|
|
|
||
|
|
static PwmConfig alternatorControl;
|
||
|
|
|
||
|
|
static THD_WORKING_AREA(ivThreadStack, UTILITY_THREAD_STACK_SIZE);
|
||
|
|
|
||
|
|
static msg_t AltCtrlThread(int param) {
|
||
|
|
chRegSetThreadName("AlternatorController");
|
||
|
|
int alternatorDutyCycle = 500;
|
||
|
|
while (TRUE) {
|
||
|
|
chThdSleepMilliseconds(10);
|
||
|
|
|
||
|
|
if ( getVBatt() > 14.2 )
|
||
|
|
alternatorDutyCycle = alternatorDutyCycle + 1 ;
|
||
|
|
else
|
||
|
|
alternatorDutyCycle = alternatorDutyCycle - 1;
|
||
|
|
|
||
|
|
|
||
|
|
if (alternatorDutyCycle < 150 )
|
||
|
|
alternatorDutyCycle = 150;
|
||
|
|
if (alternatorDutyCycle > 950)
|
||
|
|
alternatorDutyCycle = 950;
|
||
|
|
setSimplePwmDutyCycle(&alternatorControl, 0.001 * alternatorDutyCycle);
|
||
|
|
}
|
||
|
|
#if defined __GNUC__
|
||
|
|
return -1;
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
void initAlternatorCtrl() {
|
||
|
|
startSimplePwm(&alternatorControl, "Alternator control",
|
||
|
|
boardConfiguration->alternatorControlPin,
|
||
|
|
0.5,
|
||
|
|
ALTERNATOR_VALVE_PWM_FREQUENCY,
|
||
|
|
ALTERNATOR_SWITCH
|
||
|
|
);
|
||
|
|
chThdCreateStatic(ivThreadStack, sizeof(ivThreadStack), LOWPRIO, (tfunc_t)AltCtrlThread, NULL);
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|