ST / Mbed OS TeseoLocation

Teseo Location demo for GPSProvider using ST GNSS driver.

Dependencies:   GPS_Provider X_NUCLEO_GNSS1A1

Getting Started with X-NUCLEO-GNSS1A1

This example demonstrates how to use the X-NUCLEO-GNSS1A1 component with one of the STM32 Nucleo-64 platforms and how real time GNSS data received by the Teseo-LIV3F device can be displayed through a serial connection and a serial terminal on a PC. Furthermore the user can run commands enabling three advanced features:

  • Geofencing
  • Odometer
  • Data Logging

Setup

/media/uploads/apalmieri/nucleo-x-nucleo.jpg

Once the antenna has been connected to the SMA female connector of the X-NUCLEO-GNSS1A1 plugged on top of the STM32 Nucleo, a serial connection should be set up between the STM32 Nucleo and the PC with the following parameters:

  • baud rate: 115200
  • data: 8 bit
  • parity: none
  • stop: 1bit
  • flow control: none
  • New-line (Tx/Rx): CR

Serial connection parameters

/media/uploads/apalmieri/serial_setup.png /media/uploads/apalmieri/serial_setup1.png

The user can select among different options to:

  • get in a human readable format information related to the acquired GNSS position (or the satellites in view, the active satellites, and so on)
  • enable feature (geofencing, odometer, data logging)
  • configure a geofence circle
  • require geofence status
  • start/stop feature (odometer, data logging)

Application menu

/media/uploads/apalmieri/teseo_app.png

source/main.cpp@4:b67349d44157, 2021-01-14 (annotated)

