Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: X_NUCLEO_IKS01A1 MLX90614 d7a_1x wizzi-utils
Fork of D7A_1x_demo_sensors_OS5 by
main.cpp@1:711fb7d8127b, 2016-12-21 (annotated)
- Committer:
- Jeej
- Date:
- Wed Dec 21 14:22:00 2016 +0000
- Revision:
- 1:711fb7d8127b
- Parent:
- 0:7e1fdc4d6e1c
- Child:
- 3:5f2917933ece
Reduced stack size to fit new target.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Jeej | 0:7e1fdc4d6e1c | 1 | // This project is a demo of the DASH7 1.x stack |
Jeej | 0:7e1fdc4d6e1c | 2 | // @autor: jeremie@wizzilab.com |
Jeej | 0:7e1fdc4d6e1c | 3 | // @date: 2016-12-20 |
Jeej | 0:7e1fdc4d6e1c | 4 | // |
Jeej | 0:7e1fdc4d6e1c | 5 | // ----- SETUP ----- |
Jeej | 0:7e1fdc4d6e1c | 6 | // This programm has been tested with the following hardware: |
Jeej | 0:7e1fdc4d6e1c | 7 | // --> NUCLEO-L152RE + DASH7 enabled SHIELD_SP1ML_v1.0 |
Jeej | 0:7e1fdc4d6e1c | 8 | // For this demo to work, you need the previously described hardware. |
Jeej | 0:7e1fdc4d6e1c | 9 | // A DASH7 1.x gateway have to be available in your area in order to retreive the data. |
Jeej | 0:7e1fdc4d6e1c | 10 | // |
Jeej | 0:7e1fdc4d6e1c | 11 | // ----- FILE SYSTEM ----- |
Jeej | 0:7e1fdc4d6e1c | 12 | // DASH7 is a file system based protocol. You read and write in files that are present on your device or your modem. |
Jeej | 0:7e1fdc4d6e1c | 13 | // Some callbacks can be implemented by the user for allowing the stack to acceed the local file system. (See description of the callbacks for more details) |
Jeej | 0:7e1fdc4d6e1c | 14 | // The file system is user defined and can be changed to fit your needs. |
Jeej | 0:7e1fdc4d6e1c | 15 | // This demo uses a simple RAM file system. |
Jeej | 0:7e1fdc4d6e1c | 16 | // The files are defined in files.h |
Jeej | 0:7e1fdc4d6e1c | 17 | // The files values are initialized in files.cpp |
Jeej | 0:7e1fdc4d6e1c | 18 | // |
Jeej | 0:7e1fdc4d6e1c | 19 | // ----- SENSORS ----- |
Jeej | 0:7e1fdc4d6e1c | 20 | // The sensors can be simulated (random data). |
Jeej | 0:7e1fdc4d6e1c | 21 | // |
Jeej | 0:7e1fdc4d6e1c | 22 | // ----- DEMO ----- |
Jeej | 0:7e1fdc4d6e1c | 23 | // This demo starts 7 threads (one for each sensor value) that will periodically read the sensor value |
Jeej | 0:7e1fdc4d6e1c | 24 | // and depending on the sensor configuration file, will send the data to the DASH7 network (notification) |
Jeej | 0:7e1fdc4d6e1c | 25 | // You can also report the alarm status by pushing the board's button (blue) |
Jeej | 0:7e1fdc4d6e1c | 26 | // |
Jeej | 0:7e1fdc4d6e1c | 27 | // ----- DEBUG ----- |
Jeej | 0:7e1fdc4d6e1c | 28 | // Several debugging options are available in wizzi-utils/dbg/dbg.h |
Jeej | 0:7e1fdc4d6e1c | 29 | // An ASSERT is a fatal error. By default, this error will reboot the device. |
Jeej | 0:7e1fdc4d6e1c | 30 | |
Jeej | 0:7e1fdc4d6e1c | 31 | #include "mbed.h" |
Jeej | 0:7e1fdc4d6e1c | 32 | #include "rtos.h" |
Jeej | 0:7e1fdc4d6e1c | 33 | #include "rtos_idle.h" |
Jeej | 0:7e1fdc4d6e1c | 34 | #include "d7a.h" |
Jeej | 0:7e1fdc4d6e1c | 35 | #include "sensors.h" |
Jeej | 0:7e1fdc4d6e1c | 36 | #include "simul.h" |
Jeej | 0:7e1fdc4d6e1c | 37 | #include "dbg.h" |
Jeej | 0:7e1fdc4d6e1c | 38 | #include "DebouncedInterrupt.h" |
Jeej | 0:7e1fdc4d6e1c | 39 | #include "files.h" |
Jeej | 0:7e1fdc4d6e1c | 40 | |
Jeej | 1:711fb7d8127b | 41 | // ----------------------------------------------- |
Jeej | 1:711fb7d8127b | 42 | // Hardware configuration |
Jeej | 1:711fb7d8127b | 43 | // ----------------------------------------------- |
Jeej | 1:711fb7d8127b | 44 | #if defined(TARGET_STM32L152RE) |
Jeej | 1:711fb7d8127b | 45 | #define D7A_PIN_TX (D10) |
Jeej | 1:711fb7d8127b | 46 | #define D7A_PIN_RX (D2) |
Jeej | 1:711fb7d8127b | 47 | #define D7A_PIN_RTS (D13) |
Jeej | 1:711fb7d8127b | 48 | #define D7A_PIN_CTS (D9) |
Jeej | 1:711fb7d8127b | 49 | #define D7A_PIN_RESET (A3) |
Jeej | 1:711fb7d8127b | 50 | #define D7A_DEBUG_LED (NC) |
Jeej | 1:711fb7d8127b | 51 | #elif defined(TARGET_STM32L432KC) |
Jeej | 1:711fb7d8127b | 52 | #define D7A_PIN_TX (D5) |
Jeej | 1:711fb7d8127b | 53 | #define D7A_PIN_RX (D4) |
Jeej | 1:711fb7d8127b | 54 | #define D7A_PIN_RTS (D11) |
Jeej | 1:711fb7d8127b | 55 | #define D7A_PIN_CTS (D10) |
Jeej | 1:711fb7d8127b | 56 | #define D7A_PIN_RESET (D12) |
Jeej | 1:711fb7d8127b | 57 | #define D7A_DEBUG_LED (D13) // LED1 |
Jeej | 1:711fb7d8127b | 58 | #else |
Jeej | 1:711fb7d8127b | 59 | #error "Please choose or add the right platform." |
Jeej | 1:711fb7d8127b | 60 | #endif |
Jeej | 1:711fb7d8127b | 61 | |
Jeej | 0:7e1fdc4d6e1c | 62 | Semaphore button_user(0); |
Jeej | 0:7e1fdc4d6e1c | 63 | Semaphore thread_ready(0); |
Jeej | 0:7e1fdc4d6e1c | 64 | |
Jeej | 0:7e1fdc4d6e1c | 65 | // Interrupt Service Routine on button press. |
Jeej | 0:7e1fdc4d6e1c | 66 | void button_push_isr( void ) |
Jeej | 0:7e1fdc4d6e1c | 67 | { |
Jeej | 0:7e1fdc4d6e1c | 68 | button_user.release(); |
Jeej | 0:7e1fdc4d6e1c | 69 | } |
Jeej | 0:7e1fdc4d6e1c | 70 | |
Jeej | 0:7e1fdc4d6e1c | 71 | // file modified queue |
Jeej | 0:7e1fdc4d6e1c | 72 | Queue<void, 8> fm_queue; |
Jeej | 0:7e1fdc4d6e1c | 73 | |
Jeej | 0:7e1fdc4d6e1c | 74 | sensor_thread_ctx_t* g_thread_ctx; |
Jeej | 0:7e1fdc4d6e1c | 75 | |
Jeej | 0:7e1fdc4d6e1c | 76 | // ----------------------------------------------- |
Jeej | 0:7e1fdc4d6e1c | 77 | // callbacks |
Jeej | 0:7e1fdc4d6e1c | 78 | // ----------------------------------------------- |
Jeej | 0:7e1fdc4d6e1c | 79 | /** |
Jeej | 0:7e1fdc4d6e1c | 80 | Write data into a file. |
Jeej | 0:7e1fdc4d6e1c | 81 | |
Jeej | 0:7e1fdc4d6e1c | 82 | @param const uint8_t File ID |
Jeej | 0:7e1fdc4d6e1c | 83 | @param const uint16_t Offset from start of data |
Jeej | 0:7e1fdc4d6e1c | 84 | @param const uint16_t Size of data to be written |
Jeej | 0:7e1fdc4d6e1c | 85 | @param const uint8_t* const Pointer to the data to write |
Jeej | 0:7e1fdc4d6e1c | 86 | @return uint32_t Size of written data |
Jeej | 0:7e1fdc4d6e1c | 87 | */ |
Jeej | 0:7e1fdc4d6e1c | 88 | uint32_t write_file_callback(const uint8_t file_id, |
Jeej | 0:7e1fdc4d6e1c | 89 | const uint16_t offset, |
Jeej | 0:7e1fdc4d6e1c | 90 | const uint16_t size, |
Jeej | 0:7e1fdc4d6e1c | 91 | const uint8_t* const content) |
Jeej | 0:7e1fdc4d6e1c | 92 | { |
Jeej | 0:7e1fdc4d6e1c | 93 | uint32_t ret = 0; |
Jeej | 0:7e1fdc4d6e1c | 94 | |
Jeej | 0:7e1fdc4d6e1c | 95 | IPRINT("Write file %d offset:%d size:%d\r\n", file_id, offset, size); |
Jeej | 0:7e1fdc4d6e1c | 96 | |
Jeej | 0:7e1fdc4d6e1c | 97 | ret = fs_write_file(file_id, offset, size, content); |
Jeej | 0:7e1fdc4d6e1c | 98 | |
Jeej | 0:7e1fdc4d6e1c | 99 | WARNING(ret, "File %d not found\r\n", file_id); |
Jeej | 0:7e1fdc4d6e1c | 100 | |
Jeej | 0:7e1fdc4d6e1c | 101 | // Indicate that the file has been modified |
Jeej | 0:7e1fdc4d6e1c | 102 | fm_queue.put((void*)file_id); |
Jeej | 0:7e1fdc4d6e1c | 103 | |
Jeej | 0:7e1fdc4d6e1c | 104 | return ret; |
Jeej | 0:7e1fdc4d6e1c | 105 | } |
Jeej | 0:7e1fdc4d6e1c | 106 | |
Jeej | 0:7e1fdc4d6e1c | 107 | /** |
Jeej | 0:7e1fdc4d6e1c | 108 | Read data from a file. |
Jeej | 0:7e1fdc4d6e1c | 109 | |
Jeej | 0:7e1fdc4d6e1c | 110 | @param const uint8_t File ID |
Jeej | 0:7e1fdc4d6e1c | 111 | @param const uint16_t Offset from start of data |
Jeej | 0:7e1fdc4d6e1c | 112 | @param const uint16_t Size of data to be read |
Jeej | 0:7e1fdc4d6e1c | 113 | @param const uint8_t* const Pointer to the reading buffer |
Jeej | 0:7e1fdc4d6e1c | 114 | @return uint32_t Size of read data |
Jeej | 0:7e1fdc4d6e1c | 115 | */ |
Jeej | 0:7e1fdc4d6e1c | 116 | uint32_t read_file_callback(const uint8_t file_id, |
Jeej | 0:7e1fdc4d6e1c | 117 | const uint16_t offset, |
Jeej | 0:7e1fdc4d6e1c | 118 | const uint16_t size, |
Jeej | 0:7e1fdc4d6e1c | 119 | uint8_t* buf) |
Jeej | 0:7e1fdc4d6e1c | 120 | { |
Jeej | 0:7e1fdc4d6e1c | 121 | uint32_t ret = 0; |
Jeej | 0:7e1fdc4d6e1c | 122 | |
Jeej | 0:7e1fdc4d6e1c | 123 | IPRINT("Read file %d offset:%d size:%d\r\n", file_id, offset, size); |
Jeej | 0:7e1fdc4d6e1c | 124 | |
Jeej | 0:7e1fdc4d6e1c | 125 | ret = fs_read_file(file_id, offset, size, buf); |
Jeej | 0:7e1fdc4d6e1c | 126 | |
Jeej | 0:7e1fdc4d6e1c | 127 | WARNING(ret, "File %d not found\r\n", file_id); |
Jeej | 0:7e1fdc4d6e1c | 128 | |
Jeej | 0:7e1fdc4d6e1c | 129 | return ret; |
Jeej | 0:7e1fdc4d6e1c | 130 | } |
Jeej | 0:7e1fdc4d6e1c | 131 | |
Jeej | 0:7e1fdc4d6e1c | 132 | /** |
Jeej | 0:7e1fdc4d6e1c | 133 | Called when a notification is finished |
Jeej | 0:7e1fdc4d6e1c | 134 | |
Jeej | 0:7e1fdc4d6e1c | 135 | @param const uint8_t File ID |
Jeej | 0:7e1fdc4d6e1c | 136 | @param const uint8_t Error code |
Jeej | 0:7e1fdc4d6e1c | 137 | @return void |
Jeej | 0:7e1fdc4d6e1c | 138 | */ |
Jeej | 0:7e1fdc4d6e1c | 139 | void notif_done_callback(const uint8_t file_id, const uint8_t error) |
Jeej | 0:7e1fdc4d6e1c | 140 | { |
Jeej | 0:7e1fdc4d6e1c | 141 | PRINT("Notif FID %d done. err %d\r\n", file_id, error); |
Jeej | 0:7e1fdc4d6e1c | 142 | } |
Jeej | 0:7e1fdc4d6e1c | 143 | |
Jeej | 0:7e1fdc4d6e1c | 144 | void unsolicited_callback(d7a_msg_t** uns) |
Jeej | 0:7e1fdc4d6e1c | 145 | { |
Jeej | 0:7e1fdc4d6e1c | 146 | PRINT("UNSOLICITED MESSAGE:\r\n"); |
Jeej | 0:7e1fdc4d6e1c | 147 | d7a_print_msg(uns); |
Jeej | 0:7e1fdc4d6e1c | 148 | d7a_free_msg(uns); |
Jeej | 0:7e1fdc4d6e1c | 149 | } |
Jeej | 0:7e1fdc4d6e1c | 150 | |
Jeej | 0:7e1fdc4d6e1c | 151 | // callbacks structure |
Jeej | 0:7e1fdc4d6e1c | 152 | const d7a_callbacks_t callbacks = { |
Jeej | 0:7e1fdc4d6e1c | 153 | .write_file = write_file_callback, // If NULL you cannot declare files |
Jeej | 0:7e1fdc4d6e1c | 154 | .read_file = read_file_callback, // If NULL you cannot declare files |
Jeej | 0:7e1fdc4d6e1c | 155 | .notif_done = notif_done_callback, |
Jeej | 0:7e1fdc4d6e1c | 156 | .unsolicited_msg = unsolicited_callback, |
Jeej | 0:7e1fdc4d6e1c | 157 | }; |
Jeej | 0:7e1fdc4d6e1c | 158 | |
Jeej | 0:7e1fdc4d6e1c | 159 | // Com configuration for the DASH7 shield |
Jeej | 0:7e1fdc4d6e1c | 160 | const d7a_com_config_t shield_config = { |
Jeej | 1:711fb7d8127b | 161 | .tx = D7A_PIN_TX, |
Jeej | 1:711fb7d8127b | 162 | .rx = D7A_PIN_RX, |
Jeej | 1:711fb7d8127b | 163 | .rts = D7A_PIN_RTS, |
Jeej | 1:711fb7d8127b | 164 | .cts = D7A_PIN_CTS, |
Jeej | 0:7e1fdc4d6e1c | 165 | }; |
Jeej | 0:7e1fdc4d6e1c | 166 | |
Jeej | 0:7e1fdc4d6e1c | 167 | // Check parameters to see if data should be send |
Jeej | 0:7e1fdc4d6e1c | 168 | static bool report_needed(sensor_config_t* cfg, int32_t value, int32_t last_value, uint32_t last_report_time) |
Jeej | 0:7e1fdc4d6e1c | 169 | { |
Jeej | 0:7e1fdc4d6e1c | 170 | switch (cfg->report_type) |
Jeej | 0:7e1fdc4d6e1c | 171 | { |
Jeej | 0:7e1fdc4d6e1c | 172 | case REPORT_ALWAYS: |
Jeej | 0:7e1fdc4d6e1c | 173 | // Send a report at each measure |
Jeej | 0:7e1fdc4d6e1c | 174 | IPRINT("Notif cause 1\r\n"); |
Jeej | 0:7e1fdc4d6e1c | 175 | return true; |
Jeej | 0:7e1fdc4d6e1c | 176 | case REPORT_ON_DIFFERENCE: |
Jeej | 0:7e1fdc4d6e1c | 177 | // Send a report when the difference between the last reported measure and the current mesure is greater than max_diff |
Jeej | 0:7e1fdc4d6e1c | 178 | if (abs(last_value - value) >= cfg->max_diff) |
Jeej | 0:7e1fdc4d6e1c | 179 | { |
Jeej | 0:7e1fdc4d6e1c | 180 | IPRINT("Notif cause 2 last:%d new:%d max_diff:%d\r\n", last_value, value, cfg->max_diff); |
Jeej | 0:7e1fdc4d6e1c | 181 | return true; |
Jeej | 0:7e1fdc4d6e1c | 182 | } |
Jeej | 0:7e1fdc4d6e1c | 183 | break; |
Jeej | 0:7e1fdc4d6e1c | 184 | case REPORT_ON_THRESHOLD: |
Jeej | 0:7e1fdc4d6e1c | 185 | // Send a report when crossing a threshold |
Jeej | 0:7e1fdc4d6e1c | 186 | if ( (value >= cfg->threshold_high && last_value < cfg->threshold_high) |
Jeej | 0:7e1fdc4d6e1c | 187 | || (value <= cfg->threshold_low && last_value > cfg->threshold_low) |
Jeej | 0:7e1fdc4d6e1c | 188 | || (value < cfg->threshold_high && last_value >= cfg->threshold_high) |
Jeej | 0:7e1fdc4d6e1c | 189 | || (value > cfg->threshold_low && last_value <= cfg->threshold_low)) |
Jeej | 0:7e1fdc4d6e1c | 190 | { |
Jeej | 0:7e1fdc4d6e1c | 191 | IPRINT("Notif cause 3 last:%d new:%d th:%d tl:%d\r\n", last_value, value, cfg->threshold_high, cfg->threshold_low); |
Jeej | 0:7e1fdc4d6e1c | 192 | return true; |
Jeej | 0:7e1fdc4d6e1c | 193 | } |
Jeej | 0:7e1fdc4d6e1c | 194 | break; |
Jeej | 0:7e1fdc4d6e1c | 195 | default: |
Jeej | 0:7e1fdc4d6e1c | 196 | break; |
Jeej | 0:7e1fdc4d6e1c | 197 | } |
Jeej | 0:7e1fdc4d6e1c | 198 | |
Jeej | 0:7e1fdc4d6e1c | 199 | // Send a report if it's been more than max_period since the last report |
Jeej | 0:7e1fdc4d6e1c | 200 | if (((last_report_time/1000) >= cfg->max_period) && (cfg->max_period != 0)) |
Jeej | 0:7e1fdc4d6e1c | 201 | { |
Jeej | 0:7e1fdc4d6e1c | 202 | IPRINT("Notif cause 4 max_period:%d time:%d\r\n", cfg->max_period, last_report_time); |
Jeej | 0:7e1fdc4d6e1c | 203 | return true; |
Jeej | 0:7e1fdc4d6e1c | 204 | } |
Jeej | 0:7e1fdc4d6e1c | 205 | |
Jeej | 0:7e1fdc4d6e1c | 206 | return false; |
Jeej | 0:7e1fdc4d6e1c | 207 | } |
Jeej | 0:7e1fdc4d6e1c | 208 | |
Jeej | 0:7e1fdc4d6e1c | 209 | |
Jeej | 0:7e1fdc4d6e1c | 210 | SENSOR_THREAD_CTX(mag, MAG_VALUE_FILE_ID, MAG_CFG_FILE_ID, mag_get_value, 3); |
Jeej | 0:7e1fdc4d6e1c | 211 | SENSOR_THREAD_CTX(acc, ACC_VALUE_FILE_ID, ACC_CFG_FILE_ID, acc_get_value, 3); |
Jeej | 0:7e1fdc4d6e1c | 212 | SENSOR_THREAD_CTX(gyr, GYR_VALUE_FILE_ID, GYR_CFG_FILE_ID, gyr_get_value, 3); |
Jeej | 0:7e1fdc4d6e1c | 213 | SENSOR_THREAD_CTX(pre, PRE_VALUE_FILE_ID, PRE_CFG_FILE_ID, pre_get_value, 1); |
Jeej | 0:7e1fdc4d6e1c | 214 | SENSOR_THREAD_CTX(hum, HUM_VALUE_FILE_ID, HUM_CFG_FILE_ID, hum_get_value, 1); |
Jeej | 0:7e1fdc4d6e1c | 215 | SENSOR_THREAD_CTX(tem1, TEM1_VALUE_FILE_ID, TEM1_CFG_FILE_ID, tem1_get_value, 1); |
Jeej | 0:7e1fdc4d6e1c | 216 | SENSOR_THREAD_CTX(tem2, TEM2_VALUE_FILE_ID, TEM2_CFG_FILE_ID, tem2_get_value, 1); |
Jeej | 0:7e1fdc4d6e1c | 217 | |
Jeej | 0:7e1fdc4d6e1c | 218 | // ----------------------------------------------- |
Jeej | 0:7e1fdc4d6e1c | 219 | // Threads |
Jeej | 0:7e1fdc4d6e1c | 220 | // ----------------------------------------------- |
Jeej | 0:7e1fdc4d6e1c | 221 | void sensor_thread() |
Jeej | 0:7e1fdc4d6e1c | 222 | { |
Jeej | 1:711fb7d8127b | 223 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 1:711fb7d8127b | 224 | |
Jeej | 0:7e1fdc4d6e1c | 225 | // Get thread context |
Jeej | 0:7e1fdc4d6e1c | 226 | sensor_thread_ctx_t* th_ctx = g_thread_ctx; |
Jeej | 0:7e1fdc4d6e1c | 227 | |
Jeej | 0:7e1fdc4d6e1c | 228 | thread_ready.release(); |
Jeej | 0:7e1fdc4d6e1c | 229 | |
Jeej | 0:7e1fdc4d6e1c | 230 | d7a_msg_t** resp = NULL; |
Jeej | 0:7e1fdc4d6e1c | 231 | uint32_t last_report_time = 0; |
Jeej | 0:7e1fdc4d6e1c | 232 | |
Jeej | 0:7e1fdc4d6e1c | 233 | // Force a first notification |
Jeej | 0:7e1fdc4d6e1c | 234 | bool first_notif = true; |
Jeej | 0:7e1fdc4d6e1c | 235 | |
Jeej | 0:7e1fdc4d6e1c | 236 | // Retrieve notification config from local file |
Jeej | 0:7e1fdc4d6e1c | 237 | fs_read_file(th_ctx->cfg_file_id, 0, sizeof(sensor_config_t), (uint8_t*)&(th_ctx->cfg)); |
Jeej | 0:7e1fdc4d6e1c | 238 | |
Jeej | 0:7e1fdc4d6e1c | 239 | // Declare the config file to allow it to be accessed via the modem |
Jeej | 0:7e1fdc4d6e1c | 240 | d7a_declare(th_ctx->cfg_file_id, VOLATILE, RW_RW, sizeof(sensor_config_t), sizeof(sensor_config_t)); |
Jeej | 0:7e1fdc4d6e1c | 241 | |
Jeej | 0:7e1fdc4d6e1c | 242 | // Create a file on the modem to store and notify the sensor value |
Jeej | 0:7e1fdc4d6e1c | 243 | d7a_create(th_ctx->value_file_id, VOLATILE, RW_R, th_ctx->data_size, th_ctx->data_size, D7A_NOTIFICATION_FULL, D7A_ITF_REPORT_CHECKED); |
Jeej | 0:7e1fdc4d6e1c | 244 | |
Jeej | 0:7e1fdc4d6e1c | 245 | while (true) |
Jeej | 0:7e1fdc4d6e1c | 246 | { |
Jeej | 0:7e1fdc4d6e1c | 247 | // Read the sensor values |
Jeej | 0:7e1fdc4d6e1c | 248 | bool err = th_ctx->read_value(th_ctx->current_value); |
Jeej | 0:7e1fdc4d6e1c | 249 | |
Jeej | 1:711fb7d8127b | 250 | ASSERT(!err, "Failed to read sensor value for FID: %d\r\n", th_ctx->value_file_id); |
Jeej | 0:7e1fdc4d6e1c | 251 | |
Jeej | 0:7e1fdc4d6e1c | 252 | // Check if data should be send |
Jeej | 0:7e1fdc4d6e1c | 253 | for (uint8_t i = 0; i < th_ctx->nb_values; i++) |
Jeej | 0:7e1fdc4d6e1c | 254 | { |
Jeej | 0:7e1fdc4d6e1c | 255 | if (report_needed(&(th_ctx->cfg), |
Jeej | 0:7e1fdc4d6e1c | 256 | th_ctx->current_value[i], |
Jeej | 0:7e1fdc4d6e1c | 257 | th_ctx->last_report_value[i], |
Jeej | 0:7e1fdc4d6e1c | 258 | last_report_time) || first_notif) |
Jeej | 0:7e1fdc4d6e1c | 259 | { |
Jeej | 0:7e1fdc4d6e1c | 260 | first_notif = false; |
Jeej | 0:7e1fdc4d6e1c | 261 | |
Jeej | 0:7e1fdc4d6e1c | 262 | PRINT("NOTIFY %3d: ", th_ctx->value_file_id); |
Jeej | 0:7e1fdc4d6e1c | 263 | for (uint8_t i = 0; i < th_ctx->nb_values; i++) |
Jeej | 0:7e1fdc4d6e1c | 264 | { |
Jeej | 0:7e1fdc4d6e1c | 265 | PRINT("%9ld ", (int32_t)th_ctx->current_value[i]); |
Jeej | 0:7e1fdc4d6e1c | 266 | } |
Jeej | 0:7e1fdc4d6e1c | 267 | PRINT("\r\n"); |
Jeej | 0:7e1fdc4d6e1c | 268 | |
Jeej | 0:7e1fdc4d6e1c | 269 | // Send data to the modem |
Jeej | 0:7e1fdc4d6e1c | 270 | resp = d7a_write(th_ctx->value_file_id, 0, th_ctx->data_size, (uint8_t*)th_ctx->current_value); |
Jeej | 0:7e1fdc4d6e1c | 271 | d7a_free_msg(resp); |
Jeej | 0:7e1fdc4d6e1c | 272 | |
Jeej | 0:7e1fdc4d6e1c | 273 | // Update last report value |
Jeej | 0:7e1fdc4d6e1c | 274 | memcpy(th_ctx->last_report_value, th_ctx->current_value, th_ctx->data_size); |
Jeej | 0:7e1fdc4d6e1c | 275 | // Reset last report time |
Jeej | 0:7e1fdc4d6e1c | 276 | last_report_time = 0; |
Jeej | 0:7e1fdc4d6e1c | 277 | break; |
Jeej | 0:7e1fdc4d6e1c | 278 | } |
Jeej | 0:7e1fdc4d6e1c | 279 | } |
Jeej | 0:7e1fdc4d6e1c | 280 | |
Jeej | 0:7e1fdc4d6e1c | 281 | // Update last report time |
Jeej | 0:7e1fdc4d6e1c | 282 | last_report_time += th_ctx->cfg.period; |
Jeej | 0:7e1fdc4d6e1c | 283 | |
Jeej | 0:7e1fdc4d6e1c | 284 | // Wait for period |
Jeej | 0:7e1fdc4d6e1c | 285 | Thread::wait(th_ctx->cfg.period); |
Jeej | 0:7e1fdc4d6e1c | 286 | } |
Jeej | 0:7e1fdc4d6e1c | 287 | } |
Jeej | 0:7e1fdc4d6e1c | 288 | |
Jeej | 0:7e1fdc4d6e1c | 289 | void file_modified_thread() |
Jeej | 0:7e1fdc4d6e1c | 290 | { |
Jeej | 0:7e1fdc4d6e1c | 291 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:7e1fdc4d6e1c | 292 | |
Jeej | 0:7e1fdc4d6e1c | 293 | while (true) |
Jeej | 0:7e1fdc4d6e1c | 294 | { |
Jeej | 0:7e1fdc4d6e1c | 295 | // Wait for a file modified event |
Jeej | 0:7e1fdc4d6e1c | 296 | osEvent evt = fm_queue.get(); |
Jeej | 0:7e1fdc4d6e1c | 297 | |
Jeej | 0:7e1fdc4d6e1c | 298 | // Retrieve FID of modified file |
Jeej | 0:7e1fdc4d6e1c | 299 | uint8_t fid = (uint8_t)(uint32_t)evt.value.p; |
Jeej | 0:7e1fdc4d6e1c | 300 | |
Jeej | 0:7e1fdc4d6e1c | 301 | PRINT("File %d has been modified\r\n", fid); |
Jeej | 0:7e1fdc4d6e1c | 302 | |
Jeej | 0:7e1fdc4d6e1c | 303 | switch (fid) |
Jeej | 0:7e1fdc4d6e1c | 304 | { |
Jeej | 0:7e1fdc4d6e1c | 305 | // If a configuration file has been modified, update the context |
Jeej | 0:7e1fdc4d6e1c | 306 | case MAG_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 307 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(mag_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 308 | break; |
Jeej | 0:7e1fdc4d6e1c | 309 | case ACC_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 310 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(acc_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 311 | break; |
Jeej | 0:7e1fdc4d6e1c | 312 | case GYR_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 313 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(gyr_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 314 | break; |
Jeej | 0:7e1fdc4d6e1c | 315 | case PRE_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 316 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(pre_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 317 | break; |
Jeej | 0:7e1fdc4d6e1c | 318 | case HUM_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 319 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(hum_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 320 | break; |
Jeej | 0:7e1fdc4d6e1c | 321 | case TEM1_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 322 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(tem1_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 323 | break; |
Jeej | 0:7e1fdc4d6e1c | 324 | case TEM2_CFG_FILE_ID: |
Jeej | 0:7e1fdc4d6e1c | 325 | fs_read_file(fid, 0, sizeof(sensor_config_t), (uint8_t*)&(tem2_thread_ctx.cfg)); |
Jeej | 0:7e1fdc4d6e1c | 326 | break; |
Jeej | 0:7e1fdc4d6e1c | 327 | default: |
Jeej | 0:7e1fdc4d6e1c | 328 | break; |
Jeej | 0:7e1fdc4d6e1c | 329 | } |
Jeej | 0:7e1fdc4d6e1c | 330 | } |
Jeej | 0:7e1fdc4d6e1c | 331 | } |
Jeej | 0:7e1fdc4d6e1c | 332 | |
Jeej | 0:7e1fdc4d6e1c | 333 | void button_user_thread() |
Jeej | 0:7e1fdc4d6e1c | 334 | { |
Jeej | 0:7e1fdc4d6e1c | 335 | FPRINT("(id:0x%08x)\r\n", osThreadGetId()); |
Jeej | 0:7e1fdc4d6e1c | 336 | |
Jeej | 0:7e1fdc4d6e1c | 337 | uint8_t alarm = 255; |
Jeej | 0:7e1fdc4d6e1c | 338 | d7a_msg_t** resp = NULL; |
Jeej | 0:7e1fdc4d6e1c | 339 | |
Jeej | 0:7e1fdc4d6e1c | 340 | // Create the alarm file |
Jeej | 0:7e1fdc4d6e1c | 341 | d7a_create(ALARM_FILE_ID, VOLATILE, RW_R, sizeof(uint8_t), sizeof(uint8_t), D7A_NOTIFICATION_FULL, D7A_ITF_SINGLE); |
Jeej | 0:7e1fdc4d6e1c | 342 | |
Jeej | 0:7e1fdc4d6e1c | 343 | // Update it with the default value |
Jeej | 0:7e1fdc4d6e1c | 344 | resp = d7a_write(ALARM_FILE_ID, 0, sizeof(uint8_t), (uint8_t*)&alarm); |
Jeej | 0:7e1fdc4d6e1c | 345 | d7a_free_msg(resp); |
Jeej | 0:7e1fdc4d6e1c | 346 | |
Jeej | 0:7e1fdc4d6e1c | 347 | while (true) |
Jeej | 0:7e1fdc4d6e1c | 348 | { |
Jeej | 0:7e1fdc4d6e1c | 349 | // Wait for button press |
Jeej | 0:7e1fdc4d6e1c | 350 | button_user.wait(); |
Jeej | 0:7e1fdc4d6e1c | 351 | |
Jeej | 0:7e1fdc4d6e1c | 352 | // Toggle alarm state |
Jeej | 0:7e1fdc4d6e1c | 353 | alarm = !alarm; |
Jeej | 0:7e1fdc4d6e1c | 354 | |
Jeej | 0:7e1fdc4d6e1c | 355 | PRINT("BUTTON ALARM %d\r\n", alarm); |
Jeej | 0:7e1fdc4d6e1c | 356 | #if 1 // Switch between Notify and Distant Read/Write example |
Jeej | 0:7e1fdc4d6e1c | 357 | |
Jeej | 0:7e1fdc4d6e1c | 358 | // Send alarm state to the modem |
Jeej | 0:7e1fdc4d6e1c | 359 | resp = d7a_write(ALARM_FILE_ID, 0, sizeof(uint8_t), (uint8_t*)&alarm); |
Jeej | 0:7e1fdc4d6e1c | 360 | WARNING(!resp[0]->err, "BUTTON ALARM ERR %d\r\n", resp[0]->err); |
Jeej | 0:7e1fdc4d6e1c | 361 | d7a_free_msg(resp); |
Jeej | 0:7e1fdc4d6e1c | 362 | #else |
Jeej | 0:7e1fdc4d6e1c | 363 | // Distant device that I want to acceed |
Jeej | 0:7e1fdc4d6e1c | 364 | #if 0 // Unicast / Broadcast |
Jeej | 0:7e1fdc4d6e1c | 365 | // Unicast |
Jeej | 0:7e1fdc4d6e1c | 366 | d7a_addressee_t target = { |
Jeej | 0:7e1fdc4d6e1c | 367 | // Access Class |
Jeej | 0:7e1fdc4d6e1c | 368 | .xcl.byte = D7A_XCL_ENDPOINT_NO, |
Jeej | 0:7e1fdc4d6e1c | 369 | // Type of security you want to use |
Jeej | 0:7e1fdc4d6e1c | 370 | .ctrl.bf.nls = D7A_NLS_AES_CCM_64, |
Jeej | 0:7e1fdc4d6e1c | 371 | // Type of ID |
Jeej | 0:7e1fdc4d6e1c | 372 | .ctrl.bf.idf = D7A_ID_UID, |
Jeej | 0:7e1fdc4d6e1c | 373 | // Device ID |
Jeej | 0:7e1fdc4d6e1c | 374 | .id = { 0x00, 0x1B, 0xC5, 0x0C, 0x70, 0x00, 0x07, 0xA3 }, |
Jeej | 0:7e1fdc4d6e1c | 375 | }; |
Jeej | 0:7e1fdc4d6e1c | 376 | #else |
Jeej | 0:7e1fdc4d6e1c | 377 | // Broadcast |
Jeej | 0:7e1fdc4d6e1c | 378 | d7a_addressee_t target = { |
Jeej | 0:7e1fdc4d6e1c | 379 | // Access Class |
Jeej | 0:7e1fdc4d6e1c | 380 | .xcl.byte = D7A_XCL_ENDPOINT_NO, |
Jeej | 0:7e1fdc4d6e1c | 381 | // Type of security you want to use |
Jeej | 0:7e1fdc4d6e1c | 382 | .ctrl.bf.nls = D7A_NLS_AES_CCM_64, |
Jeej | 0:7e1fdc4d6e1c | 383 | // Type of ID |
Jeej | 0:7e1fdc4d6e1c | 384 | .ctrl.bf.idf = D7A_ID_NBID, |
Jeej | 0:7e1fdc4d6e1c | 385 | // Maximum number of responses (1-32) |
Jeej | 0:7e1fdc4d6e1c | 386 | .id[0] = D7A_NBID(8), |
Jeej | 0:7e1fdc4d6e1c | 387 | }; |
Jeej | 0:7e1fdc4d6e1c | 388 | #endif |
Jeej | 0:7e1fdc4d6e1c | 389 | |
Jeej | 0:7e1fdc4d6e1c | 390 | #if 1 // Read / Write |
Jeej | 0:7e1fdc4d6e1c | 391 | // Read example |
Jeej | 0:7e1fdc4d6e1c | 392 | //resp = d7a_read(MAG_CFG_FILE_ID, 12, 5, &target, D7A_ITF_ONESHOT); |
Jeej | 0:7e1fdc4d6e1c | 393 | resp = d7a_read(ALARM_FILE_ID, 0, 1, NULL, &target, D7A_ITF_ONESHOT); |
Jeej | 0:7e1fdc4d6e1c | 394 | #else |
Jeej | 0:7e1fdc4d6e1c | 395 | // Write example |
Jeej | 0:7e1fdc4d6e1c | 396 | uint8_t v = 0x01; |
Jeej | 0:7e1fdc4d6e1c | 397 | resp = d7a_write(ALARM_FILE_ID, 0, 1, &v, NULL, &target, D7A_ITF_ONESHOT); |
Jeej | 0:7e1fdc4d6e1c | 398 | #endif |
Jeej | 0:7e1fdc4d6e1c | 399 | // Check received response(s) |
Jeej | 0:7e1fdc4d6e1c | 400 | d7a_print_msg(resp); |
Jeej | 0:7e1fdc4d6e1c | 401 | |
Jeej | 0:7e1fdc4d6e1c | 402 | PRINT("Resp done.\r\n"); |
Jeej | 0:7e1fdc4d6e1c | 403 | d7a_free_msg(resp); |
Jeej | 0:7e1fdc4d6e1c | 404 | #endif |
Jeej | 0:7e1fdc4d6e1c | 405 | |
Jeej | 0:7e1fdc4d6e1c | 406 | |
Jeej | 0:7e1fdc4d6e1c | 407 | } |
Jeej | 0:7e1fdc4d6e1c | 408 | } |
Jeej | 0:7e1fdc4d6e1c | 409 | |
Jeej | 0:7e1fdc4d6e1c | 410 | |
Jeej | 0:7e1fdc4d6e1c | 411 | /*** Main function ------------------------------------------------------------- ***/ |
Jeej | 0:7e1fdc4d6e1c | 412 | int main() |
Jeej | 0:7e1fdc4d6e1c | 413 | { |
Jeej | 0:7e1fdc4d6e1c | 414 | // Start & initialize |
Jeej | 1:711fb7d8127b | 415 | DBG_OPEN(D7A_DEBUG_LED); |
Jeej | 0:7e1fdc4d6e1c | 416 | PRINT("\r\n--- Starting new run ---\r\n"); |
Jeej | 0:7e1fdc4d6e1c | 417 | |
Jeej | 1:711fb7d8127b | 418 | DigitalOut myled(D7A_DEBUG_LED); |
Jeej | 0:7e1fdc4d6e1c | 419 | myled = 1; |
Jeej | 0:7e1fdc4d6e1c | 420 | |
Jeej | 0:7e1fdc4d6e1c | 421 | extern uint16_t const os_maxtaskrun; |
Jeej | 0:7e1fdc4d6e1c | 422 | //IPRINT("Max user threads: %d\r\n", os_maxtaskrun-1-9); |
Jeej | 0:7e1fdc4d6e1c | 423 | |
Jeej | 1:711fb7d8127b | 424 | d7a_open(&shield_config, D7A_PIN_RESET, &callbacks); |
Jeej | 0:7e1fdc4d6e1c | 425 | d7a_modem_print_infos(); |
Jeej | 0:7e1fdc4d6e1c | 426 | |
Jeej | 0:7e1fdc4d6e1c | 427 | // Create the revision file for the Dash7board |
Jeej | 0:7e1fdc4d6e1c | 428 | d7a_create(65, PERMANENT, RW_R, sizeof(d7a_revision_t), sizeof(d7a_revision_t), D7A_NOTIFICATION_FULL, D7A_ITF_REPORT_CHECKED); |
Jeej | 0:7e1fdc4d6e1c | 429 | // Notify revision |
Jeej | 0:7e1fdc4d6e1c | 430 | d7a_msg_t** resp = d7a_write(65, 0, sizeof(d7a_revision_t), (uint8_t*)&f_dev_rev); |
Jeej | 0:7e1fdc4d6e1c | 431 | d7a_free_msg(resp); |
Jeej | 0:7e1fdc4d6e1c | 432 | |
Jeej | 0:7e1fdc4d6e1c | 433 | #if _SENSORS_SIMU_ |
Jeej | 0:7e1fdc4d6e1c | 434 | PRINT("(Simulated sensors)\r\n"); |
Jeej | 0:7e1fdc4d6e1c | 435 | uint32_t divider; |
Jeej | 0:7e1fdc4d6e1c | 436 | |
Jeej | 0:7e1fdc4d6e1c | 437 | // Retreive the simulation parameter from local file |
Jeej | 0:7e1fdc4d6e1c | 438 | fs_read_file(SIMUL_FILE_ID, 0, sizeof(uint32_t), (uint8_t*)÷r); |
Jeej | 0:7e1fdc4d6e1c | 439 | |
Jeej | 0:7e1fdc4d6e1c | 440 | // Update the simulation parameters |
Jeej | 0:7e1fdc4d6e1c | 441 | simul_update_param(divider); |
Jeej | 0:7e1fdc4d6e1c | 442 | |
Jeej | 0:7e1fdc4d6e1c | 443 | // Declare the simulation parameter file |
Jeej | 0:7e1fdc4d6e1c | 444 | d7a_declare(SIMUL_FILE_ID, PERMANENT, RW_RW, sizeof(sensor_config_t), sizeof(sensor_config_t)); |
Jeej | 0:7e1fdc4d6e1c | 445 | |
Jeej | 0:7e1fdc4d6e1c | 446 | #else |
Jeej | 0:7e1fdc4d6e1c | 447 | // Open I2C and initialise the sensors |
Jeej | 0:7e1fdc4d6e1c | 448 | sensors_init(); |
Jeej | 0:7e1fdc4d6e1c | 449 | |
Jeej | 0:7e1fdc4d6e1c | 450 | #endif // _SENSORS_SIMU_ |
Jeej | 0:7e1fdc4d6e1c | 451 | |
Jeej | 0:7e1fdc4d6e1c | 452 | osStatus status; |
Jeej | 0:7e1fdc4d6e1c | 453 | |
Jeej | 0:7e1fdc4d6e1c | 454 | // Start sensors threads |
Jeej | 1:711fb7d8127b | 455 | #define THREAD_START(_name) Thread _name##_th(osPriorityNormal, 1024, NULL);\ |
Jeej | 0:7e1fdc4d6e1c | 456 | g_thread_ctx = &_name##_thread_ctx;\ |
Jeej | 0:7e1fdc4d6e1c | 457 | status = _name##_th.start(sensor_thread);\ |
Jeej | 1:711fb7d8127b | 458 | ASSERT(status == osOK, "Failed to start ##_name## thread (err: %d)\r\n", status);\ |
Jeej | 0:7e1fdc4d6e1c | 459 | thread_ready.wait(); |
Jeej | 0:7e1fdc4d6e1c | 460 | |
Jeej | 0:7e1fdc4d6e1c | 461 | |
Jeej | 0:7e1fdc4d6e1c | 462 | |
Jeej | 0:7e1fdc4d6e1c | 463 | #if _MAG_EN_ |
Jeej | 0:7e1fdc4d6e1c | 464 | THREAD_START(mag); |
Jeej | 0:7e1fdc4d6e1c | 465 | #endif // _MAG_EN_ |
Jeej | 0:7e1fdc4d6e1c | 466 | #if _ACC_EN_ |
Jeej | 0:7e1fdc4d6e1c | 467 | THREAD_START(acc); |
Jeej | 0:7e1fdc4d6e1c | 468 | #endif // _ACC_EN_ |
Jeej | 0:7e1fdc4d6e1c | 469 | #if _GYR_EN_ |
Jeej | 0:7e1fdc4d6e1c | 470 | THREAD_START(gyr); |
Jeej | 0:7e1fdc4d6e1c | 471 | #endif // _GYR_EN_ |
Jeej | 0:7e1fdc4d6e1c | 472 | #if _PRE_EN_ |
Jeej | 0:7e1fdc4d6e1c | 473 | THREAD_START(pre); |
Jeej | 0:7e1fdc4d6e1c | 474 | #endif // _PRE_EN_ |
Jeej | 0:7e1fdc4d6e1c | 475 | #if _HUM_EN_ |
Jeej | 0:7e1fdc4d6e1c | 476 | THREAD_START(hum); |
Jeej | 0:7e1fdc4d6e1c | 477 | #endif // _HUM_EN_ |
Jeej | 0:7e1fdc4d6e1c | 478 | #if _TEM1_EN_ |
Jeej | 0:7e1fdc4d6e1c | 479 | THREAD_START(tem1); |
Jeej | 0:7e1fdc4d6e1c | 480 | #endif // _TEM1_EN_ |
Jeej | 0:7e1fdc4d6e1c | 481 | #if _TEM2_EN_ |
Jeej | 0:7e1fdc4d6e1c | 482 | THREAD_START(tem2); |
Jeej | 0:7e1fdc4d6e1c | 483 | #endif // _TEM2_EN_ |
Jeej | 0:7e1fdc4d6e1c | 484 | |
Jeej | 0:7e1fdc4d6e1c | 485 | // File modified thread |
Jeej | 1:711fb7d8127b | 486 | Thread fm_th(osPriorityNormal, 512, NULL); |
Jeej | 1:711fb7d8127b | 487 | status = fm_th.start(file_modified_thread); |
Jeej | 1:711fb7d8127b | 488 | ASSERT(status == osOK, "Failed to start fm thread (err: %d)\r\n", status); |
Jeej | 0:7e1fdc4d6e1c | 489 | |
Jeej | 1:711fb7d8127b | 490 | // For button |
Jeej | 1:711fb7d8127b | 491 | #ifdef USER_BUTTON |
Jeej | 1:711fb7d8127b | 492 | DebouncedInterrupt user_interrupt(USER_BUTTON); |
Jeej | 1:711fb7d8127b | 493 | user_interrupt.attach(button_push_isr, IRQ_FALL, 200, true); |
Jeej | 1:711fb7d8127b | 494 | |
Jeej | 1:711fb7d8127b | 495 | Thread but_th(osPriorityNormal, 512, NULL); |
Jeej | 1:711fb7d8127b | 496 | status = but_th.start(button_user_thread); |
Jeej | 1:711fb7d8127b | 497 | ASSERT(status == osOK, "Failed to start but thread (err: %d)\r\n", status); |
Jeej | 1:711fb7d8127b | 498 | #endif |
Jeej | 0:7e1fdc4d6e1c | 499 | |
Jeej | 0:7e1fdc4d6e1c | 500 | // Set main task to lowest priority |
Jeej | 0:7e1fdc4d6e1c | 501 | osThreadSetPriority(osThreadGetId(), osPriorityIdle); |
Jeej | 0:7e1fdc4d6e1c | 502 | while(true) |
Jeej | 0:7e1fdc4d6e1c | 503 | { |
Jeej | 0:7e1fdc4d6e1c | 504 | // Wait to avoid beeing stuck in loop |
Jeej | 0:7e1fdc4d6e1c | 505 | Thread::wait(200); |
Jeej | 0:7e1fdc4d6e1c | 506 | myled = !myled; |
Jeej | 0:7e1fdc4d6e1c | 507 | } |
Jeej | 0:7e1fdc4d6e1c | 508 | } |