u-blox / WakeUp

Fork of original library to fix mbed 5 deprecation warnings

Dependencies:   LPC1114_WakeInterruptIn

Dependents:   low-power-sleep

Fork of WakeUp by Erik -

Device/WakeUp_LPC11XX.cpp@23:884e86933aaa, 2017-04-10 (annotated)

Committer:
RobMeades
Date:
Mon Apr 10 13:05:23 2017 +0000
Revision:
23:884e86933aaa
Parent:
14:6bf547e1e62d 
Fix deprecation warnings.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Sissors 10:c41bc9154a7c 1 /**
Sissors 10:c41bc9154a7c 2 See homepage of this lib for LPC11xx special treatment
Sissors 10:c41bc9154a7c 3 **/
Sissors 10:c41bc9154a7c 4
Sissors 10:c41bc9154a7c 5 #ifdef TARGET_LPC11XX_11CXX
Sissors 10:c41bc9154a7c 6
Sissors 10:c41bc9154a7c 7 #include "WakeUp.h"
Sissors 10:c41bc9154a7c 8 #include "WakeInterruptIn.h"
Sissors 12:779d866b8a2d 9 #include "pinmap.h"
Sissors 13:fd24cec76d5a 10 #include "toolchain.h"
Sissors 10:c41bc9154a7c 11
Sissors 11:72db657fc572 12 //Pin used, allowed pins = P0_1 (dp24, default), P0_8 (dp1) and P0_9 (dp2)
Sissors 11:72db657fc572 13 //By defining WakeUpPin in for example your main.cpp this can be overridden
Sissors 11:72db657fc572 14 WEAK PinName WakeUpPin = dp24;
Sissors 11:72db657fc572 15 extern PinName WakeUpPin;
Sissors 11:72db657fc572 16
Sissors 11:72db657fc572 17 WakeInterruptIn IRQ_in(WakeUpPin);
Sissors 11:72db657fc572 18 PwmOut pulse_out(WakeUpPin);
Sissors 10:c41bc9154a7c 19
RobMeades 23:884e86933aaa 20 Callback<void()> WakeUp::cbk;
Sissors 10:c41bc9154a7c 21 float WakeUp::cycles_per_ms = 20.0;
Sissors 10:c41bc9154a7c 22
Sissors 10:c41bc9154a7c 23 static uint32_t old_clk_sel = ~0;
Sissors 10:c41bc9154a7c 24 static uint32_t SYSAHBCLKCTRL;
Sissors 10:c41bc9154a7c 25 static uint32_t TCR, PR, MR3;
Sissors 11:72db657fc572 26 static LPC_TMR_TypeDef *WakeUpTimer;
Sissors 11:72db657fc572 27 static uint32_t SYSAHBCLKCTRL_Sleep;
Sissors 11:72db657fc572 28 static uint8_t WakeUpTimer_Match;
Sissors 10:c41bc9154a7c 29
Sissors 10:c41bc9154a7c 30 static inline void restore(void);
Sissors 10:c41bc9154a7c 31
Sissors 10:c41bc9154a7c 32
Sissors 10:c41bc9154a7c 33 void WakeUp::set_ms(uint32_t ms)
Sissors 10:c41bc9154a7c 34 {
Sissors 11:72db657fc572 35 if (old_clk_sel == ~0) { //Only during first run
Sissors 11:72db657fc572 36 old_clk_sel = LPC_SYSCON->MAINCLKSEL;
Sissors 11:72db657fc572 37 SYSAHBCLKCTRL = LPC_SYSCON->SYSAHBCLKCTRL;
Sissors 10:c41bc9154a7c 38
Sissors 11:72db657fc572 39 switch(WakeUpPin) {
Sissors 11:72db657fc572 40 case dp24:
Sissors 11:72db657fc572 41 WakeUpTimer = LPC_TMR32B0;
Sissors 11:72db657fc572 42 SYSAHBCLKCTRL_Sleep = 0x15 | (1<<9);
Sissors 11:72db657fc572 43 WakeUpTimer_Match = 2;
Sissors 11:72db657fc572 44 break;
Sissors 11:72db657fc572 45 case dp1:
Sissors 11:72db657fc572 46 WakeUpTimer = LPC_TMR16B0;
Sissors 11:72db657fc572 47 SYSAHBCLKCTRL_Sleep = 0x15 | (1<<7);
Sissors 11:72db657fc572 48 WakeUpTimer_Match = 0;
Sissors 11:72db657fc572 49 break;
Sissors 11:72db657fc572 50 case dp2:
Sissors 11:72db657fc572 51 WakeUpTimer = LPC_TMR16B0;
Sissors 11:72db657fc572 52 SYSAHBCLKCTRL_Sleep = 0x15 | (1<<7);
Sissors 11:72db657fc572 53 WakeUpTimer_Match = 1;
Sissors 11:72db657fc572 54 break;
Sissors 11:72db657fc572 55 default:
Sissors 11:72db657fc572 56 error("Invalid WakeUp pin, choose dp1, dp2 or dp24");
Sissors 11:72db657fc572 57 }
Sissors 11:72db657fc572 58 }
Sissors 11:72db657fc572 59
Sissors 11:72db657fc572 60 if (ms != 0) {
Sissors 11:72db657fc572 61 if (LPC_SYSCON->SYSAHBCLKCTRL != SYSAHBCLKCTRL_Sleep) //Always when it is different from sleep settings
Sissors 10:c41bc9154a7c 62 SYSAHBCLKCTRL = LPC_SYSCON->SYSAHBCLKCTRL;
Sissors 10:c41bc9154a7c 63
Sissors 10:c41bc9154a7c 64 LPC_SYSCON->PDRUNCFG &= ~PDRUNCFG_WDTOSC_PD;
Sissors 10:c41bc9154a7c 65 LPC_SYSCON->PDSLEEPCFG = 0x000018B7 | (LPC_SYSCON->PDRUNCFG & (PDRUNCFG_WDTOSC_PD | PDRUNCFG_BOD_PD));
Sissors 10:c41bc9154a7c 66
Sissors 10:c41bc9154a7c 67 //Set oscillator for 20kHz
Sissors 10:c41bc9154a7c 68 LPC_SYSCON->WDTOSCCTRL = 14 | (1<<5);
Sissors 10:c41bc9154a7c 69
Sissors 10:c41bc9154a7c 70 //Store old PWM
Sissors 11:72db657fc572 71 TCR = WakeUpTimer->TCR;
Sissors 11:72db657fc572 72 PR = WakeUpTimer->PR;
Sissors 11:72db657fc572 73 MR3 = WakeUpTimer->MR3;
Sissors 10:c41bc9154a7c 74
Sissors 10:c41bc9154a7c 75 //Setup PWM
Sissors 11:72db657fc572 76 WakeUpTimer->TCR = TMR16B0TCR_CRST;
Sissors 10:c41bc9154a7c 77 uint32_t ticks = (float)ms * cycles_per_ms;
Sissors 10:c41bc9154a7c 78
Sissors 10:c41bc9154a7c 79 //whatever timer it is, we treat it as 16-bit (with PR that is 32-bit still, do the math, it is enough for this)
Sissors 11:72db657fc572 80 WakeUpTimer->PR = ticks >> 16;
Sissors 11:72db657fc572 81 WakeUpTimer->MR[WakeUpTimer_Match] = ticks / ((ticks >> 16) + 1);
Sissors 11:72db657fc572 82 WakeUpTimer->MR3 = 0xFFFF;
Sissors 10:c41bc9154a7c 83
Sissors 10:c41bc9154a7c 84 IRQ_in.rise(irq_handler);
Sissors 10:c41bc9154a7c 85
Sissors 10:c41bc9154a7c 86 //Disable most peripherals
Sissors 11:72db657fc572 87 LPC_SYSCON->SYSAHBCLKCTRL = SYSAHBCLKCTRL_Sleep;
Sissors 10:c41bc9154a7c 88
Sissors 10:c41bc9154a7c 89 //Switch clock to WD OSC
Sissors 10:c41bc9154a7c 90 LPC_SYSCON->MAINCLKSEL = 0x2;
Sissors 10:c41bc9154a7c 91 LPC_SYSCON->MAINCLKUEN = 0;
Sissors 10:c41bc9154a7c 92 LPC_SYSCON->MAINCLKUEN = MAINCLKUEN_ENA;
Sissors 10:c41bc9154a7c 93
Sissors 10:c41bc9154a7c 94 //Enable PWM:
Sissors 11:72db657fc572 95 WakeUpTimer->TCR = TMR16B0TCR_CEN;
Sissors 10:c41bc9154a7c 96 } else {
Sissors 10:c41bc9154a7c 97 //Else restore normal settings
Sissors 10:c41bc9154a7c 98 restore();
Sissors 10:c41bc9154a7c 99 }
Sissors 10:c41bc9154a7c 100
Sissors 10:c41bc9154a7c 101 }
Sissors 10:c41bc9154a7c 102
Sissors 10:c41bc9154a7c 103 void WakeUp::irq_handler(void)
Sissors 10:c41bc9154a7c 104 {
Sissors 10:c41bc9154a7c 105 restore();
RobMeades 23:884e86933aaa 106 if (cbk) {
RobMeades 23:884e86933aaa 107 cbk.call();
RobMeades 23:884e86933aaa 108 }
Sissors 10:c41bc9154a7c 109 }
Sissors 10:c41bc9154a7c 110
Sissors 10:c41bc9154a7c 111 void WakeUp::calibrate(void)
Sissors 10:c41bc9154a7c 112 {
Sissors 14:6bf547e1e62d 113 //Save current pin function
Sissors 14:6bf547e1e62d 114 __IO uint32_t *reg = (__IO uint32_t*)(LPC_IOCON_BASE + (dp24 & 0xFF));
Sissors 14:6bf547e1e62d 115 uint32_t old_pinfun = *reg;
Sissors 14:6bf547e1e62d 116
Sissors 12:779d866b8a2d 117 //Set oscillator for 20kHz
Sissors 12:779d866b8a2d 118 LPC_SYSCON->PDRUNCFG &= ~PDRUNCFG_WDTOSC_PD;
Sissors 12:779d866b8a2d 119 LPC_SYSCON->WDTOSCCTRL = 14 | (1<<5);
Sissors 12:779d866b8a2d 120
Sissors 12:779d866b8a2d 121 //Direct WDT to the CLKOUT pin (dp24), sample it back
Sissors 12:779d866b8a2d 122 DigitalIn din(dp24);
Sissors 12:779d866b8a2d 123 Timer timer;
Sissors 12:779d866b8a2d 124
Sissors 12:779d866b8a2d 125 LPC_SYSCON->CLKOUTDIV = 1;
Sissors 12:779d866b8a2d 126 LPC_SYSCON->CLKOUTCLKSEL = 0x2;
Sissors 12:779d866b8a2d 127 LPC_SYSCON->CLKOUTUEN = 0;
Sissors 12:779d866b8a2d 128 LPC_SYSCON->CLKOUTUEN = CLKOUTUEN_ENA;
Sissors 12:779d866b8a2d 129 pin_function(dp24, 1);
Sissors 12:779d866b8a2d 130
Sissors 12:779d866b8a2d 131 int count = 0;
Sissors 12:779d866b8a2d 132 timer.start();
Sissors 12:779d866b8a2d 133 while (timer.read_ms() < 100) {
Sissors 12:779d866b8a2d 134 while (din.read() == 0);
Sissors 12:779d866b8a2d 135 while (din.read() == 1);
Sissors 12:779d866b8a2d 136 count++;
Sissors 12:779d866b8a2d 137 }
Sissors 12:779d866b8a2d 138 cycles_per_ms = (float)count / 100.0f;
Sissors 14:6bf547e1e62d 139
Sissors 14:6bf547e1e62d 140 //Set old pin function back, disable CLKOUT
Sissors 14:6bf547e1e62d 141 *reg = old_pinfun;
Sissors 14:6bf547e1e62d 142 LPC_SYSCON->CLKOUTDIV = 0;
Sissors 10:c41bc9154a7c 143 }
Sissors 10:c41bc9154a7c 144
Sissors 10:c41bc9154a7c 145 static inline void restore(void) {
Sissors 10:c41bc9154a7c 146
Sissors 11:72db657fc572 147 WakeUpTimer->MR[WakeUpTimer_Match] = 0xFFFFFFFF;
Sissors 10:c41bc9154a7c 148
Sissors 10:c41bc9154a7c 149 if (old_clk_sel == 3) //Was running on PLL
Sissors 10:c41bc9154a7c 150 while(LPC_SYSCON->SYSPLLSTAT != SYSPLLSTAT_LOCK);
Sissors 10:c41bc9154a7c 151
Sissors 10:c41bc9154a7c 152 if (old_clk_sel < 4) { //If valid setting
Sissors 10:c41bc9154a7c 153 LPC_SYSCON->MAINCLKSEL = old_clk_sel;
Sissors 10:c41bc9154a7c 154 LPC_SYSCON->MAINCLKUEN = 0;
Sissors 10:c41bc9154a7c 155 LPC_SYSCON->MAINCLKUEN = MAINCLKUEN_ENA;
Sissors 10:c41bc9154a7c 156 }
Sissors 10:c41bc9154a7c 157
Sissors 10:c41bc9154a7c 158 IRQ_in.rise(NULL);
Sissors 10:c41bc9154a7c 159
Sissors 10:c41bc9154a7c 160 LPC_SYSCON->SYSAHBCLKCTRL = SYSAHBCLKCTRL;
Sissors 10:c41bc9154a7c 161
Sissors 11:72db657fc572 162 WakeUpTimer->MR3 = MR3;
Sissors 11:72db657fc572 163 WakeUpTimer->PR = PR;
Sissors 11:72db657fc572 164 WakeUpTimer->TCR = TCR;
Sissors 10:c41bc9154a7c 165 }
Sissors 10:c41bc9154a7c 166
Sissors 10:c41bc9154a7c 167 #endif