62 lines
2.0 KiB
C++
62 lines
2.0 KiB
C++
/**
|
|
* @file pwm_generator.cpp
|
|
* @brief software PWM generator
|
|
*
|
|
* Software PWM implementation. Considering how low all frequencies are, we can totally afford a couple of float multiplications.
|
|
* By generating PWM programmatically we are saving the timers for better purposes. This implementation also supports generating
|
|
* synchronized waves as needed for example to emulate dual Hall-effect crankshaft position sensors.
|
|
*
|
|
*
|
|
* @date May 28, 2013
|
|
* @author Andrey Belomutskiy, (c) 2012-2015
|
|
*
|
|
*/
|
|
|
|
#include "pwm_generator.h"
|
|
|
|
#include "pin_repository.h"
|
|
#include "datalogging.h"
|
|
|
|
/**
|
|
* This method controls the actual hardware pins
|
|
*
|
|
* This method takes ~350 ticks.
|
|
*/
|
|
void applyPinState(PwmConfig *state, int stateIndex) {
|
|
efiAssertVoid(stateIndex < PWM_PHASE_MAX_COUNT, "invalid stateIndex");
|
|
efiAssertVoid(state->multiWave.waveCount <= PWM_PHASE_MAX_WAVE_PER_PWM, "invalid waveCount");
|
|
for (int waveIndex = 0; waveIndex < state->multiWave.waveCount; waveIndex++) {
|
|
OutputPin *output = state->outputPins[waveIndex];
|
|
int value = state->multiWave.waves[waveIndex].pinStates[stateIndex];
|
|
output->setValue(value);
|
|
}
|
|
}
|
|
|
|
void startSimplePwm(PwmConfig *state, const char *msg, OutputPin *output, float frequency, float dutyCycle, pwm_gen_callback *stateChangeCallback) {
|
|
efiAssertVoid(dutyCycle >= 0 && dutyCycle <= 1, "dutyCycle");
|
|
|
|
float switchTimes[] = { dutyCycle, 1 };
|
|
pin_state_t pinStates0[] = { 0, 1 };
|
|
|
|
pin_state_t *pinStates[1] = { pinStates0 };
|
|
|
|
state->outputPins[0] = output;
|
|
|
|
state->periodNt = US2NT(frequency2periodUs(frequency));
|
|
state->weComplexInit(msg, 2, switchTimes, 1, pinStates, NULL, stateChangeCallback);
|
|
}
|
|
|
|
void startSimplePwmExt(PwmConfig *state, const char *msg, brain_pin_e brainPin, OutputPin *output, float frequency,
|
|
float dutyCycle, pwm_gen_callback *stateChangeCallback) {
|
|
|
|
GPIO_TypeDef * port = getHwPort(brainPin);
|
|
int pin = getHwPin(brainPin);
|
|
outputPinRegister(msg, output, port, pin);
|
|
|
|
startSimplePwm(state, msg, output, frequency, dutyCycle, stateChangeCallback);
|
|
}
|
|
|
|
void initPwmGenerator(void) {
|
|
}
|
|
|