Blame view
orbimote/firmware/main.c
10.1 KB
ca223e024
orbimote avec sof...
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 |
/*
* Read pediodically the measurements from the board sensors
* then send to the LoRaWAN network in which the endpoint is registered.
* The payload format is LPP Cayenne.
*
* Copyright (C) 2020 LIG Université Grenoble Alpes
*
* This file is subject to the terms and conditions of the GNU Lesser
* General Public License v2.1. See the file LICENSE in the top level
* directory for more details.
*/
#define ENABLE_DEBUG (1)
#include "debug.h"
#include <string.h>
#include "xtimer.h"
#include <time.h>
#include "mutex.h"
#include "periph_conf.h"
#include "periph/rtc.h"
#include "board.h"
#include "fmt.h"
#include "net/loramac.h"
#include "semtech_loramac.h"
#include "loramac_utils.h"
#include "cayenne_lpp.h"
// NXP MPL3115A2: 20 to 110 kPa, Absolute Digital Pressure Sensor
#include "mpl3115a2.h"
#include "mpl3115a2_params.h"
// NXP MMA8451Q, 3-axis, 14-bit/8-bit digital accelerometer
// #include "mma8x5x.h"
// #include "mma8x5x_params.h"
// NXP Xtrinsic MAG3110 Three-Axis, Digital Magnetometer
// #include "mag3110.h"
// #include "mag3110_params.h"
#include "time_utils.h"
/* Declare globally the loramac descriptor */
static semtech_loramac_t loramac;
/* Declare globally the sensor device descriptor */
static mpl3115a2_t dev;
/* Cayenne LPP buffer */
static cayenne_lpp_t lpp;
/* LoRaMac values */
#define JOIN_NEXT_RETRY_TIME 120 // Next join tentative in 2 minute(s)
#define SECONDS_PER_DAY 24 * 60 * 60
/* Use a fast datarate, e.g. BW125/SF7 in EU868 */
#define DR_INIT LORAMAC_DR_5
#define ADR_ON true
#define FIRST_TX_PERIOD 120 // First Tx period 2 minutes
#define TX_PERIOD 120 // Tx period 2 minutes
#define PORT_UP_DATA 1
#define PORT_UP_GET_EPOCH 2
#define PORT_UP_ERROR 99
#define PORT_DN_TEXT 1
#define PORT_DN_EPOCH 2
#define PORT_DN_SET_TX_PERIOD 3
#define SLEEP_USEC (1UL * US_PER_SEC)
/* Implement the receiver thread */
#define RECEIVER_MSG_QUEUE (4U)
#ifdef FORGE_DEVEUI_APPEUI_APPKEY
static uint8_t secret[LORAMAC_APPKEY_LEN];
#endif
static uint8_t deveui[LORAMAC_DEVEUI_LEN];
static uint8_t appeui[LORAMAC_APPEUI_LEN];
static uint8_t appkey[LORAMAC_APPKEY_LEN];
static msg_t _receiver_queue[RECEIVER_MSG_QUEUE];
static char _receiver_stack[THREAD_STACKSIZE_DEFAULT];
static uint32_t epoch = 0;
static bool epoch_set = false;
static struct tm current_time;
static uint16_t tx_period = TX_PERIOD;
static void init_sensors(void){
uint8_t port = PORT_UP_DATA;
if (mpl3115a2_init(&dev, &mpl3115a2_params[0]) != MPL3115A2_OK) {
DEBUG("[FAILED] init mpl3115a2!");
port = PORT_UP_ERROR;
}
semtech_loramac_set_tx_port(&loramac, port);
}
static void print_sensors(void)
{
// TODO si l'initialisation du mpl3115a2 a échoué, il faut envoyer un message avec le fPort PORT_UP_ERROR
if (mpl3115a2_set_active(&dev) != MPL3115A2_OK) {
DEBUG("[FAILED] activate mpl3115a2!");
return;
}
uint32_t pressure;
int16_t temperature;
uint8_t status;
xtimer_usleep(SLEEP_USEC);
if ((mpl3115a2_read_pressure(&dev, &pressure, &status) |
mpl3115a2_read_temp(&dev, &temperature)) != MPL3115A2_OK) {
DEBUG("[FAILED] read values from mpl3115a2!");
return;
}
else {
DEBUG("mpl3115a2: pressure=%u Pa, temperature=%3d.%d C, state=%#02x
",
(unsigned int)pressure, temperature/10, abs(temperature%10), status);
}
if (mpl3115a2_set_standby(&dev) != MPL3115A2_OK) {
DEBUG("[FAILED] standby mpl3115a2!");
return;
}
}
static void read_sensors(cayenne_lpp_t* lpp){
// TODO si l'initialisation du ds75lx a échoué, il faut envoyer un message avec le fPort PORT_UP_ERROR
if (mpl3115a2_set_active(&dev) != MPL3115A2_OK) {
DEBUG("[FAILED] activate mpl3115a2!");
return;
}
uint32_t pressure;
int16_t temperature;
uint8_t status;
xtimer_usleep(SLEEP_USEC);
if ((mpl3115a2_read_pressure(&dev, &pressure, &status) |
mpl3115a2_read_temp(&dev, &temperature)) != MPL3115A2_OK) {
DEBUG("[FAILED] read values from mpl3115a2!");
return;
}
else {
DEBUG("mpl3115a2: pressure=%u Pa, temperature=%3d.%d C, state=%#02x
",
(unsigned int)pressure, temperature/10, abs(temperature%10), status);
cayenne_lpp_add_temperature(lpp, 0, (float)temperature / 10);
cayenne_lpp_add_barometric_pressure(lpp, 1, (float)pressure);
}
if (mpl3115a2_set_standby(&dev) != MPL3115A2_OK) {
DEBUG("[FAILED] standby mpl3115a2!");
return;
}
}
static void sender(void)
{
while (1)
{
/* read the sensors values and add them to lpp */
read_sensors(&lpp);
/* send the LoRaWAN message */
uint8_t ret = semtech_loramac_send(&loramac, lpp.buffer, lpp.cursor);
if (ret != SEMTECH_LORAMAC_TX_DONE)
{
DEBUG("Cannot send LPP payload: ret code: %d (%s)
", ret, semtech_loramac_err_message(ret));
}
/* clear buffer once done */
cayenne_lpp_reset(&lpp);
/* sleep tx_period secs */
// TODO introduire un alea de quelques secondes dans la tx_period pour éviter que des endpoints qui redémarrent ensemble se brouillent les uns les autres.
// TODO verifier que la tx_period est compatible avec le DC (sinon, le Tx retourne le code=13)
xtimer_sleep(tx_period);
}
/* this should never be reached */
return;
}
static void *receiver(void *arg)
{
msg_init_queue(_receiver_queue, RECEIVER_MSG_QUEUE);
(void)arg;
while (1) {
rtc_get_time(¤t_time);
print_time("Clock value is now ", ¤t_time);
/* blocks until something is received */
switch (semtech_loramac_recv(&loramac)) {
case SEMTECH_LORAMAC_RX_DATA:
// TODO process Downlink payload
switch(loramac.rx_data.port) {
case PORT_DN_TEXT:
loramac.rx_data.payload[loramac.rx_data.payload_len] = 0;
DEBUG("Data received: text=%s, port: %d
",
(char *)loramac.rx_data.payload, loramac.rx_data.port);
break;
case PORT_DN_EPOCH:
if(loramac.rx_data.payload_len == sizeof(epoch)) {
epoch=*((uint32_t*)loramac.rx_data.payload);
DEBUG("Data received: epoch=%ld, port: %d
",
epoch, loramac.rx_data.port);
struct tm new_time;
epoch_to_time(&new_time, epoch);
rtc_set_time(&new_time);
print_time("Clock value is set to ", &new_time);
epoch_set = true;
} else {
DEBUG("Data received: bad size for epoch, port: %d
",
loramac.rx_data.port);
}
break;
case PORT_DN_SET_TX_PERIOD:
if(loramac.rx_data.payload_len == sizeof(tx_period)) {
tx_period=*((uint16_t*)loramac.rx_data.payload);
DEBUG("Data received: tx_period=%d, port: %d
",
tx_period, loramac.rx_data.port);
} else {
DEBUG("Data received: bad size for tx_period, port: %d
",
loramac.rx_data.port);
}
break;
default:
DEBUG("Data received: ");
printf_ba(loramac.rx_data.payload, loramac.rx_data.payload_len);
DEBUG(", port: %d
",loramac.rx_data.port);
break;
}
break;
case SEMTECH_LORAMAC_RX_CONFIRMED:
// TODO if too much unconfirmed Tx frames --> rejoin
DEBUG("Received ACK from network
");
break;
default:
break;
}
}
return NULL;
}
/**
* main function
* TODO add LED, button, add reed switch
* TOOD add GPS parsing on UART RX pin (UART TX pin is used by the console)
*/
int main(void)
{
/* read RTC */
rtc_get_time(¤t_time);
print_time("Clock value is now ", ¤t_time);
/* initialize the sensors */
init_sensors();
/* print the current values of the sensors */
print_sensors();
/* initialize the loramac stack */
semtech_loramac_init(&loramac);
/* set ADR flag */
semtech_loramac_set_adr(&loramac, ADR_ON);
#ifdef FORGE_DEVEUI_APPEUI_APPKEY
/* forge the deveui, appeui and appkey of the endpoint */
fmt_hex_bytes(secret, SECRET);
loramac_forge_deveui(deveui,appeui,appkey,secret);
DEBUG("Secret:"); printf_ba(secret,LORAMAC_APPKEY_LEN); DEBUG("
");
#else
/* Convert identifiers and application key */
fmt_hex_bytes(deveui, DEVEUI);
fmt_hex_bytes(appeui, APPEUI);
fmt_hex_bytes(appkey, APPKEY);
#endif
DEBUG("DevEUI:"); printf_ba(deveui,LORAMAC_DEVEUI_LEN); DEBUG("
");
DEBUG("AppEUI:"); printf_ba(appeui,LORAMAC_APPEUI_LEN); DEBUG("
");
DEBUG("AppKey:"); printf_ba(appkey,LORAMAC_APPKEY_LEN); DEBUG("
");
/* set the LoRaWAN keys */
semtech_loramac_set_deveui(&loramac, deveui);
semtech_loramac_set_appeui(&loramac, appeui);
semtech_loramac_set_appkey(&loramac, appkey);
/* start the OTAA join procedure (and retries in required) */
/*uint8_t joinRes = */ loramac_join_retry_loop(&loramac, DR_INIT, JOIN_NEXT_RETRY_TIME, SECONDS_PER_DAY);
/* start the receiver thread */
thread_create(_receiver_stack, sizeof(_receiver_stack),
THREAD_PRIORITY_MAIN - 1, 0, receiver, NULL, "receiver thread");
/* sleep FIRST_TX_PERIOD secs */
xtimer_sleep(FIRST_TX_PERIOD);
/* call the sender */
sender();
return 0; /* should never be reached */
}
|