Mike R / FastPWM

Pinscape fork (KL25Z)

Dependents:   Pinscape_Controller_V2_arnoz Pinscape_Controller_V2

Fork of FastPWM by Erik -

FastPWM_common.cpp@28:14000d42f8bb, 2017-03-17 (annotated)

Committer:
mjr
Date:
Fri Mar 17 22:01:35 2017 +0000
Revision:
28:14000d42f8bb
Parent:
18:d91c0629e4e6
Child:
34:8b826bfff900
Bug fixes.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Sissors 4:a7b9f778c4b4 1 #include "FastPWM.h"
Sissors 4:a7b9f778c4b4 2
Sissors 4:a7b9f778c4b4 3 FastPWM::FastPWM(PinName pin, int prescaler) : PwmOut(pin) {
Sissors 12:4600daab8a83 4 fast_obj = NULL;
Sissors 4:a7b9f778c4b4 5 initFastPWM();
Sissors 4:a7b9f778c4b4 6 this->prescaler(prescaler);
Sissors 4:a7b9f778c4b4 7
Sissors 4:a7b9f778c4b4 8 //Set duty cycle on 0%, period on 20ms
mjr 28:14000d42f8bb 9 printf("FastPWM\r\n");
Sissors 4:a7b9f778c4b4 10 period(0.02);
Sissors 6:0f57969697b6 11 write(0);
Sissors 4:a7b9f778c4b4 12
Sissors 4:a7b9f778c4b4 13
Sissors 4:a7b9f778c4b4 14 }
Sissors 4:a7b9f778c4b4 15
Sissors 12:4600daab8a83 16 FastPWM::~FastPWM( void ) {
Sissors 12:4600daab8a83 17 if (fast_obj != NULL)
Sissors 12:4600daab8a83 18 delete(fast_obj);
Sissors 12:4600daab8a83 19 }
Sissors 12:4600daab8a83 20
Sissors 4:a7b9f778c4b4 21 void FastPWM::period(double seconds) {
Sissors 4:a7b9f778c4b4 22 if (dynamicPrescaler)
Sissors 4:a7b9f778c4b4 23 calcPrescaler((uint64_t)(seconds * (double) SystemCoreClock));
Sissors 4:a7b9f778c4b4 24
Sissors 4:a7b9f778c4b4 25 period_ticks(seconds * dticks + 0.5);
Sissors 4:a7b9f778c4b4 26 }
Sissors 4:a7b9f778c4b4 27
Sissors 4:a7b9f778c4b4 28 void FastPWM::period_ms(int ms) {
Sissors 4:a7b9f778c4b4 29 if (dynamicPrescaler)
Sissors 4:a7b9f778c4b4 30 calcPrescaler(ms * (SystemCoreClock / 1000));
Sissors 4:a7b9f778c4b4 31
Sissors 4:a7b9f778c4b4 32 period_ticks(ms * iticks_ms);
Sissors 4:a7b9f778c4b4 33 }
Sissors 4:a7b9f778c4b4 34
Sissors 4:a7b9f778c4b4 35 void FastPWM::period_us(int us) {
Sissors 4:a7b9f778c4b4 36 if (dynamicPrescaler)
Sissors 4:a7b9f778c4b4 37 calcPrescaler(us * (SystemCoreClock / 1000000));
Sissors 4:a7b9f778c4b4 38
Sissors 4:a7b9f778c4b4 39 period_ticks(us * iticks_us);
Sissors 4:a7b9f778c4b4 40 }
Sissors 4:a7b9f778c4b4 41
Sissors 4:a7b9f778c4b4 42 void FastPWM::period_us(double us) {
Sissors 4:a7b9f778c4b4 43 if (dynamicPrescaler)
Sissors 4:a7b9f778c4b4 44 calcPrescaler((uint64_t)(us * (double)(SystemCoreClock / 1000000)));
Sissors 4:a7b9f778c4b4 45
Sissors 4:a7b9f778c4b4 46 period_ticks(us * dticks_us + 0.5);
Sissors 4:a7b9f778c4b4 47 }
Sissors 4:a7b9f778c4b4 48
Sissors 4:a7b9f778c4b4 49 void FastPWM::pulsewidth(double seconds) {
Sissors 4:a7b9f778c4b4 50 pulsewidth_ticks(seconds * dticks + 0.5);
Sissors 4:a7b9f778c4b4 51 }
Sissors 4:a7b9f778c4b4 52
Sissors 4:a7b9f778c4b4 53 void FastPWM::pulsewidth_ms(int ms) {
Sissors 4:a7b9f778c4b4 54 pulsewidth_ticks(ms * iticks_ms);
Sissors 4:a7b9f778c4b4 55 }
Sissors 4:a7b9f778c4b4 56
Sissors 4:a7b9f778c4b4 57 void FastPWM::pulsewidth_us(int us) {
Sissors 4:a7b9f778c4b4 58 pulsewidth_ticks(us * iticks_us);
Sissors 4:a7b9f778c4b4 59 }
Sissors 4:a7b9f778c4b4 60
Sissors 4:a7b9f778c4b4 61 void FastPWM::pulsewidth_us(double us) {
Sissors 4:a7b9f778c4b4 62 pulsewidth_ticks(us * dticks_us + 0.5);
Sissors 4:a7b9f778c4b4 63 }
Sissors 4:a7b9f778c4b4 64
Sissors 4:a7b9f778c4b4 65 void FastPWM::write(double duty) {
Sissors 4:a7b9f778c4b4 66 _duty=duty;
Sissors 4:a7b9f778c4b4 67 pulsewidth_ticks(duty*getPeriod());
Sissors 4:a7b9f778c4b4 68 }
Sissors 4:a7b9f778c4b4 69
Sissors 4:a7b9f778c4b4 70 double FastPWM::read( void ) {
Sissors 4:a7b9f778c4b4 71 return _duty;
Sissors 4:a7b9f778c4b4 72 }
Sissors 4:a7b9f778c4b4 73
Sissors 4:a7b9f778c4b4 74 FastPWM & FastPWM::operator= (double value) {
Sissors 4:a7b9f778c4b4 75 write(value);
Sissors 4:a7b9f778c4b4 76 return(*this);
Sissors 4:a7b9f778c4b4 77 }
Sissors 4:a7b9f778c4b4 78
Sissors 4:a7b9f778c4b4 79 FastPWM::operator double() {
Sissors 4:a7b9f778c4b4 80 return _duty;
Sissors 4:a7b9f778c4b4 81 }
Sissors 4:a7b9f778c4b4 82
Sissors 4:a7b9f778c4b4 83 int FastPWM::prescaler(int value) {
Sissors 4:a7b9f778c4b4 84 int retval;
Sissors 4:a7b9f778c4b4 85 if (value == -1) {
Sissors 4:a7b9f778c4b4 86 dynamicPrescaler = true;
Sissors 4:a7b9f778c4b4 87 value = 0;
Sissors 4:a7b9f778c4b4 88 }
Sissors 4:a7b9f778c4b4 89 else
Sissors 4:a7b9f778c4b4 90 dynamicPrescaler = false;
Sissors 4:a7b9f778c4b4 91
Sissors 4:a7b9f778c4b4 92 retval = setPrescaler(value);
Sissors 4:a7b9f778c4b4 93 updateTicks(retval);
Sissors 4:a7b9f778c4b4 94 return retval;
Sissors 4:a7b9f778c4b4 95 }
Sissors 4:a7b9f778c4b4 96
Sissors 4:a7b9f778c4b4 97 void FastPWM::updateTicks( uint32_t prescaler ) {
Sissors 4:a7b9f778c4b4 98 dticks = SystemCoreClock / (double)prescaler;
jocis 18:d91c0629e4e6 99 dticks_us = dticks / 1000000.0f;
jocis 18:d91c0629e4e6 100 iticks_us = (int)(dticks_us + 0.5);
jocis 18:d91c0629e4e6 101 iticks_ms = (int)(dticks_us * 1000.0 + 0.5);
Sissors 4:a7b9f778c4b4 102 }
Sissors 4:a7b9f778c4b4 103
Sissors 4:a7b9f778c4b4 104 int FastPWM::calcPrescaler(uint64_t clocks) {
Sissors 4:a7b9f778c4b4 105 uint32_t scale = (clocks >> bits) + 1;
Sissors 4:a7b9f778c4b4 106 uint32_t retval = setPrescaler(scale);
Sissors 4:a7b9f778c4b4 107 updateTicks(retval);
Sissors 4:a7b9f778c4b4 108 return retval;
Sissors 4:a7b9f778c4b4 109 }