inported from local
FastPWM_common.cpp
- Committer:
- NYX
- Date:
- 2020-03-16
- Revision:
- 0:60857722c2ff
File content as of revision 0:60857722c2ff:
#include "FastPWM.h" FastPWM::FastPWM(PinName pin, int prescaler) : PwmOut(pin) { fast_obj = NULL; initFastPWM(); this->prescaler(prescaler); //Set duty cycle on 0%, period on 20ms period(0.02); write(0); } FastPWM::~FastPWM( void ) { if (fast_obj != NULL) delete(fast_obj); } void FastPWM::period(double seconds) { if (dynamicPrescaler) calcPrescaler((uint64_t)(seconds * (double) SystemCoreClock)); period_ticks(seconds * dticks + 0.5); } void FastPWM::period_ms(int ms) { if (dynamicPrescaler) calcPrescaler(ms * (SystemCoreClock / 1000)); period_ticks(ms * iticks_ms); } void FastPWM::period_us(int us) { if (dynamicPrescaler) calcPrescaler(us * (SystemCoreClock / 1000000)); period_ticks(us * iticks_us); } void FastPWM::period_us(double us) { if (dynamicPrescaler) calcPrescaler((uint64_t)(us * (double)(SystemCoreClock / 1000000))); period_ticks(us * dticks_us + 0.5); } void FastPWM::pulsewidth(double seconds) { pulsewidth_ticks(seconds * dticks + 0.5); } void FastPWM::pulsewidth_ms(int ms) { pulsewidth_ticks(ms * iticks_ms); } void FastPWM::pulsewidth_us(int us) { pulsewidth_ticks(us * iticks_us); } void FastPWM::pulsewidth_us(double us) { pulsewidth_ticks(us * dticks_us + 0.5); } void FastPWM::write(double duty) { _duty=duty; pulsewidth_ticks(duty*getPeriod()); } double FastPWM::read( void ) { return _duty; } FastPWM & FastPWM::operator= (double value) { write(value); return(*this); } FastPWM::operator double() { return _duty; } int FastPWM::prescaler(int value) { int retval; if (value == -1) { dynamicPrescaler = true; value = 0; } else dynamicPrescaler = false; retval = setPrescaler(value); updateTicks(retval); return retval; } void FastPWM::updateTicks( uint32_t prescaler ) { dticks = SystemCoreClock / (double)prescaler; dticks_us = dticks / 1000000.0f; iticks_us = (int)(dticks_us + 0.5); iticks_ms = (int)(dticks_us * 1000.0 + 0.5); } int FastPWM::calcPrescaler(uint64_t clocks) { uint32_t scale = (clocks >> bits) + 1; uint32_t retval = setPrescaler(scale); updateTicks(retval); return retval; }