mirror of https://github.com/rusefi/wideband.git
54 lines
1.2 KiB
C++
54 lines
1.2 KiB
C++
#include "pwm.h"
|
|
|
|
#include <rusefi/math.h>
|
|
|
|
Pwm::Pwm(PWMDriver& driver)
|
|
: m_driver(&driver)
|
|
, m_counterFrequency(0)
|
|
, m_counterPeriod(0)
|
|
{
|
|
}
|
|
|
|
void Pwm::Start()
|
|
{
|
|
static const PWMConfig config = {
|
|
m_counterFrequency,
|
|
m_counterPeriod,
|
|
nullptr,
|
|
{
|
|
{PWM_OUTPUT_ACTIVE_HIGH | PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW, nullptr},
|
|
{PWM_OUTPUT_ACTIVE_HIGH | PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW, nullptr},
|
|
{PWM_OUTPUT_ACTIVE_HIGH | PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW, nullptr},
|
|
{PWM_OUTPUT_ACTIVE_HIGH | PWM_COMPLEMENTARY_OUTPUT_ACTIVE_LOW, nullptr}
|
|
},
|
|
0,
|
|
0,
|
|
#if STM32_PWM_USE_ADVANCED
|
|
0
|
|
#endif
|
|
};
|
|
|
|
Start(config);
|
|
}
|
|
|
|
void Pwm::Start(const PWMConfig& config)
|
|
{
|
|
m_counterFrequency = config.frequency;
|
|
m_counterPeriod = config.period;
|
|
|
|
pwmStart(m_driver, &config);
|
|
}
|
|
|
|
void Pwm::SetDuty(int channel, float duty) {
|
|
auto dutyFloat = clampF(0, duty, 1);
|
|
m_dutyFloat[channel] = dutyFloat;
|
|
pwmcnt_t highTime = m_counterPeriod * dutyFloat;
|
|
|
|
pwmEnableChannel(m_driver, channel, highTime);
|
|
}
|
|
|
|
float Pwm::GetLastDuty(int channel)
|
|
{
|
|
return m_dutyFloat[channel];
|
|
}
|