Committer:
apalmieri
Date:
Thu Jan 14 09:33:08 2021 +0000
Revision:
4:b67349d44157
Parent:
0:7b0a5a01caec 
Get TeseoLocation program aligned with mbed-os-6.6.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
apalmieri 0:7b0a5a01caec 1 /**
apalmieri 0:7b0a5a01caec 2 *******************************************************************************
apalmieri 0:7b0a5a01caec 3 * @file main.cpp
apalmieri 0:7b0a5a01caec 4 * @author AST / Central Lab
apalmieri 0:7b0a5a01caec 5 * @version V1.0.0
apalmieri 0:7b0a5a01caec 6 * @date June-2017
apalmieri 0:7b0a5a01caec 7 * @brief Teseo Location Hello World
apalmieri 0:7b0a5a01caec 8 *
apalmieri 0:7b0a5a01caec 9 *******************************************************************************
apalmieri 0:7b0a5a01caec 10 * @attention
apalmieri 0:7b0a5a01caec 11 *
apalmieri 0:7b0a5a01caec 12 * <h2><center>&copy; COPYRIGHT(c) 2017 STMicroelectronics</center></h2>
apalmieri 0:7b0a5a01caec 13 *
apalmieri 0:7b0a5a01caec 14 * Licensed under MCD-ST Liberty SW License Agreement V2, (the "License");
apalmieri 0:7b0a5a01caec 15 * You may not use this file except in compliance with the License.
apalmieri 0:7b0a5a01caec 16 * You may obtain a copy of the License at:
apalmieri 0:7b0a5a01caec 17 *
apalmieri 0:7b0a5a01caec 18 * http://www.st.com/software_license_agreement_liberty_v2
apalmieri 0:7b0a5a01caec 19 *
apalmieri 0:7b0a5a01caec 20 * Redistribution and use in source and binary forms, with or without modification,
apalmieri 0:7b0a5a01caec 21 * are permitted provided that the following conditions are met:
apalmieri 0:7b0a5a01caec 22 * 1. Redistributions of source code must retain the above copyright notice,
apalmieri 0:7b0a5a01caec 23 * this list of conditions and the following disclaimer.
apalmieri 0:7b0a5a01caec 24 * 2. Redistributions in binary form must reproduce the above copyright notice,
apalmieri 0:7b0a5a01caec 25 * this list of conditions and the following disclaimer in the documentation
apalmieri 0:7b0a5a01caec 26 * and/or other materials provided with the distribution.
apalmieri 0:7b0a5a01caec 27 * 3. Neither the name of STMicroelectronics nor the names of its contributors
apalmieri 0:7b0a5a01caec 28 * may be used to endorse or promote products derived from this software
apalmieri 0:7b0a5a01caec 29 * without specific prior written permission.
apalmieri 0:7b0a5a01caec 30 *
apalmieri 0:7b0a5a01caec 31 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
apalmieri 0:7b0a5a01caec 32 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
apalmieri 0:7b0a5a01caec 33 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
apalmieri 0:7b0a5a01caec 34 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
apalmieri 0:7b0a5a01caec 35 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
apalmieri 0:7b0a5a01caec 36 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
apalmieri 0:7b0a5a01caec 37 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
apalmieri 0:7b0a5a01caec 38 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
apalmieri 0:7b0a5a01caec 39 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
apalmieri 0:7b0a5a01caec 40 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
apalmieri 0:7b0a5a01caec 41 *
apalmieri 0:7b0a5a01caec 42 ********************************************************************************
apalmieri 0:7b0a5a01caec 43 */
apalmieri 0:7b0a5a01caec 44
apalmieri 0:7b0a5a01caec 45 #include "mbed.h"
apalmieri 0:7b0a5a01caec 46 #include "Teseo.h"
apalmieri 0:7b0a5a01caec 47 #include "GPSProvider.h"
apalmieri 0:7b0a5a01caec 48
apalmieri 0:7b0a5a01caec 49 #include "geofence_config.h"
apalmieri 0:7b0a5a01caec 50
apalmieri 0:7b0a5a01caec 51 #define DEBUG_RX_PIN D0
apalmieri 0:7b0a5a01caec 52 #define DEBUG_TX_PIN D1
apalmieri 0:7b0a5a01caec 53
apalmieri 0:7b0a5a01caec 54 /* appliation commands */
apalmieri 0:7b0a5a01caec 55 typedef enum AppCmd {
apalmieri 0:7b0a5a01caec 56 APP_CMD_IDLE, // No special command
apalmieri 0:7b0a5a01caec 57 APP_CMD_HELP, // Show the supported commands
apalmieri 0:7b0a5a01caec 58 APP_CMD_START, // Start location
apalmieri 0:7b0a5a01caec 59 APP_CMD_STOP, // Stop location
apalmieri 0:7b0a5a01caec 60 APP_CMD_GETLASTLOC, // Get last location
apalmieri 0:7b0a5a01caec 61 APP_CMD_ENGEOFENCE, // Enable Geofence
apalmieri 0:7b0a5a01caec 62 APP_CMD_CONFGEOFENCE, // Config Geofence
apalmieri 0:7b0a5a01caec 63 APP_CMD_GEOFENCEREQ, // Request Geofence status
apalmieri 0:7b0a5a01caec 64 APP_CMD_ENODO, // Enable Odometer
apalmieri 0:7b0a5a01caec 65 APP_CMD_STARTODO, // Start Odometer system
apalmieri 0:7b0a5a01caec 66 APP_CMD_STOPODO, // Stop Odometer system
apalmieri 0:7b0a5a01caec 67 APP_CMD_ENDATALOG, // Enable Datalog
apalmieri 0:7b0a5a01caec 68 APP_CMD_CONFDATALOG, // Config Datalog
apalmieri 0:7b0a5a01caec 69 APP_CMD_STARTDATALOG, // Start Datalog
apalmieri 0:7b0a5a01caec 70 APP_CMD_STOPDATALOG, // Stop Datalog
apalmieri 0:7b0a5a01caec 71 APP_CMD_ERASEDATALOG, // Erase Datalog
apalmieri 0:7b0a5a01caec 72 APP_CMD_VERBOSE, // Enable verbose mode
apalmieri 0:7b0a5a01caec 73 APP_CMD_RESET, // Debug command, pull reset pin high level
apalmieri 0:7b0a5a01caec 74 APP_CMD_GET_DEVICE_INFO // Get Device Info
apalmieri 0:7b0a5a01caec 75 } eAppCmd;
apalmieri 0:7b0a5a01caec 76
apalmieri 0:7b0a5a01caec 77 static void _AppShowCmd(void);
apalmieri 0:7b0a5a01caec 78 static void _ConsoleRxHandler(void);
apalmieri 0:7b0a5a01caec 79 static void _AppCmdProcess(char *pCmd);
apalmieri 0:7b0a5a01caec 80 static void _AppShowLastPosition(const GPSProvider::LocationUpdateParams_t *lastLoc);
apalmieri 0:7b0a5a01caec 81 static void _AppEnGeofence(const bool isGeofenceSupported);
apalmieri 0:7b0a5a01caec 82 static void _AppGeofenceCfg(void);
apalmieri 0:7b0a5a01caec 83 static void _AppEnOdometer(const bool isOdometerSupported);
apalmieri 0:7b0a5a01caec 84 static void _AppEnDatalogging(const bool isDataloggingSupported);
apalmieri 0:7b0a5a01caec 85 static void _AppDatalogCfg(void);
apalmieri 0:7b0a5a01caec 86
apalmieri 0:7b0a5a01caec 87 static void _ExecAppCmd(void);
apalmieri 0:7b0a5a01caec 88
apalmieri 0:7b0a5a01caec 89 static int sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 90 static eGeofenceId geofenceId;
apalmieri 0:7b0a5a01caec 91
apalmieri 4:b67349d44157 92 static BufferedSerial serialDebug(DEBUG_TX_PIN, DEBUG_RX_PIN, 115200);
apalmieri 4:b67349d44157 93 #define TESEO_APP_LOG_INFO(...) printf(__VA_ARGS__)
apalmieri 0:7b0a5a01caec 94
apalmieri 0:7b0a5a01caec 95 #define WARNING_NOT_RUN_MSG TESEO_APP_LOG_INFO("GNSS is not running. Please, type 'start' to make it runnable.\r\n");
apalmieri 0:7b0a5a01caec 96 #define WARNING_ALREADY_RUN_MSG TESEO_APP_LOG_INFO("GNSS is already running.\r\n");
apalmieri 0:7b0a5a01caec 97
apalmieri 0:7b0a5a01caec 98 static GPSProvider gnss;
apalmieri 0:7b0a5a01caec 99 static bool gnssRunning = false;
apalmieri 0:7b0a5a01caec 100 static int level = 1;
apalmieri 0:7b0a5a01caec 101
apalmieri 4:b67349d44157 102 FileHandle *mbed::mbed_override_console(int fd)
apalmieri 4:b67349d44157 103 {
apalmieri 4:b67349d44157 104 return &serialDebug;
apalmieri 4:b67349d44157 105 }
apalmieri 4:b67349d44157 106
apalmieri 0:7b0a5a01caec 107 void
apalmieri 0:7b0a5a01caec 108 locationHandler(const GPSProvider::LocationUpdateParams_t *params)
apalmieri 0:7b0a5a01caec 109 {
apalmieri 0:7b0a5a01caec 110 if (params->valid) {
apalmieri 0:7b0a5a01caec 111 /* application specific handling of location data; */
apalmieri 0:7b0a5a01caec 112 TESEO_APP_LOG_INFO("locationHandler...\r\n");
apalmieri 0:7b0a5a01caec 113 }
apalmieri 0:7b0a5a01caec 114 }
apalmieri 0:7b0a5a01caec 115
apalmieri 0:7b0a5a01caec 116 void
apalmieri 0:7b0a5a01caec 117 geofenceCfg(int ret_code)
apalmieri 0:7b0a5a01caec 118 {
apalmieri 0:7b0a5a01caec 119 TESEO_APP_LOG_INFO("geofenceCfg...\r\n");
apalmieri 0:7b0a5a01caec 120 }
apalmieri 0:7b0a5a01caec 121
apalmieri 0:7b0a5a01caec 122 void
apalmieri 0:7b0a5a01caec 123 geofenceStatus(const GPSProvider::GeofenceStatusParams_t *params, int ret_code)
apalmieri 0:7b0a5a01caec 124 {
apalmieri 0:7b0a5a01caec 125 /* application specific handling of geofencing status data; */
apalmieri 0:7b0a5a01caec 126 TESEO_APP_LOG_INFO("geofenceStatus...\r\n");
apalmieri 0:7b0a5a01caec 127 }
apalmieri 0:7b0a5a01caec 128
apalmieri 0:7b0a5a01caec 129 static void
apalmieri 0:7b0a5a01caec 130 _ConsoleRxHandler(void)
apalmieri 0:7b0a5a01caec 131 {
apalmieri 0:7b0a5a01caec 132 static char cmd[32] = {0};
apalmieri 0:7b0a5a01caec 133 char ch;
apalmieri 4:b67349d44157 134 char nl = '\n';
apalmieri 0:7b0a5a01caec 135
apalmieri 0:7b0a5a01caec 136 while(true) {
apalmieri 0:7b0a5a01caec 137 while (!serialDebug.readable()) {
apalmieri 4:b67349d44157 138 ThisThread::yield(); // Allow other threads to run
apalmieri 0:7b0a5a01caec 139 }
apalmieri 4:b67349d44157 140 serialDebug.read(&ch, 1);
apalmieri 4:b67349d44157 141 serialDebug.write((const void *)&ch, 1);
apalmieri 0:7b0a5a01caec 142 if (ch == '\r') {
apalmieri 4:b67349d44157 143 serialDebug.write((const void *)&nl, 1);
apalmieri 0:7b0a5a01caec 144 if (strlen(cmd) > 0) {
apalmieri 0:7b0a5a01caec 145 _AppCmdProcess(cmd);
apalmieri 0:7b0a5a01caec 146 memset(cmd, 0, sizeof(cmd));
apalmieri 0:7b0a5a01caec 147 }
apalmieri 0:7b0a5a01caec 148 } else {
apalmieri 0:7b0a5a01caec 149 cmd[strlen(cmd)] = ch;
apalmieri 0:7b0a5a01caec 150 }
apalmieri 0:7b0a5a01caec 151 }
apalmieri 0:7b0a5a01caec 152 }
apalmieri 0:7b0a5a01caec 153
apalmieri 0:7b0a5a01caec 154 static
apalmieri 0:7b0a5a01caec 155 void
apalmieri 0:7b0a5a01caec 156 _ExecAppCmd(void)
apalmieri 0:7b0a5a01caec 157 {
apalmieri 0:7b0a5a01caec 158 while (true) {
apalmieri 0:7b0a5a01caec 159 //TESEO_APP_LOG_INFO("main thread!!!\r\n");
apalmieri 0:7b0a5a01caec 160 switch (sAppCmd) {
apalmieri 0:7b0a5a01caec 161 case APP_CMD_HELP:
apalmieri 0:7b0a5a01caec 162 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 163 _AppShowCmd();
apalmieri 0:7b0a5a01caec 164 break;
apalmieri 0:7b0a5a01caec 165
apalmieri 0:7b0a5a01caec 166 case APP_CMD_IDLE:
apalmieri 0:7b0a5a01caec 167 if(gnssRunning) {
apalmieri 0:7b0a5a01caec 168 //TESEO_APP_LOG_INFO("process.\r\n");
apalmieri 0:7b0a5a01caec 169 gnss.process();
apalmieri 0:7b0a5a01caec 170 }
apalmieri 0:7b0a5a01caec 171 break;
apalmieri 0:7b0a5a01caec 172
apalmieri 0:7b0a5a01caec 173 case APP_CMD_START:
apalmieri 0:7b0a5a01caec 174 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 175 if(gnssRunning) {
apalmieri 0:7b0a5a01caec 176 WARNING_ALREADY_RUN_MSG;
apalmieri 0:7b0a5a01caec 177 } else {
apalmieri 0:7b0a5a01caec 178 TESEO_APP_LOG_INFO("start gnss.\r\n");
apalmieri 0:7b0a5a01caec 179 gnss.start();
apalmieri 0:7b0a5a01caec 180 gnssRunning = true;
apalmieri 0:7b0a5a01caec 181 }
apalmieri 0:7b0a5a01caec 182 break;
apalmieri 0:7b0a5a01caec 183 case APP_CMD_STOP:
apalmieri 0:7b0a5a01caec 184 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 185 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 186 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 187 } else {
apalmieri 0:7b0a5a01caec 188 TESEO_APP_LOG_INFO("stop gnss.\r\n");
apalmieri 0:7b0a5a01caec 189 gnss.stop();
apalmieri 0:7b0a5a01caec 190 gnssRunning = false;
apalmieri 0:7b0a5a01caec 191 }
apalmieri 0:7b0a5a01caec 192 break;
apalmieri 0:7b0a5a01caec 193 case APP_CMD_RESET:
apalmieri 0:7b0a5a01caec 194 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 195 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 196 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 197 } else {
apalmieri 0:7b0a5a01caec 198 TESEO_APP_LOG_INFO("reset on.\r\n");
apalmieri 0:7b0a5a01caec 199 gnss.reset();
apalmieri 0:7b0a5a01caec 200 }
apalmieri 0:7b0a5a01caec 201 break;
apalmieri 0:7b0a5a01caec 202 case APP_CMD_GETLASTLOC:
apalmieri 0:7b0a5a01caec 203 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 204 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 205 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 206 } else {
apalmieri 0:7b0a5a01caec 207 TESEO_APP_LOG_INFO("get last loc.\r\n");
apalmieri 0:7b0a5a01caec 208 _AppShowLastPosition(gnss.getLastLocation());
apalmieri 0:7b0a5a01caec 209 }
apalmieri 0:7b0a5a01caec 210 break;
apalmieri 0:7b0a5a01caec 211 case APP_CMD_ENGEOFENCE:
apalmieri 0:7b0a5a01caec 212 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 213 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 214 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 215 } else {
apalmieri 0:7b0a5a01caec 216 TESEO_APP_LOG_INFO("enable geofence.\r\n");
apalmieri 0:7b0a5a01caec 217 _AppEnGeofence(gnss.isGeofencingSupported());
apalmieri 0:7b0a5a01caec 218 }
apalmieri 0:7b0a5a01caec 219 break;
apalmieri 0:7b0a5a01caec 220 case APP_CMD_CONFGEOFENCE:
apalmieri 0:7b0a5a01caec 221 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 222 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 223 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 224 } else {
apalmieri 0:7b0a5a01caec 225 TESEO_APP_LOG_INFO("config geofence.\r\n");
apalmieri 0:7b0a5a01caec 226 _AppGeofenceCfg();
apalmieri 0:7b0a5a01caec 227 }
apalmieri 0:7b0a5a01caec 228 break;
apalmieri 0:7b0a5a01caec 229 case APP_CMD_GEOFENCEREQ:
apalmieri 0:7b0a5a01caec 230 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 231 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 232 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 233 } else {
apalmieri 0:7b0a5a01caec 234 TESEO_APP_LOG_INFO("request geofence status.\r\n");
apalmieri 0:7b0a5a01caec 235 gnss.geofenceReq();
apalmieri 0:7b0a5a01caec 236 }
apalmieri 0:7b0a5a01caec 237 break;
apalmieri 0:7b0a5a01caec 238 case APP_CMD_ENODO:
apalmieri 0:7b0a5a01caec 239 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 240 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 241 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 242 } else {
apalmieri 0:7b0a5a01caec 243 TESEO_APP_LOG_INFO("enable odometer.\r\n");
apalmieri 0:7b0a5a01caec 244 _AppEnOdometer(gnss.isOdometerSupported());
apalmieri 0:7b0a5a01caec 245 }
apalmieri 0:7b0a5a01caec 246 break;
apalmieri 0:7b0a5a01caec 247 case APP_CMD_STARTODO:
apalmieri 0:7b0a5a01caec 248 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 249 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 250 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 251 } else {
apalmieri 0:7b0a5a01caec 252 TESEO_APP_LOG_INFO("start odo subystem.\r\n");
apalmieri 0:7b0a5a01caec 253 gnss.startOdo(1);
apalmieri 0:7b0a5a01caec 254 }
apalmieri 0:7b0a5a01caec 255 break;
apalmieri 0:7b0a5a01caec 256 case APP_CMD_STOPODO:
apalmieri 0:7b0a5a01caec 257 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 258 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 259 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 260 } else {
apalmieri 0:7b0a5a01caec 261 TESEO_APP_LOG_INFO("stop odo subystem.\r\n");
apalmieri 0:7b0a5a01caec 262 gnss.stopOdo();
apalmieri 0:7b0a5a01caec 263 }
apalmieri 0:7b0a5a01caec 264 break;
apalmieri 0:7b0a5a01caec 265 case APP_CMD_ENDATALOG:
apalmieri 0:7b0a5a01caec 266 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 267 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 268 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 269 } else {
apalmieri 0:7b0a5a01caec 270 TESEO_APP_LOG_INFO("enable datalog.\r\n");
apalmieri 0:7b0a5a01caec 271 _AppEnDatalogging(gnss.isDataloggingSupported());
apalmieri 0:7b0a5a01caec 272 }
apalmieri 0:7b0a5a01caec 273 break;
apalmieri 0:7b0a5a01caec 274 case APP_CMD_CONFDATALOG:
apalmieri 0:7b0a5a01caec 275 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 276 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 277 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 278 } else {
apalmieri 0:7b0a5a01caec 279 TESEO_APP_LOG_INFO("config datalog.\r\n");
apalmieri 0:7b0a5a01caec 280 _AppDatalogCfg();
apalmieri 0:7b0a5a01caec 281 }
apalmieri 0:7b0a5a01caec 282 break;
apalmieri 0:7b0a5a01caec 283 case APP_CMD_STARTDATALOG:
apalmieri 0:7b0a5a01caec 284 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 285 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 286 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 287 } else {
apalmieri 0:7b0a5a01caec 288 TESEO_APP_LOG_INFO("start datalog.\r\n");
apalmieri 0:7b0a5a01caec 289 gnss.startDatalog();
apalmieri 0:7b0a5a01caec 290 }
apalmieri 0:7b0a5a01caec 291 break;
apalmieri 0:7b0a5a01caec 292 case APP_CMD_STOPDATALOG:
apalmieri 0:7b0a5a01caec 293 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 294 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 295 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 296 } else {
apalmieri 0:7b0a5a01caec 297 TESEO_APP_LOG_INFO("stop datalog.\r\n");
apalmieri 0:7b0a5a01caec 298 gnss.stopDatalog();
apalmieri 0:7b0a5a01caec 299 }
apalmieri 0:7b0a5a01caec 300 break;
apalmieri 0:7b0a5a01caec 301 case APP_CMD_ERASEDATALOG:
apalmieri 0:7b0a5a01caec 302 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 303 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 304 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 305 } else {
apalmieri 0:7b0a5a01caec 306 TESEO_APP_LOG_INFO("erase datalog.\r\n");
apalmieri 0:7b0a5a01caec 307 gnss.eraseDatalog();
apalmieri 0:7b0a5a01caec 308 }
apalmieri 0:7b0a5a01caec 309 break;
apalmieri 0:7b0a5a01caec 310 case APP_CMD_VERBOSE:
apalmieri 0:7b0a5a01caec 311 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 312 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 313 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 314 } else {
apalmieri 0:7b0a5a01caec 315 TESEO_APP_LOG_INFO("set verbose mode.\r\n");
apalmieri 0:7b0a5a01caec 316 gnss.setVerboseMode(level);
apalmieri 0:7b0a5a01caec 317 }
apalmieri 0:7b0a5a01caec 318 break;
apalmieri 0:7b0a5a01caec 319 case APP_CMD_GET_DEVICE_INFO:
apalmieri 0:7b0a5a01caec 320 sAppCmd = APP_CMD_IDLE;
apalmieri 0:7b0a5a01caec 321 if(!gnssRunning) {
apalmieri 0:7b0a5a01caec 322 WARNING_NOT_RUN_MSG;
apalmieri 0:7b0a5a01caec 323 } else {
apalmieri 0:7b0a5a01caec 324 TESEO_APP_LOG_INFO("get device info.\r\n");
apalmieri 0:7b0a5a01caec 325 if(gnss.haveDeviceInfo()) {
apalmieri 4:b67349d44157 326 TESEO_APP_LOG_INFO("%s", gnss.getDeviceInfo());
apalmieri 0:7b0a5a01caec 327 }
apalmieri 0:7b0a5a01caec 328 TESEO_APP_LOG_INFO("\r\n");
apalmieri 0:7b0a5a01caec 329 }
apalmieri 0:7b0a5a01caec 330 break;
apalmieri 0:7b0a5a01caec 331 }
apalmieri 4:b67349d44157 332 ThisThread::yield(); // Allow other threads to run
apalmieri 0:7b0a5a01caec 333 }
apalmieri 0:7b0a5a01caec 334 }
apalmieri 0:7b0a5a01caec 335
apalmieri 0:7b0a5a01caec 336 int main() {
apalmieri 0:7b0a5a01caec 337 Thread consoleThread;
apalmieri 0:7b0a5a01caec 338 Thread cmdThread;
apalmieri 0:7b0a5a01caec 339
apalmieri 4:b67349d44157 340 TESEO_APP_LOG_INFO("Starting GNSS...\r\n");
apalmieri 4:b67349d44157 341
apalmieri 0:7b0a5a01caec 342 consoleThread.start(_ConsoleRxHandler);
apalmieri 0:7b0a5a01caec 343
apalmieri 0:7b0a5a01caec 344 gnss.reset();
apalmieri 0:7b0a5a01caec 345 gnss.onLocationUpdate(locationHandler);
apalmieri 0:7b0a5a01caec 346 TESEO_APP_LOG_INFO("Success to new GNSS.\r\n");
apalmieri 0:7b0a5a01caec 347
apalmieri 0:7b0a5a01caec 348 _AppShowCmd();
apalmieri 0:7b0a5a01caec 349 cmdThread.start(_ExecAppCmd);
apalmieri 4:b67349d44157 350
apalmieri 0:7b0a5a01caec 351 while(1) {
apalmieri 4:b67349d44157 352 ThisThread::yield();
apalmieri 0:7b0a5a01caec 353 }
apalmieri 0:7b0a5a01caec 354
apalmieri 0:7b0a5a01caec 355 }
apalmieri 0:7b0a5a01caec 356
apalmieri 0:7b0a5a01caec 357 static void
apalmieri 0:7b0a5a01caec 358 _AppShowLastPosition(const GPSProvider::LocationUpdateParams_t *lastLoc)
apalmieri 0:7b0a5a01caec 359 {
apalmieri 0:7b0a5a01caec 360 char msg[256];
apalmieri 0:7b0a5a01caec 361 GPSProvider::LocationUpdateParams_t lastLocation = *lastLoc;
apalmieri 0:7b0a5a01caec 362
apalmieri 0:7b0a5a01caec 363 if(lastLocation.valid == true) {
apalmieri 0:7b0a5a01caec 364 sprintf(msg,"Latitude:\t\t[ %.0f' %d'' ]\n\r",
apalmieri 0:7b0a5a01caec 365 (lastLocation.lat - ((int)lastLocation.lat % 100)) / 100,
apalmieri 0:7b0a5a01caec 366 ((int)lastLocation.lat % 100));
apalmieri 4:b67349d44157 367 TESEO_APP_LOG_INFO("%s", msg);
apalmieri 0:7b0a5a01caec 368
apalmieri 0:7b0a5a01caec 369 sprintf(msg,"Longitude:\t\t[ %.0f' %d'' ]\n\r",
apalmieri 0:7b0a5a01caec 370 (lastLocation.lon - ((int)lastLocation.lon % 100)) / 100,
apalmieri 0:7b0a5a01caec 371 ((int)lastLocation.lon % 100));
apalmieri 4:b67349d44157 372 TESEO_APP_LOG_INFO("%s", msg);
apalmieri 0:7b0a5a01caec 373
apalmieri 0:7b0a5a01caec 374 sprintf(msg,"Altitude:\t\t[ %.2f ]\n\r",
apalmieri 0:7b0a5a01caec 375 lastLocation.altitude);
apalmieri 4:b67349d44157 376 TESEO_APP_LOG_INFO("%s", msg);
apalmieri 0:7b0a5a01caec 377
apalmieri 0:7b0a5a01caec 378 sprintf(msg,"Satellites locked:\t[ %d ]\n\r",
apalmieri 0:7b0a5a01caec 379 lastLocation.numGPSSVs);
apalmieri 4:b67349d44157 380 TESEO_APP_LOG_INFO("%s", msg);
apalmieri 0:7b0a5a01caec 381
apalmieri 0:7b0a5a01caec 382 sprintf(msg, "UTC:\t\t\t[ %d ]\n\r",
apalmieri 0:7b0a5a01caec 383 (int)lastLocation.utcTime);
apalmieri 4:b67349d44157 384 TESEO_APP_LOG_INFO("%s", msg);
apalmieri 0:7b0a5a01caec 385
apalmieri 0:7b0a5a01caec 386 } else {
apalmieri 0:7b0a5a01caec 387 sprintf(msg, "Last position wasn't valid.\n\n\r");
apalmieri 4:b67349d44157 388 TESEO_APP_LOG_INFO("%s", msg);
apalmieri 0:7b0a5a01caec 389 }
apalmieri 0:7b0a5a01caec 390 }
apalmieri 0:7b0a5a01caec 391
apalmieri 0:7b0a5a01caec 392 static void
apalmieri 0:7b0a5a01caec 393 _AppEnGeofence(const bool isGeofenceSupported)
apalmieri 0:7b0a5a01caec 394 {
apalmieri 0:7b0a5a01caec 395 if(isGeofenceSupported) {
apalmieri 0:7b0a5a01caec 396 gps_provider_error_t ret = gnss.enableGeofence();
apalmieri 0:7b0a5a01caec 397 if(ret == GPS_ERROR_NONE) {
apalmieri 0:7b0a5a01caec 398 TESEO_APP_LOG_INFO("Enabling Geofencing subsystem...\n\r");
apalmieri 0:7b0a5a01caec 399 }
apalmieri 0:7b0a5a01caec 400 } else {
apalmieri 0:7b0a5a01caec 401 TESEO_APP_LOG_INFO("Geofencing is not supported!\n\r");
apalmieri 0:7b0a5a01caec 402 }
apalmieri 0:7b0a5a01caec 403
apalmieri 0:7b0a5a01caec 404 }
apalmieri 0:7b0a5a01caec 405
apalmieri 0:7b0a5a01caec 406 static void
apalmieri 0:7b0a5a01caec 407 _AppGeofenceCfg(void)
apalmieri 0:7b0a5a01caec 408 {
apalmieri 0:7b0a5a01caec 409 GPSGeofence gf;
apalmieri 0:7b0a5a01caec 410
apalmieri 0:7b0a5a01caec 411 switch (geofenceId) {
apalmieri 0:7b0a5a01caec 412 case LecceId:
apalmieri 0:7b0a5a01caec 413 gf.setGeofenceCircle(STLecce);
apalmieri 0:7b0a5a01caec 414 break;
apalmieri 0:7b0a5a01caec 415 case CataniaId:
apalmieri 0:7b0a5a01caec 416 gf.setGeofenceCircle(Catania);
apalmieri 0:7b0a5a01caec 417 break;
apalmieri 0:7b0a5a01caec 418 }
apalmieri 0:7b0a5a01caec 419 /*
apalmieri 0:7b0a5a01caec 420 GPSGeofence::GeofenceCircle_t c = gf.getGeofenceCircle();
apalmieri 0:7b0a5a01caec 421 printf("_AppGeofenceCfg id=%d\r\n", c.id);
apalmieri 0:7b0a5a01caec 422 printf("_AppGeofenceCfg en=%d\r\n", c.enabled);
apalmieri 0:7b0a5a01caec 423 printf("_AppGeofenceCfg tol=%d\r\n", c.tolerance);
apalmieri 0:7b0a5a01caec 424 printf("_AppGeofenceCfg lat=%.2f\r\n", c.lat);
apalmieri 0:7b0a5a01caec 425 printf("_AppGeofenceCfg lon=%.2f\r\n", c.lon);
apalmieri 0:7b0a5a01caec 426 printf("_AppGeofenceCfg radius=%.2f\r\n", c.radius);
apalmieri 0:7b0a5a01caec 427 */
apalmieri 0:7b0a5a01caec 428
apalmieri 0:7b0a5a01caec 429 GPSGeofence *geofenceTable[] = {&gf};
apalmieri 0:7b0a5a01caec 430
apalmieri 0:7b0a5a01caec 431 gnss.onGeofenceCfgMessage(geofenceCfg);
apalmieri 0:7b0a5a01caec 432 gnss.onGeofenceStatusMessage(geofenceStatus);
apalmieri 0:7b0a5a01caec 433 gps_provider_error_t ret = gnss.configGeofences(geofenceTable, sizeof(geofenceTable)/sizeof(GPSGeofence *));
apalmieri 0:7b0a5a01caec 434 if(ret == GPS_ERROR_NONE) {
apalmieri 0:7b0a5a01caec 435 TESEO_APP_LOG_INFO("Configuring Geofence circles...\n\r");
apalmieri 0:7b0a5a01caec 436 }
apalmieri 0:7b0a5a01caec 437
apalmieri 0:7b0a5a01caec 438 }
apalmieri 0:7b0a5a01caec 439
apalmieri 0:7b0a5a01caec 440 static void
apalmieri 0:7b0a5a01caec 441 _AppEnOdometer(const bool isOdometerSupported)
apalmieri 0:7b0a5a01caec 442 {
apalmieri 0:7b0a5a01caec 443 if(isOdometerSupported) {
apalmieri 0:7b0a5a01caec 444 gps_provider_error_t ret = gnss.enableOdo();
apalmieri 0:7b0a5a01caec 445 if(ret == GPS_ERROR_NONE) {
apalmieri 0:7b0a5a01caec 446 TESEO_APP_LOG_INFO("Enabling Odometer subsystem...\n\r");
apalmieri 0:7b0a5a01caec 447 }
apalmieri 0:7b0a5a01caec 448 } else {
apalmieri 0:7b0a5a01caec 449 TESEO_APP_LOG_INFO("Odometer is not supported!\n\r");
apalmieri 0:7b0a5a01caec 450 }
apalmieri 0:7b0a5a01caec 451
apalmieri 0:7b0a5a01caec 452 }
apalmieri 0:7b0a5a01caec 453
apalmieri 0:7b0a5a01caec 454 static void
apalmieri 0:7b0a5a01caec 455 _AppEnDatalogging(const bool isDataloggingSupported)
apalmieri 0:7b0a5a01caec 456 {
apalmieri 0:7b0a5a01caec 457 if(isDataloggingSupported) {
apalmieri 0:7b0a5a01caec 458 gps_provider_error_t ret = gnss.enableDatalog();
apalmieri 0:7b0a5a01caec 459 if(ret == GPS_ERROR_NONE) {
apalmieri 0:7b0a5a01caec 460 TESEO_APP_LOG_INFO("Enabling Datalog subsystem...\n\r");
apalmieri 0:7b0a5a01caec 461 }
apalmieri 0:7b0a5a01caec 462 } else {
apalmieri 0:7b0a5a01caec 463 TESEO_APP_LOG_INFO("Datalog is not supported!\n\r");
apalmieri 0:7b0a5a01caec 464 }
apalmieri 0:7b0a5a01caec 465
apalmieri 0:7b0a5a01caec 466 }
apalmieri 0:7b0a5a01caec 467
apalmieri 0:7b0a5a01caec 468 static void
apalmieri 0:7b0a5a01caec 469 _AppDatalogCfg(void)
apalmieri 0:7b0a5a01caec 470 {
apalmieri 0:7b0a5a01caec 471 bool enableBufferFullAlarm = false;
apalmieri 0:7b0a5a01caec 472 bool enableCircularBuffer = true;
apalmieri 0:7b0a5a01caec 473 unsigned minRate = 5;
apalmieri 0:7b0a5a01caec 474 unsigned minSpeed = 0;
apalmieri 0:7b0a5a01caec 475 unsigned minPosition = 0;
apalmieri 0:7b0a5a01caec 476 int logMask = 1;
apalmieri 0:7b0a5a01caec 477
apalmieri 0:7b0a5a01caec 478 GPSDatalog dl(enableBufferFullAlarm,
apalmieri 0:7b0a5a01caec 479 enableCircularBuffer,
apalmieri 0:7b0a5a01caec 480 minRate,
apalmieri 0:7b0a5a01caec 481 minSpeed,
apalmieri 0:7b0a5a01caec 482 minPosition,
apalmieri 0:7b0a5a01caec 483 logMask);
apalmieri 0:7b0a5a01caec 484
apalmieri 0:7b0a5a01caec 485 gps_provider_error_t ret = gnss.configDatalog(&dl);
apalmieri 0:7b0a5a01caec 486 if(ret == GPS_ERROR_NONE) {
apalmieri 0:7b0a5a01caec 487 TESEO_APP_LOG_INFO("Configuring Datalog...\n\r");
apalmieri 0:7b0a5a01caec 488 }
apalmieri 0:7b0a5a01caec 489 }
apalmieri 0:7b0a5a01caec 490
apalmieri 0:7b0a5a01caec 491 static void
apalmieri 0:7b0a5a01caec 492 _AppShowCmd(void)
apalmieri 0:7b0a5a01caec 493 {
apalmieri 0:7b0a5a01caec 494 TESEO_APP_LOG_INFO("Location commands:\r\n");
apalmieri 0:7b0a5a01caec 495 TESEO_APP_LOG_INFO(" help - help to show supported commands\r\n");
apalmieri 0:7b0a5a01caec 496 TESEO_APP_LOG_INFO(" start - begin location app\r\n");
apalmieri 0:7b0a5a01caec 497 TESEO_APP_LOG_INFO(" stop - end location app\r\n");
apalmieri 0:7b0a5a01caec 498 TESEO_APP_LOG_INFO(" getlastloc - get last location\r\n");
apalmieri 0:7b0a5a01caec 499 TESEO_APP_LOG_INFO(" en-geo - enable Geofence\r\n");
apalmieri 0:7b0a5a01caec 500 TESEO_APP_LOG_INFO(" geo-c - config Geofence [c=l Lecce, c=t Catania]\r\n");
apalmieri 0:7b0a5a01caec 501 TESEO_APP_LOG_INFO(" req-geo - request Geofence status\r\n");
apalmieri 0:7b0a5a01caec 502 TESEO_APP_LOG_INFO(" en-odo - enable Odoemter\r\n");
apalmieri 0:7b0a5a01caec 503 TESEO_APP_LOG_INFO(" start-odo - start Ododmeter [demo distance 1m]\r\n");
apalmieri 0:7b0a5a01caec 504 TESEO_APP_LOG_INFO(" stop-odo - stop Ododmeter\r\n");
apalmieri 0:7b0a5a01caec 505 TESEO_APP_LOG_INFO(" en-datalog - enable Datalog\r\n");
apalmieri 0:7b0a5a01caec 506 TESEO_APP_LOG_INFO(" cfg-dl - config Datalog\r\n");
apalmieri 0:7b0a5a01caec 507 TESEO_APP_LOG_INFO(" start-dl - start Datalog\r\n");
apalmieri 0:7b0a5a01caec 508 TESEO_APP_LOG_INFO(" stop-dl - stop Datalog\r\n");
apalmieri 0:7b0a5a01caec 509 TESEO_APP_LOG_INFO(" erase-dl - erase Datalog\r\n");
apalmieri 0:7b0a5a01caec 510 TESEO_APP_LOG_INFO(" verbose-l - nmea msg verbose mode [l=1 normal, l=2 debug]\r\n");
apalmieri 0:7b0a5a01caec 511 TESEO_APP_LOG_INFO(" reset - reset GNSS\r\n");
apalmieri 0:7b0a5a01caec 512 TESEO_APP_LOG_INFO(" getdevinfo - get device info\r\n");
apalmieri 0:7b0a5a01caec 513 }
apalmieri 0:7b0a5a01caec 514
apalmieri 0:7b0a5a01caec 515 static void
apalmieri 0:7b0a5a01caec 516 _AppCmdProcess(char *pCmd)
apalmieri 0:7b0a5a01caec 517 {
apalmieri 0:7b0a5a01caec 518 if (strcmp(pCmd, "help") == 0) {
apalmieri 0:7b0a5a01caec 519 sAppCmd = APP_CMD_HELP;
apalmieri 0:7b0a5a01caec 520 } else if (strcmp(pCmd, "start") == 0) {
apalmieri 0:7b0a5a01caec 521 sAppCmd = APP_CMD_START;
apalmieri 0:7b0a5a01caec 522 } else if (strcmp(pCmd, "stop") == 0) {
apalmieri 0:7b0a5a01caec 523 sAppCmd = APP_CMD_STOP;
apalmieri 0:7b0a5a01caec 524 } else if (strcmp(pCmd, "getlastloc") == 0) {
apalmieri 0:7b0a5a01caec 525 sAppCmd = APP_CMD_GETLASTLOC;
apalmieri 0:7b0a5a01caec 526 } else if (strcmp(pCmd, "en-geo") == 0) {
apalmieri 0:7b0a5a01caec 527 sAppCmd = APP_CMD_ENGEOFENCE;
apalmieri 0:7b0a5a01caec 528 } else if (strcmp(pCmd, "geo-l") == 0) {
apalmieri 0:7b0a5a01caec 529 geofenceId = LecceId;
apalmieri 0:7b0a5a01caec 530 sAppCmd = APP_CMD_CONFGEOFENCE;
apalmieri 0:7b0a5a01caec 531 } else if (strcmp(pCmd, "geo-t") == 0) {
apalmieri 0:7b0a5a01caec 532 geofenceId = CataniaId;
apalmieri 0:7b0a5a01caec 533 sAppCmd = APP_CMD_CONFGEOFENCE;
apalmieri 0:7b0a5a01caec 534 } else if (strcmp(pCmd, "req-geo") == 0) {
apalmieri 0:7b0a5a01caec 535 sAppCmd = APP_CMD_GEOFENCEREQ;
apalmieri 0:7b0a5a01caec 536 } else if (strcmp(pCmd, "en-odo") == 0) {
apalmieri 0:7b0a5a01caec 537 sAppCmd = APP_CMD_ENODO;
apalmieri 0:7b0a5a01caec 538 } else if (strcmp(pCmd, "start-odo") == 0) {
apalmieri 0:7b0a5a01caec 539 sAppCmd = APP_CMD_STARTODO;
apalmieri 0:7b0a5a01caec 540 } else if (strcmp(pCmd, "stop-odo") == 0) {
apalmieri 0:7b0a5a01caec 541 sAppCmd = APP_CMD_STOPODO;
apalmieri 0:7b0a5a01caec 542 } else if (strcmp(pCmd, "en-datalog") == 0) {
apalmieri 0:7b0a5a01caec 543 sAppCmd = APP_CMD_ENDATALOG;
apalmieri 0:7b0a5a01caec 544 } else if (strcmp(pCmd, "cfg-dl") == 0) {
apalmieri 0:7b0a5a01caec 545 sAppCmd = APP_CMD_CONFDATALOG;
apalmieri 0:7b0a5a01caec 546 } else if (strcmp(pCmd, "start-dl") == 0) {
apalmieri 0:7b0a5a01caec 547 sAppCmd = APP_CMD_STARTDATALOG;
apalmieri 0:7b0a5a01caec 548 } else if (strcmp(pCmd, "stop-dl") == 0) {
apalmieri 0:7b0a5a01caec 549 sAppCmd = APP_CMD_STOPDATALOG;
apalmieri 0:7b0a5a01caec 550 } else if (strcmp(pCmd, "erase-dl") == 0) {
apalmieri 0:7b0a5a01caec 551 sAppCmd = APP_CMD_ERASEDATALOG;
apalmieri 0:7b0a5a01caec 552 } else if (strcmp(pCmd, "verbose-1") == 0) {
apalmieri 0:7b0a5a01caec 553 level = 1;
apalmieri 0:7b0a5a01caec 554 sAppCmd = APP_CMD_VERBOSE;
apalmieri 0:7b0a5a01caec 555 } else if (strcmp(pCmd, "verbose-2") == 0) {
apalmieri 0:7b0a5a01caec 556 level = 2;
apalmieri 0:7b0a5a01caec 557 sAppCmd = APP_CMD_VERBOSE;
apalmieri 0:7b0a5a01caec 558 } else if (strcmp(pCmd, "reset") == 0) {
apalmieri 0:7b0a5a01caec 559 sAppCmd = APP_CMD_RESET;
apalmieri 0:7b0a5a01caec 560 } else if (strcmp(pCmd, "getdevinfo") == 0) {
apalmieri 0:7b0a5a01caec 561 sAppCmd = APP_CMD_GET_DEVICE_INFO;
apalmieri 0:7b0a5a01caec 562 } else {
apalmieri 0:7b0a5a01caec 563 TESEO_APP_LOG_INFO("\r\nUnknown command %s\r\n", pCmd);
apalmieri 0:7b0a5a01caec 564 }
apalmieri 0:7b0a5a01caec 565
apalmieri 0:7b0a5a01caec 566 TESEO_APP_LOG_INFO("\r\n");
apalmieri 0:7b0a5a01caec 567 }