Thiago Lima / SX1276GenericLib

test

Dependents:   Telemetria_RX_SD_GPS_copy Telemetria_RX_SD_GPS Telemetria_TX Telemetria_TX ... more

Arduino-mbed-APIs/arduino-mbed.cpp@90:d98572047c9c, 2017-09-17 (annotated)

Committer:
Helmut Tschemernjak
Date:
Sun Sep 17 12:46:18 2017 +0200
Revision:
90:d98572047c9c
Parent:
88:d120930aeb13
Child:
93:c328629726a6
Added better Arduino InitSerial support with Led blinking.

Added initial unload support

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Helmut Tschemernjak 46:e78a1d0391ac 1 /*
Helmut Tschemernjak 65:b2d98328fcba 2 * The file is Licensed under the Apache License, Version 2.0
Helmut Tschemernjak 46:e78a1d0391ac 3 * (c) 2017 Helmut Tschemernjak
Helmut Tschemernjak 46:e78a1d0391ac 4 * 30826 Garbsen (Hannover) Germany
Helmut Tschemernjak 46:e78a1d0391ac 5 */
Helmut Tschemernjak 46:e78a1d0391ac 6
Helmut Tschemernjak 65:b2d98328fcba 7 #ifdef ARDUINO
Helmut Tschemernjak 65:b2d98328fcba 8
Helmut Tschemernjak 65:b2d98328fcba 9 using namespace std;
Helmut Tschemernjak 65:b2d98328fcba 10
Helmut Tschemernjak 65:b2d98328fcba 11 #include "arduino-mbed.h"
Helmut Tschemernjak 75:7330dd86cdea 12 #include "arduino-util.h"
Helmut Tschemernjak 65:b2d98328fcba 13
Helmut Tschemernjak 75:7330dd86cdea 14 Stream *ser;
Helmut Tschemernjak 90:d98572047c9c 15 bool SerialUSB_active;
Helmut Tschemernjak 84:3428e25c7157 16
Helmut Tschemernjak 90:d98572047c9c 17 void InitSerial(Stream *serial, int timeout_ms, DigitalOut *led) {
Helmut Tschemernjak 75:7330dd86cdea 18 ser = serial;
Helmut Tschemernjak 90:d98572047c9c 19 SerialUSB_active = true;
Helmut Tschemernjak 90:d98572047c9c 20 if (!timeout_ms)
Helmut Tschemernjak 90:d98572047c9c 21 return;
Helmut Tschemernjak 84:3428e25c7157 22 if (serial == (Stream *)&SerialUSB) {
Helmut Tschemernjak 84:3428e25c7157 23 uint32_t start = ms_getTicker();
Helmut Tschemernjak 84:3428e25c7157 24
Helmut Tschemernjak 84:3428e25c7157 25 SerialUSB_active = true;
Helmut Tschemernjak 84:3428e25c7157 26 while(!SerialUSB) {
Helmut Tschemernjak 84:3428e25c7157 27 if (ms_getTicker() > start + timeout_ms) {
Helmut Tschemernjak 84:3428e25c7157 28 SerialUSB_active = false;
Helmut Tschemernjak 84:3428e25c7157 29 break;
Helmut Tschemernjak 84:3428e25c7157 30 }
Helmut Tschemernjak 84:3428e25c7157 31 }
Helmut Tschemernjak 84:3428e25c7157 32 if (!SerialUSB_active) {
Helmut Tschemernjak 84:3428e25c7157 33 USB->DEVICE.CTRLA.bit.SWRST = 1; // disconnect the USB Port
Helmut Tschemernjak 84:3428e25c7157 34 while (USB->DEVICE.CTRLA.bit.SWRST == 1);
Helmut Tschemernjak 90:d98572047c9c 35 if (led) {
Helmut Tschemernjak 90:d98572047c9c 36 for (int i = 0; i < 10; i++) {
Helmut Tschemernjak 90:d98572047c9c 37 // lets blink the LED to show that SerialUSB is off.
Helmut Tschemernjak 90:d98572047c9c 38 *led = 1;
Helmut Tschemernjak 90:d98572047c9c 39 delay(80);
Helmut Tschemernjak 90:d98572047c9c 40 *led = 0;
Helmut Tschemernjak 90:d98572047c9c 41 delay(80);
Helmut Tschemernjak 90:d98572047c9c 42 }
Helmut Tschemernjak 90:d98572047c9c 43 }
Helmut Tschemernjak 84:3428e25c7157 44 }
Helmut Tschemernjak 84:3428e25c7157 45 }
Helmut Tschemernjak 75:7330dd86cdea 46 }
Helmut Tschemernjak 65:b2d98328fcba 47
Helmut Tschemernjak 65:b2d98328fcba 48 static void pinInt00(void);
Helmut Tschemernjak 65:b2d98328fcba 49 static void pinInt01(void);
Helmut Tschemernjak 65:b2d98328fcba 50 static void pinInt02(void);
Helmut Tschemernjak 65:b2d98328fcba 51 static void pinInt03(void);
Helmut Tschemernjak 65:b2d98328fcba 52 static void pinInt04(void);
Helmut Tschemernjak 65:b2d98328fcba 53 static void pinInt05(void);
Helmut Tschemernjak 65:b2d98328fcba 54 static void pinInt06(void);
Helmut Tschemernjak 65:b2d98328fcba 55 static void pinInt07(void);
Helmut Tschemernjak 65:b2d98328fcba 56 static void pinInt08(void);
Helmut Tschemernjak 65:b2d98328fcba 57 static void pinInt09(void);
Helmut Tschemernjak 65:b2d98328fcba 58 static void pinInt10(void);
Helmut Tschemernjak 65:b2d98328fcba 59 static void pinInt11(void);
Helmut Tschemernjak 65:b2d98328fcba 60 static void pinInt12(void);
Helmut Tschemernjak 65:b2d98328fcba 61 static void pinInt13(void);
Helmut Tschemernjak 65:b2d98328fcba 62 static void pinInt14(void);
Helmut Tschemernjak 65:b2d98328fcba 63 static void pinInt15(void);
Helmut Tschemernjak 65:b2d98328fcba 64 static void pinInt16(void);
Helmut Tschemernjak 65:b2d98328fcba 65 static void pinInt17(void);
Helmut Tschemernjak 65:b2d98328fcba 66 static void pinInt18(void);
Helmut Tschemernjak 65:b2d98328fcba 67 static void pinInt19(void);
Helmut Tschemernjak 65:b2d98328fcba 68 static void pinInt20(void);
Helmut Tschemernjak 65:b2d98328fcba 69 static void pinInt21(void);
Helmut Tschemernjak 65:b2d98328fcba 70 static void pinInt22(void);
Helmut Tschemernjak 65:b2d98328fcba 71 static void pinInt23(void);
Helmut Tschemernjak 65:b2d98328fcba 72 static void pinInt24(void);
Helmut Tschemernjak 65:b2d98328fcba 73 static void pinInt25(void);
Helmut Tschemernjak 65:b2d98328fcba 74 static void pinInt26(void);
Helmut Tschemernjak 65:b2d98328fcba 75 static void pinInt27(void);
Helmut Tschemernjak 65:b2d98328fcba 76 static void pinInt28(void);
Helmut Tschemernjak 65:b2d98328fcba 77 static void pinInt29(void);
Helmut Tschemernjak 65:b2d98328fcba 78 static void pinInt30(void);
Helmut Tschemernjak 65:b2d98328fcba 79 static void pinInt31(void);
Helmut Tschemernjak 65:b2d98328fcba 80 static void pinInt32(void);
Helmut Tschemernjak 65:b2d98328fcba 81 static void pinInt33(void);
Helmut Tschemernjak 65:b2d98328fcba 82 static void pinInt34(void);
Helmut Tschemernjak 65:b2d98328fcba 83 static void pinInt35(void);
Helmut Tschemernjak 65:b2d98328fcba 84 static void pinInt36(void);
Helmut Tschemernjak 65:b2d98328fcba 85 static void pinInt37(void);
Helmut Tschemernjak 65:b2d98328fcba 86 static void pinInt38(void);
Helmut Tschemernjak 65:b2d98328fcba 87 static void pinInt39(void);
Helmut Tschemernjak 65:b2d98328fcba 88 static void pinInt40(void);
Helmut Tschemernjak 65:b2d98328fcba 89 static void pinInt41(void);
Helmut Tschemernjak 65:b2d98328fcba 90 static void pinInt42(void);
Helmut Tschemernjak 65:b2d98328fcba 91 static void pinInt43(void);
Helmut Tschemernjak 65:b2d98328fcba 92 static void pinInt44(void);
Helmut Tschemernjak 65:b2d98328fcba 93 static void pinInt45(void);
Helmut Tschemernjak 65:b2d98328fcba 94 static void pinInt46(void);
Helmut Tschemernjak 65:b2d98328fcba 95 static void pinInt47(void);
Helmut Tschemernjak 46:e78a1d0391ac 96
Helmut Tschemernjak 46:e78a1d0391ac 97
Helmut Tschemernjak 46:e78a1d0391ac 98
Helmut Tschemernjak 65:b2d98328fcba 99 #define MAX_MCU_PINS 48
Helmut Tschemernjak 65:b2d98328fcba 100 class InterruptIn;
Helmut Tschemernjak 65:b2d98328fcba 101 struct intPtrTable {
Helmut Tschemernjak 65:b2d98328fcba 102 void (*func)(void);
Helmut Tschemernjak 65:b2d98328fcba 103 InterruptIn *context;
Helmut Tschemernjak 65:b2d98328fcba 104 } intPtrTable[MAX_MCU_PINS] = {
Helmut Tschemernjak 65:b2d98328fcba 105 { pinInt00, NULL },
Helmut Tschemernjak 65:b2d98328fcba 106 { pinInt01, NULL },
Helmut Tschemernjak 65:b2d98328fcba 107 { pinInt02, NULL },
Helmut Tschemernjak 65:b2d98328fcba 108 { pinInt03, NULL },
Helmut Tschemernjak 65:b2d98328fcba 109 { pinInt04, NULL },
Helmut Tschemernjak 65:b2d98328fcba 110 { pinInt05, NULL },
Helmut Tschemernjak 65:b2d98328fcba 111 { pinInt06, NULL },
Helmut Tschemernjak 65:b2d98328fcba 112 { pinInt07, NULL },
Helmut Tschemernjak 65:b2d98328fcba 113 { pinInt08, NULL },
Helmut Tschemernjak 65:b2d98328fcba 114 { pinInt09, NULL },
Helmut Tschemernjak 65:b2d98328fcba 115 { pinInt10, NULL },
Helmut Tschemernjak 65:b2d98328fcba 116 { pinInt11, NULL },
Helmut Tschemernjak 65:b2d98328fcba 117 { pinInt12, NULL },
Helmut Tschemernjak 65:b2d98328fcba 118 { pinInt13, NULL },
Helmut Tschemernjak 65:b2d98328fcba 119 { pinInt14, NULL },
Helmut Tschemernjak 65:b2d98328fcba 120 { pinInt15, NULL },
Helmut Tschemernjak 65:b2d98328fcba 121 { pinInt16, NULL },
Helmut Tschemernjak 65:b2d98328fcba 122 { pinInt17, NULL },
Helmut Tschemernjak 65:b2d98328fcba 123 { pinInt18, NULL },
Helmut Tschemernjak 65:b2d98328fcba 124 { pinInt19, NULL },
Helmut Tschemernjak 65:b2d98328fcba 125 { pinInt20, NULL },
Helmut Tschemernjak 65:b2d98328fcba 126 { pinInt21, NULL },
Helmut Tschemernjak 65:b2d98328fcba 127 { pinInt22, NULL },
Helmut Tschemernjak 65:b2d98328fcba 128 { pinInt23, NULL },
Helmut Tschemernjak 65:b2d98328fcba 129 { pinInt24, NULL },
Helmut Tschemernjak 65:b2d98328fcba 130 { pinInt25, NULL },
Helmut Tschemernjak 65:b2d98328fcba 131 { pinInt26, NULL },
Helmut Tschemernjak 65:b2d98328fcba 132 { pinInt27, NULL },
Helmut Tschemernjak 65:b2d98328fcba 133 { pinInt28, NULL },
Helmut Tschemernjak 65:b2d98328fcba 134 { pinInt29, NULL },
Helmut Tschemernjak 65:b2d98328fcba 135 { pinInt30, NULL },
Helmut Tschemernjak 65:b2d98328fcba 136 { pinInt31, NULL },
Helmut Tschemernjak 65:b2d98328fcba 137 { pinInt32, NULL },
Helmut Tschemernjak 65:b2d98328fcba 138 { pinInt33, NULL },
Helmut Tschemernjak 65:b2d98328fcba 139 { pinInt34, NULL },
Helmut Tschemernjak 65:b2d98328fcba 140 { pinInt35, NULL },
Helmut Tschemernjak 65:b2d98328fcba 141 { pinInt36, NULL },
Helmut Tschemernjak 65:b2d98328fcba 142 { pinInt37, NULL },
Helmut Tschemernjak 65:b2d98328fcba 143 { pinInt38, NULL },
Helmut Tschemernjak 65:b2d98328fcba 144 { pinInt39, NULL },
Helmut Tschemernjak 65:b2d98328fcba 145 { pinInt40, NULL },
Helmut Tschemernjak 65:b2d98328fcba 146 { pinInt41, NULL },
Helmut Tschemernjak 65:b2d98328fcba 147 { pinInt42, NULL },
Helmut Tschemernjak 65:b2d98328fcba 148 { pinInt43, NULL },
Helmut Tschemernjak 65:b2d98328fcba 149 { pinInt44, NULL },
Helmut Tschemernjak 65:b2d98328fcba 150 { pinInt45, NULL },
Helmut Tschemernjak 65:b2d98328fcba 151 { pinInt46, NULL },
Helmut Tschemernjak 65:b2d98328fcba 152 { pinInt47, NULL }
Helmut Tschemernjak 65:b2d98328fcba 153 }; // our max MCUs pins
Helmut Tschemernjak 46:e78a1d0391ac 154
Helmut Tschemernjak 46:e78a1d0391ac 155
Helmut Tschemernjak 46:e78a1d0391ac 156
Helmut Tschemernjak 65:b2d98328fcba 157 static void pinInt00(void) { InterruptIn::_irq_handler(intPtrTable[0].context); }
Helmut Tschemernjak 65:b2d98328fcba 158 static void pinInt01(void) { InterruptIn::_irq_handler(intPtrTable[1].context); }
Helmut Tschemernjak 65:b2d98328fcba 159 static void pinInt02(void) { InterruptIn::_irq_handler(intPtrTable[2].context); }
Helmut Tschemernjak 65:b2d98328fcba 160 static void pinInt03(void) { InterruptIn::_irq_handler(intPtrTable[3].context); }
Helmut Tschemernjak 65:b2d98328fcba 161 static void pinInt04(void) { InterruptIn::_irq_handler(intPtrTable[4].context); }
Helmut Tschemernjak 65:b2d98328fcba 162 static void pinInt05(void) { InterruptIn::_irq_handler(intPtrTable[5].context); }
Helmut Tschemernjak 65:b2d98328fcba 163 static void pinInt06(void) { InterruptIn::_irq_handler(intPtrTable[6].context); }
Helmut Tschemernjak 65:b2d98328fcba 164 static void pinInt07(void) { InterruptIn::_irq_handler(intPtrTable[7].context); }
Helmut Tschemernjak 65:b2d98328fcba 165 static void pinInt08(void) { InterruptIn::_irq_handler(intPtrTable[8].context); }
Helmut Tschemernjak 65:b2d98328fcba 166 static void pinInt09(void) { InterruptIn::_irq_handler(intPtrTable[9].context); }
Helmut Tschemernjak 65:b2d98328fcba 167 static void pinInt10(void) { InterruptIn::_irq_handler(intPtrTable[10].context); }
Helmut Tschemernjak 65:b2d98328fcba 168 static void pinInt11(void) { InterruptIn::_irq_handler(intPtrTable[11].context); }
Helmut Tschemernjak 65:b2d98328fcba 169 static void pinInt12(void) { InterruptIn::_irq_handler(intPtrTable[12].context); }
Helmut Tschemernjak 65:b2d98328fcba 170 static void pinInt13(void) { InterruptIn::_irq_handler(intPtrTable[13].context); }
Helmut Tschemernjak 65:b2d98328fcba 171 static void pinInt14(void) { InterruptIn::_irq_handler(intPtrTable[14].context); }
Helmut Tschemernjak 65:b2d98328fcba 172 static void pinInt15(void) { InterruptIn::_irq_handler(intPtrTable[15].context); }
Helmut Tschemernjak 65:b2d98328fcba 173 static void pinInt16(void) { InterruptIn::_irq_handler(intPtrTable[16].context); }
Helmut Tschemernjak 65:b2d98328fcba 174 static void pinInt17(void) { InterruptIn::_irq_handler(intPtrTable[17].context); }
Helmut Tschemernjak 65:b2d98328fcba 175 static void pinInt18(void) { InterruptIn::_irq_handler(intPtrTable[18].context); }
Helmut Tschemernjak 65:b2d98328fcba 176 static void pinInt19(void) { InterruptIn::_irq_handler(intPtrTable[19].context); }
Helmut Tschemernjak 65:b2d98328fcba 177 static void pinInt20(void) { InterruptIn::_irq_handler(intPtrTable[20].context); }
Helmut Tschemernjak 65:b2d98328fcba 178 static void pinInt21(void) { InterruptIn::_irq_handler(intPtrTable[21].context); }
Helmut Tschemernjak 65:b2d98328fcba 179 static void pinInt22(void) { InterruptIn::_irq_handler(intPtrTable[22].context); }
Helmut Tschemernjak 65:b2d98328fcba 180 static void pinInt23(void) { InterruptIn::_irq_handler(intPtrTable[23].context); }
Helmut Tschemernjak 65:b2d98328fcba 181 static void pinInt24(void) { InterruptIn::_irq_handler(intPtrTable[24].context); }
Helmut Tschemernjak 65:b2d98328fcba 182 static void pinInt25(void) { InterruptIn::_irq_handler(intPtrTable[25].context); }
Helmut Tschemernjak 65:b2d98328fcba 183 static void pinInt26(void) { InterruptIn::_irq_handler(intPtrTable[26].context); }
Helmut Tschemernjak 65:b2d98328fcba 184 static void pinInt27(void) { InterruptIn::_irq_handler(intPtrTable[27].context); }
Helmut Tschemernjak 65:b2d98328fcba 185 static void pinInt28(void) { InterruptIn::_irq_handler(intPtrTable[28].context); }
Helmut Tschemernjak 65:b2d98328fcba 186 static void pinInt29(void) { InterruptIn::_irq_handler(intPtrTable[29].context); }
Helmut Tschemernjak 65:b2d98328fcba 187 static void pinInt30(void) { InterruptIn::_irq_handler(intPtrTable[30].context); }
Helmut Tschemernjak 65:b2d98328fcba 188 static void pinInt31(void) { InterruptIn::_irq_handler(intPtrTable[31].context); }
Helmut Tschemernjak 65:b2d98328fcba 189 static void pinInt32(void) { InterruptIn::_irq_handler(intPtrTable[32].context); }
Helmut Tschemernjak 65:b2d98328fcba 190 static void pinInt33(void) { InterruptIn::_irq_handler(intPtrTable[33].context); }
Helmut Tschemernjak 65:b2d98328fcba 191 static void pinInt34(void) { InterruptIn::_irq_handler(intPtrTable[34].context); }
Helmut Tschemernjak 65:b2d98328fcba 192 static void pinInt35(void) { InterruptIn::_irq_handler(intPtrTable[35].context); }
Helmut Tschemernjak 65:b2d98328fcba 193 static void pinInt36(void) { InterruptIn::_irq_handler(intPtrTable[36].context); }
Helmut Tschemernjak 65:b2d98328fcba 194 static void pinInt37(void) { InterruptIn::_irq_handler(intPtrTable[37].context); }
Helmut Tschemernjak 65:b2d98328fcba 195 static void pinInt38(void) { InterruptIn::_irq_handler(intPtrTable[38].context); }
Helmut Tschemernjak 65:b2d98328fcba 196 static void pinInt39(void) { InterruptIn::_irq_handler(intPtrTable[39].context); }
Helmut Tschemernjak 65:b2d98328fcba 197 static void pinInt40(void) { InterruptIn::_irq_handler(intPtrTable[40].context); }
Helmut Tschemernjak 65:b2d98328fcba 198 static void pinInt41(void) { InterruptIn::_irq_handler(intPtrTable[41].context); }
Helmut Tschemernjak 65:b2d98328fcba 199 static void pinInt42(void) { InterruptIn::_irq_handler(intPtrTable[42].context); }
Helmut Tschemernjak 65:b2d98328fcba 200 static void pinInt43(void) { InterruptIn::_irq_handler(intPtrTable[43].context); }
Helmut Tschemernjak 65:b2d98328fcba 201 static void pinInt44(void) { InterruptIn::_irq_handler(intPtrTable[44].context); }
Helmut Tschemernjak 65:b2d98328fcba 202 static void pinInt45(void) { InterruptIn::_irq_handler(intPtrTable[45].context); }
Helmut Tschemernjak 65:b2d98328fcba 203 static void pinInt46(void) { InterruptIn::_irq_handler(intPtrTable[46].context); }
Helmut Tschemernjak 65:b2d98328fcba 204 static void pinInt47(void) { InterruptIn::_irq_handler(intPtrTable[47].context); }
Helmut Tschemernjak 46:e78a1d0391ac 205
Helmut Tschemernjak 46:e78a1d0391ac 206
Helmut Tschemernjak 80:62f0b027efff 207 void wait_ms(uint32_t ms)
Helmut Tschemernjak 80:62f0b027efff 208 {
Helmut Tschemernjak 80:62f0b027efff 209 uint32_t start = ms_getTicker();
Helmut Tschemernjak 80:62f0b027efff 210
Helmut Tschemernjak 80:62f0b027efff 211 while (true) {
Helmut Tschemernjak 80:62f0b027efff 212 uint32_t t = ms_getTicker();
Helmut Tschemernjak 80:62f0b027efff 213 if (t < start) // warp.
Helmut Tschemernjak 80:62f0b027efff 214 start = 0;
Helmut Tschemernjak 80:62f0b027efff 215 if (t > (start + ms))
Helmut Tschemernjak 80:62f0b027efff 216 break;
Helmut Tschemernjak 80:62f0b027efff 217 }
Helmut Tschemernjak 80:62f0b027efff 218 }
Helmut Tschemernjak 80:62f0b027efff 219
Helmut Tschemernjak 77:7f227a4dffe6 220 struct TimeoutVector TimeOuts[MAX_TIMEOUTS];
Helmut Tschemernjak 46:e78a1d0391ac 221
Helmut Tschemernjak 65:b2d98328fcba 222 void
Helmut Tschemernjak 65:b2d98328fcba 223 InterruptIn::rise(Callback<void()> func) {
Helmut Tschemernjak 65:b2d98328fcba 224 if (_gpioPin >= MAX_MCU_PINS-1)
Helmut Tschemernjak 65:b2d98328fcba 225 return;
Helmut Tschemernjak 65:b2d98328fcba 226 if (func) {
Helmut Tschemernjak 65:b2d98328fcba 227 _func = func;
Helmut Tschemernjak 65:b2d98328fcba 228 intPtrTable[_gpioPin].context = this;
Helmut Tschemernjak 69:d440a5b04708 229 attachInterrupt(MYdigitalPinToInterrupt(_gpioPin), intPtrTable[_gpioPin].func, RISING);
Helmut Tschemernjak 65:b2d98328fcba 230 } else {
Helmut Tschemernjak 65:b2d98328fcba 231 _func = InterruptIn::donothing;
Helmut Tschemernjak 65:b2d98328fcba 232 intPtrTable[_gpioPin].context = NULL;
Helmut Tschemernjak 65:b2d98328fcba 233 detachInterrupt(_gpioPin);
Helmut Tschemernjak 46:e78a1d0391ac 234 }
Helmut Tschemernjak 65:b2d98328fcba 235 };
Helmut Tschemernjak 46:e78a1d0391ac 236
Helmut Tschemernjak 65:b2d98328fcba 237 void
Helmut Tschemernjak 65:b2d98328fcba 238 InterruptIn::fall(Callback<void()> func) {
Helmut Tschemernjak 65:b2d98328fcba 239 if (func) {
Helmut Tschemernjak 65:b2d98328fcba 240 _func = func;
Helmut Tschemernjak 65:b2d98328fcba 241 intPtrTable[_gpioPin].context = this;
Helmut Tschemernjak 69:d440a5b04708 242 attachInterrupt(MYdigitalPinToInterrupt(_gpioPin), intPtrTable[_gpioPin].func, FALLING);
Helmut Tschemernjak 65:b2d98328fcba 243 } else {
Helmut Tschemernjak 65:b2d98328fcba 244 _func = InterruptIn::donothing;
Helmut Tschemernjak 65:b2d98328fcba 245 intPtrTable[_gpioPin].context = NULL;
Helmut Tschemernjak 65:b2d98328fcba 246 detachInterrupt(_gpioPin);
Helmut Tschemernjak 46:e78a1d0391ac 247 }
Helmut Tschemernjak 46:e78a1d0391ac 248 }
Helmut Tschemernjak 46:e78a1d0391ac 249
Helmut Tschemernjak 88:d120930aeb13 250 void
Helmut Tschemernjak 88:d120930aeb13 251 InterruptIn::high(Callback<void()> func) {
Helmut Tschemernjak 88:d120930aeb13 252 if (func) {
Helmut Tschemernjak 88:d120930aeb13 253 _func = func;
Helmut Tschemernjak 88:d120930aeb13 254 intPtrTable[_gpioPin].context = this;
Helmut Tschemernjak 88:d120930aeb13 255 attachInterrupt(MYdigitalPinToInterrupt(_gpioPin), intPtrTable[_gpioPin].func, HIGH);
Helmut Tschemernjak 88:d120930aeb13 256 } else {
Helmut Tschemernjak 88:d120930aeb13 257 _func = InterruptIn::donothing;
Helmut Tschemernjak 88:d120930aeb13 258 intPtrTable[_gpioPin].context = NULL;
Helmut Tschemernjak 88:d120930aeb13 259 detachInterrupt(_gpioPin);
Helmut Tschemernjak 88:d120930aeb13 260 }
Helmut Tschemernjak 88:d120930aeb13 261 }
Helmut Tschemernjak 88:d120930aeb13 262
Helmut Tschemernjak 88:d120930aeb13 263 void
Helmut Tschemernjak 88:d120930aeb13 264 InterruptIn::low(Callback<void()> func) {
Helmut Tschemernjak 88:d120930aeb13 265 if (func) {
Helmut Tschemernjak 88:d120930aeb13 266 _func = func;
Helmut Tschemernjak 88:d120930aeb13 267 intPtrTable[_gpioPin].context = this;
Helmut Tschemernjak 88:d120930aeb13 268 attachInterrupt(MYdigitalPinToInterrupt(_gpioPin), intPtrTable[_gpioPin].func, LOW);
Helmut Tschemernjak 88:d120930aeb13 269 } else {
Helmut Tschemernjak 88:d120930aeb13 270 _func = InterruptIn::donothing;
Helmut Tschemernjak 88:d120930aeb13 271 intPtrTable[_gpioPin].context = NULL;
Helmut Tschemernjak 88:d120930aeb13 272 detachInterrupt(_gpioPin);
Helmut Tschemernjak 88:d120930aeb13 273 }
Helmut Tschemernjak 88:d120930aeb13 274 }
Helmut Tschemernjak 88:d120930aeb13 275
Helmut Tschemernjak 88:d120930aeb13 276
Helmut Tschemernjak 88:d120930aeb13 277
Helmut Tschemernjak 46:e78a1d0391ac 278
Helmut Tschemernjak 70:1d496aae2819 279 uint32_t s_getTicker(void)
Helmut Tschemernjak 70:1d496aae2819 280 {
Helmut Tschemernjak 70:1d496aae2819 281 long long ns = ns_getTicker();
Helmut Tschemernjak 70:1d496aae2819 282 ns /= (long long)1000000000; // to secs
Helmut Tschemernjak 70:1d496aae2819 283
Helmut Tschemernjak 70:1d496aae2819 284 int secs = ns;
Helmut Tschemernjak 70:1d496aae2819 285 return secs;
Helmut Tschemernjak 70:1d496aae2819 286 }
Helmut Tschemernjak 70:1d496aae2819 287
Helmut Tschemernjak 70:1d496aae2819 288
Helmut Tschemernjak 67:d3afd803f40d 289 uint32_t ms_getTicker(void)
Helmut Tschemernjak 67:d3afd803f40d 290 {
Helmut Tschemernjak 67:d3afd803f40d 291 uint32_t us = us_getTicker();
Helmut Tschemernjak 67:d3afd803f40d 292
Helmut Tschemernjak 67:d3afd803f40d 293 us /= 1000; // to ms
Helmut Tschemernjak 67:d3afd803f40d 294 return us;
Helmut Tschemernjak 67:d3afd803f40d 295 }
Helmut Tschemernjak 67:d3afd803f40d 296
Helmut Tschemernjak 67:d3afd803f40d 297 uint32_t us_getTicker(void)
Helmut Tschemernjak 67:d3afd803f40d 298 {
Helmut Tschemernjak 67:d3afd803f40d 299 long long ns = ns_getTicker();
Helmut Tschemernjak 67:d3afd803f40d 300
Helmut Tschemernjak 67:d3afd803f40d 301 ns /= (long long)1000; // to us
Helmut Tschemernjak 67:d3afd803f40d 302 uint32_t us = ns & 0xffffffff;
Helmut Tschemernjak 67:d3afd803f40d 303
Helmut Tschemernjak 67:d3afd803f40d 304 return us;
Helmut Tschemernjak 67:d3afd803f40d 305 }
Helmut Tschemernjak 67:d3afd803f40d 306
Helmut Tschemernjak 67:d3afd803f40d 307
Helmut Tschemernjak 65:b2d98328fcba 308 void
Helmut Tschemernjak 65:b2d98328fcba 309 Timeout::insert(void)
Helmut Tschemernjak 65:b2d98328fcba 310 {
Helmut Tschemernjak 65:b2d98328fcba 311 noInterrupts();
Helmut Tschemernjak 65:b2d98328fcba 312 for (int i = 0; i < MAX_TIMEOUTS-1; i++) {
Helmut Tschemernjak 65:b2d98328fcba 313 struct TimeoutVector *tvp = &TimeOuts[i];
Helmut Tschemernjak 79:8ae448a3c1fd 314 if (tvp->timer == this) // already here, timer has been restartet.
Helmut Tschemernjak 79:8ae448a3c1fd 315 break;
Helmut Tschemernjak 65:b2d98328fcba 316 if (tvp->timer == NULL) {
Helmut Tschemernjak 65:b2d98328fcba 317 tvp->timer = this;
Helmut Tschemernjak 65:b2d98328fcba 318 break;
Helmut Tschemernjak 65:b2d98328fcba 319 }
Helmut Tschemernjak 65:b2d98328fcba 320 }
Helmut Tschemernjak 65:b2d98328fcba 321 interrupts();
Helmut Tschemernjak 65:b2d98328fcba 322 }
Helmut Tschemernjak 65:b2d98328fcba 323
Helmut Tschemernjak 65:b2d98328fcba 324 void
Helmut Tschemernjak 65:b2d98328fcba 325 Timeout::remove(void)
Helmut Tschemernjak 65:b2d98328fcba 326 {
Helmut Tschemernjak 65:b2d98328fcba 327 noInterrupts();
Helmut Tschemernjak 65:b2d98328fcba 328 for (int i = 0; i < MAX_TIMEOUTS-1; i++) {
Helmut Tschemernjak 65:b2d98328fcba 329 struct TimeoutVector *tvp = &TimeOuts[i];
Helmut Tschemernjak 65:b2d98328fcba 330 if (tvp->timer == this) {
Helmut Tschemernjak 65:b2d98328fcba 331 tvp->timer = NULL;
Helmut Tschemernjak 65:b2d98328fcba 332 break;
Helmut Tschemernjak 65:b2d98328fcba 333 }
Helmut Tschemernjak 65:b2d98328fcba 334 }
Helmut Tschemernjak 65:b2d98328fcba 335 interrupts();
Helmut Tschemernjak 65:b2d98328fcba 336 }
Helmut Tschemernjak 65:b2d98328fcba 337
Helmut Tschemernjak 65:b2d98328fcba 338
Helmut Tschemernjak 65:b2d98328fcba 339 void
Helmut Tschemernjak 67:d3afd803f40d 340 Timeout::restart()
Helmut Tschemernjak 65:b2d98328fcba 341 {
Helmut Tschemernjak 77:7f227a4dffe6 342 Tcc *t = getTimeout_tcc();
Helmut Tschemernjak 67:d3afd803f40d 343 uint64_t timeout = ~0;
Helmut Tschemernjak 65:b2d98328fcba 344
Helmut Tschemernjak 65:b2d98328fcba 345 /*
Helmut Tschemernjak 65:b2d98328fcba 346 * find the lowest timeout value which is our the next timeout
Helmut Tschemernjak 65:b2d98328fcba 347 * zero means stop the timer.
Helmut Tschemernjak 65:b2d98328fcba 348 */
Helmut Tschemernjak 65:b2d98328fcba 349 noInterrupts();
Helmut Tschemernjak 65:b2d98328fcba 350 for (int i = 0; i < MAX_TIMEOUTS-1; i++) {
Helmut Tschemernjak 65:b2d98328fcba 351 struct TimeoutVector *tvp = &TimeOuts[i];
Helmut Tschemernjak 67:d3afd803f40d 352 if (tvp->timer) {
Helmut Tschemernjak 67:d3afd803f40d 353 if (tvp->timer->_timeout < timeout) {
Helmut Tschemernjak 67:d3afd803f40d 354 timeout = tvp->timer->_timeout;
Helmut Tschemernjak 65:b2d98328fcba 355 }
Helmut Tschemernjak 65:b2d98328fcba 356 }
Helmut Tschemernjak 65:b2d98328fcba 357 }
Helmut Tschemernjak 65:b2d98328fcba 358 interrupts();
Helmut Tschemernjak 65:b2d98328fcba 359
Helmut Tschemernjak 67:d3afd803f40d 360 if (timeout == (uint64_t)~0) {
Helmut Tschemernjak 67:d3afd803f40d 361 stopTimer(t);
Helmut Tschemernjak 65:b2d98328fcba 362 return;
Helmut Tschemernjak 65:b2d98328fcba 363 }
Helmut Tschemernjak 67:d3afd803f40d 364
Helmut Tschemernjak 67:d3afd803f40d 365 uint64_t nsecs = ns_getTicker();
Helmut Tschemernjak 65:b2d98328fcba 366
Helmut Tschemernjak 67:d3afd803f40d 367 if (timeout > nsecs) {
Helmut Tschemernjak 67:d3afd803f40d 368 startTimer(t, (uint64_t)timeout - (uint64_t)nsecs);
Helmut Tschemernjak 65:b2d98328fcba 369 return;
Helmut Tschemernjak 65:b2d98328fcba 370 } else {
Helmut Tschemernjak 67:d3afd803f40d 371 startTimer(t, (uint64_t)1); // just one nsec to trigger interrrupt
Helmut Tschemernjak 65:b2d98328fcba 372 }
Helmut Tschemernjak 65:b2d98328fcba 373 }
Helmut Tschemernjak 67:d3afd803f40d 374
Helmut Tschemernjak 46:e78a1d0391ac 375 #endif // ARDUINO