ST-DEVKIT-LRWAN
Dependents: DISCO-L072CZ-LRWAN1-base
Fork of SX1276GenericLib by
Arduino-mbed-APIs/arduino-mbed.cpp@91:0bf084e4d983, 2017-12-04 (annotated)
- Committer:
- alphaemmeo
- Date:
- Mon Dec 04 14:21:04 2017 +0000
- Revision:
- 91:0bf084e4d983
- Parent:
- 90:d98572047c9c
base test
Who changed what in which revision?
User | Revision | Line number | New 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 |