Csr location demo application shows location and satellite information, which supports H13467 + ST F103RB/NXP LCP1549 boards now.

Dependencies:   CsrLocation mbed GPSProvider

Fork of CsrLocationDemo by Qualcomm Technologies International, Ltd.

Committer:
zhjcpi
Date:
Tue Aug 05 06:22:37 2014 +0000
Revision:
9:87d1555b6219
Parent:
6:d040264b3329
Child:
10:8dbf356c44ec
Add button support to triger position report in PTF mode.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
zhjcpi 0:789f6b6f710d 1
zhjcpi 0:789f6b6f710d 2 /* CsrLocation class for mbed Microcontroller
zhjcpi 0:789f6b6f710d 3 * Copyright 2014 CSR plc
zhjcpi 0:789f6b6f710d 4 */
zhjcpi 0:789f6b6f710d 5
zhjcpi 0:789f6b6f710d 6
zhjcpi 0:789f6b6f710d 7 #include "mbed.h"
zhjcpi 0:789f6b6f710d 8 #include "CsrLocation.h"
zhjcpi 0:789f6b6f710d 9
zhjcpi 3:7a3ed8ae071d 10 #define APP_DBG_PORT_BAUD 115200
zhjcpi 3:7a3ed8ae071d 11 #define CSR_APP_LOG_INFO(...) sSerialDebug.printf(__VA_ARGS__)
zhjcpi 3:7a3ed8ae071d 12
zhjcpi 0:789f6b6f710d 13 /* appliation commands */
zhjcpi 0:789f6b6f710d 14 typedef enum AppCmd
zhjcpi 0:789f6b6f710d 15 {
zhjcpi 0:789f6b6f710d 16 APP_CMD_IDLE, // No special command
zhjcpi 0:789f6b6f710d 17 APP_CMD_HELP, // Show the supported commands
zhjcpi 0:789f6b6f710d 18 APP_CMD_START, // Start location
zhjcpi 0:789f6b6f710d 19 APP_CMD_STOP, // Stop location
zhjcpi 0:789f6b6f710d 20 APP_CMD_PM_FULL, // Set full power mode
zhjcpi 0:789f6b6f710d 21 APP_CMD_PM_PTF, // Set low power PTF mode
zhjcpi 0:789f6b6f710d 22 APP_CMD_PTF_GETPOS, // Get location immediately in low power PTF mode
zhjcpi 3:7a3ed8ae071d 23 APP_CMD_NMEA, // proto mode is NMEA
zhjcpi 3:7a3ed8ae071d 24 APP_CMD_OSP, // proto mode is OSP
zhjcpi 3:7a3ed8ae071d 25 APP_CMD_SWITCH_NMEA, // Debug command, switch chip to NMEA protocol at 4800bps
zhjcpi 3:7a3ed8ae071d 26 APP_CMD_SWITCH_OSP, // Debug command, switch chip to NMEA protocol at 4800bps
zhjcpi 3:7a3ed8ae071d 27 APP_CMD_START_FAILED, // Process start failed case
zhjcpi 3:7a3ed8ae071d 28 APP_CMD_STOP_FAILED, // Process stop failed case
zhjcpi 0:789f6b6f710d 29 APP_CMD_ONOFF_ON, // Debug command, pull onoff pin high level
zhjcpi 0:789f6b6f710d 30 APP_CMD_ONOFF_OFF, // Debug command, pull onoff pin low level
zhjcpi 0:789f6b6f710d 31 APP_CMD_RESET_ON, // Debug command, pull reset pin high level
zhjcpi 9:87d1555b6219 32 APP_CMD_RESET_OFF, // Debug command, pull reset pin low level
zhjcpi 9:87d1555b6219 33 APP_CMD_PINTEST_ON, // Debug command, pull test pin high level
zhjcpi 9:87d1555b6219 34 APP_CMD_PINTEST_OFF, // Debug command, pull test pin low level
zhjcpi 9:87d1555b6219 35 APP_CMD_PINTEST_OFF_ON // Debug command, pull test pin low firstly, then pull high level
zhjcpi 9:87d1555b6219 36
zhjcpi 0:789f6b6f710d 37 }eAppCmd;
zhjcpi 0:789f6b6f710d 38
zhjcpi 0:789f6b6f710d 39
zhjcpi 0:789f6b6f710d 40 static void _AppShowCmd(void);
zhjcpi 9:87d1555b6219 41 static void _AppBtnPushed(void);
zhjcpi 2:b70e3a839116 42 static void _AppOutputCallback(uint32_t msgId, void * const pMsgData, uint32_t msgLength);
zhjcpi 2:b70e3a839116 43 static void _AppEventCallback(eCsrLocEventType event, uint32_t data);
zhjcpi 0:789f6b6f710d 44 static void _ConsoleRxHandler(void);
zhjcpi 0:789f6b6f710d 45 static void _AppCmdProcess(char *pCmd);
zhjcpi 0:789f6b6f710d 46
zhjcpi 0:789f6b6f710d 47
zhjcpi 0:789f6b6f710d 48 static int sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 49 static ePowerMode sPwrMode = PWR_FULL;
zhjcpi 3:7a3ed8ae071d 50 static eProto sProto = PROTO_OSP;
zhjcpi 0:789f6b6f710d 51
zhjcpi 3:7a3ed8ae071d 52 static DBG_SERIAL_TYPE sSerialDebug(PINMAP_UART_DEBUG_TX, PINMAP_UART_DEBUG_RX);
zhjcpi 3:7a3ed8ae071d 53 static LOC_SERIAL_TYPE sSerialLoc(PINMAP_UART_LOC_TX, PINMAP_UART_LOC_RX);
zhjcpi 3:7a3ed8ae071d 54 static DigitalOut sPinOnoff(PINMAP_GPIO_LOC_ONOFF);
zhjcpi 3:7a3ed8ae071d 55 static DigitalOut sPinReset(PINMAP_GPIO_LOC_RESET);
zhjcpi 3:7a3ed8ae071d 56 static DigitalOut sLedLocOn(LOC_LED1);
zhjcpi 3:7a3ed8ae071d 57 static DigitalOut sLedPosReport(LOC_LED2);
zhjcpi 9:87d1555b6219 58 static InterruptIn sBtn(PINMAP_GPIO_BTN);
zhjcpi 9:87d1555b6219 59 static DigitalOut sPinTest(D10);
zhjcpi 0:789f6b6f710d 60
zhjcpi 0:789f6b6f710d 61 int main(void)
zhjcpi 0:789f6b6f710d 62 {
zhjcpi 0:789f6b6f710d 63 CsrLocation *pCsrLoc;
zhjcpi 0:789f6b6f710d 64 tCsrLocConfig locConfig;
zhjcpi 0:789f6b6f710d 65
zhjcpi 9:87d1555b6219 66 sLedLocOn = 0;
zhjcpi 9:87d1555b6219 67 sLedPosReport = 0;
zhjcpi 9:87d1555b6219 68 sPinTest = 1;
zhjcpi 9:87d1555b6219 69 sBtn.mode(PullUp);
zhjcpi 9:87d1555b6219 70 sBtn.fall(&_AppBtnPushed);
zhjcpi 9:87d1555b6219 71
zhjcpi 0:789f6b6f710d 72 /* initialize the debug serial port */
zhjcpi 3:7a3ed8ae071d 73 sSerialDebug.baud(APP_DBG_PORT_BAUD);
zhjcpi 0:789f6b6f710d 74 sSerialDebug.attach(&_ConsoleRxHandler);
zhjcpi 0:789f6b6f710d 75
zhjcpi 0:789f6b6f710d 76 /* initialize the CsrLocConfig */
zhjcpi 0:789f6b6f710d 77 locConfig.pSerialDebug = &sSerialDebug;
zhjcpi 0:789f6b6f710d 78 locConfig.pSerialLoc = &sSerialLoc;
zhjcpi 0:789f6b6f710d 79 locConfig.pPinOnoff = &sPinOnoff;
zhjcpi 0:789f6b6f710d 80 locConfig.pPinReset = &sPinReset;
zhjcpi 0:789f6b6f710d 81
zhjcpi 0:789f6b6f710d 82 /* new the CsrLocation instance */
zhjcpi 0:789f6b6f710d 83 pCsrLoc = new CsrLocation(&locConfig);
zhjcpi 0:789f6b6f710d 84 if(pCsrLoc == NULL)
zhjcpi 0:789f6b6f710d 85 {
zhjcpi 3:7a3ed8ae071d 86 CSR_APP_LOG_INFO("Failed to new csrLocation.\r\n");
zhjcpi 0:789f6b6f710d 87 sSerialDebug.attach(NULL);
zhjcpi 0:789f6b6f710d 88 return -1;
zhjcpi 0:789f6b6f710d 89 }
zhjcpi 3:7a3ed8ae071d 90 else
zhjcpi 3:7a3ed8ae071d 91 {
zhjcpi 3:7a3ed8ae071d 92 CSR_APP_LOG_INFO("Success to new csrLocation.\r\n");
zhjcpi 3:7a3ed8ae071d 93 }
zhjcpi 0:789f6b6f710d 94
zhjcpi 0:789f6b6f710d 95 /* Register output callback and event callback functions */
zhjcpi 0:789f6b6f710d 96 pCsrLoc->CsrLocRegOutput(_AppOutputCallback, _AppEventCallback);
zhjcpi 0:789f6b6f710d 97
zhjcpi 0:789f6b6f710d 98 _AppShowCmd();
zhjcpi 0:789f6b6f710d 99
zhjcpi 0:789f6b6f710d 100 while(1)
zhjcpi 0:789f6b6f710d 101 {
zhjcpi 0:789f6b6f710d 102 switch(sAppCmd)
zhjcpi 0:789f6b6f710d 103 {
zhjcpi 0:789f6b6f710d 104 case APP_CMD_HELP:
zhjcpi 0:789f6b6f710d 105 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 106 _AppShowCmd();
zhjcpi 0:789f6b6f710d 107 break;
zhjcpi 0:789f6b6f710d 108 case APP_CMD_START:
zhjcpi 0:789f6b6f710d 109 sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 110 CSR_APP_LOG_INFO("start location.\r\n");
zhjcpi 0:789f6b6f710d 111 sLedLocOn = 1;
zhjcpi 3:7a3ed8ae071d 112 pCsrLoc->CsrLocStart(sPwrMode, sProto);
zhjcpi 0:789f6b6f710d 113 break;
zhjcpi 0:789f6b6f710d 114 case APP_CMD_STOP:
zhjcpi 0:789f6b6f710d 115 sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 116 CSR_APP_LOG_INFO("stop location.\r\n");
zhjcpi 0:789f6b6f710d 117 sLedLocOn = 0;
zhjcpi 0:789f6b6f710d 118 pCsrLoc->CsrLocStop();
zhjcpi 0:789f6b6f710d 119 break;
zhjcpi 0:789f6b6f710d 120 case APP_CMD_START_FAILED:
zhjcpi 0:789f6b6f710d 121 sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 122 CSR_APP_LOG_INFO("reset as start failed.\r\n");
zhjcpi 0:789f6b6f710d 123 sLedLocOn = 0;
zhjcpi 0:789f6b6f710d 124 pCsrLoc->CsrLocStop();
zhjcpi 0:789f6b6f710d 125 pCsrLoc->CsrLocReset();
zhjcpi 0:789f6b6f710d 126 break;
zhjcpi 0:789f6b6f710d 127 case APP_CMD_STOP_FAILED:
zhjcpi 0:789f6b6f710d 128 sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 129 CSR_APP_LOG_INFO("reset as stop failed.\r\n");
zhjcpi 0:789f6b6f710d 130 sLedLocOn = 0;
zhjcpi 0:789f6b6f710d 131 pCsrLoc->CsrLocStop();
zhjcpi 0:789f6b6f710d 132 pCsrLoc->CsrLocReset();
zhjcpi 0:789f6b6f710d 133 break;
zhjcpi 0:789f6b6f710d 134 case APP_CMD_IDLE:
zhjcpi 0:789f6b6f710d 135 pCsrLoc->CsrLocUpdate();
zhjcpi 0:789f6b6f710d 136 break;
zhjcpi 0:789f6b6f710d 137 case APP_CMD_ONOFF_ON:
zhjcpi 3:7a3ed8ae071d 138 CSR_APP_LOG_INFO("onoff on.\r\n");
zhjcpi 0:789f6b6f710d 139 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 140 sPinOnoff = 1;
zhjcpi 0:789f6b6f710d 141 break;
zhjcpi 0:789f6b6f710d 142 case APP_CMD_ONOFF_OFF:
zhjcpi 3:7a3ed8ae071d 143 CSR_APP_LOG_INFO("onoff off.\r\n");
zhjcpi 0:789f6b6f710d 144 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 145 sPinOnoff = 0;
zhjcpi 0:789f6b6f710d 146 break;
zhjcpi 0:789f6b6f710d 147 case APP_CMD_RESET_ON:
zhjcpi 3:7a3ed8ae071d 148 CSR_APP_LOG_INFO("reset on.\r\n");
zhjcpi 0:789f6b6f710d 149 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 150 sPinReset = 1;
zhjcpi 0:789f6b6f710d 151 break;
zhjcpi 0:789f6b6f710d 152 case APP_CMD_RESET_OFF:
zhjcpi 3:7a3ed8ae071d 153 CSR_APP_LOG_INFO("reset off.\r\n");
zhjcpi 0:789f6b6f710d 154 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 155 sPinReset = 0;
zhjcpi 0:789f6b6f710d 156 break;
zhjcpi 9:87d1555b6219 157 case APP_CMD_PINTEST_ON:
zhjcpi 9:87d1555b6219 158 CSR_APP_LOG_INFO("test pin on.\r\n");
zhjcpi 9:87d1555b6219 159 sAppCmd = APP_CMD_IDLE;
zhjcpi 9:87d1555b6219 160 sPinTest = 1;
zhjcpi 9:87d1555b6219 161 break;
zhjcpi 9:87d1555b6219 162 case APP_CMD_PINTEST_OFF:
zhjcpi 9:87d1555b6219 163 CSR_APP_LOG_INFO("test pin off.\r\n");
zhjcpi 5:a4f421140212 164 sAppCmd = APP_CMD_IDLE;
zhjcpi 9:87d1555b6219 165 sPinTest = 0;
zhjcpi 9:87d1555b6219 166 break;
zhjcpi 9:87d1555b6219 167 case APP_CMD_PINTEST_OFF_ON:
zhjcpi 9:87d1555b6219 168 CSR_APP_LOG_INFO("test pin off and high.\r\n");
zhjcpi 9:87d1555b6219 169 sAppCmd = APP_CMD_IDLE;
zhjcpi 9:87d1555b6219 170 sPinTest = 0;
zhjcpi 9:87d1555b6219 171 wait_ms(100);
zhjcpi 9:87d1555b6219 172 sPinTest = 1;
zhjcpi 9:87d1555b6219 173 break;
zhjcpi 9:87d1555b6219 174 case APP_CMD_PTF_GETPOS:
zhjcpi 3:7a3ed8ae071d 175 CSR_APP_LOG_INFO("lpm get pos.\r\n");
zhjcpi 9:87d1555b6219 176 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 177 pCsrLoc->CsrLocLpmGetPos();
zhjcpi 0:789f6b6f710d 178 break;
zhjcpi 0:789f6b6f710d 179 case APP_CMD_NMEA:
zhjcpi 9:87d1555b6219 180 CSR_APP_LOG_INFO("select NMEA protocol.\r\n");
zhjcpi 9:87d1555b6219 181 sProto = PROTO_NMEA;
zhjcpi 5:a4f421140212 182 sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 183 break;
zhjcpi 3:7a3ed8ae071d 184 case APP_CMD_OSP:
zhjcpi 3:7a3ed8ae071d 185 CSR_APP_LOG_INFO("select OSP protocol.\r\n");
zhjcpi 3:7a3ed8ae071d 186 sProto = PROTO_OSP;
zhjcpi 9:87d1555b6219 187 sAppCmd = APP_CMD_IDLE;
zhjcpi 3:7a3ed8ae071d 188 break;
zhjcpi 3:7a3ed8ae071d 189 case APP_CMD_SWITCH_NMEA:
zhjcpi 9:87d1555b6219 190 CSR_APP_LOG_INFO("switch to NMEA protocol.\r\n");
zhjcpi 5:a4f421140212 191 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 192 pCsrLoc->CsrLocDebugSwitch2Nmea();
zhjcpi 0:789f6b6f710d 193 break;
zhjcpi 0:789f6b6f710d 194 case APP_CMD_PM_FULL:
zhjcpi 9:87d1555b6219 195 CSR_APP_LOG_INFO("fpm set.\r\n");
zhjcpi 5:a4f421140212 196 sAppCmd = APP_CMD_IDLE;
zhjcpi 0:789f6b6f710d 197 sPwrMode = PWR_FULL;
zhjcpi 0:789f6b6f710d 198 break;
zhjcpi 0:789f6b6f710d 199 case APP_CMD_PM_PTF:
zhjcpi 9:87d1555b6219 200 CSR_APP_LOG_INFO("lpm ptf set.\r\n");
zhjcpi 5:a4f421140212 201 sAppCmd = APP_CMD_IDLE;
zhjcpi 9:87d1555b6219 202 sPwrMode = PWR_PTF;
zhjcpi 0:789f6b6f710d 203 break;
zhjcpi 0:789f6b6f710d 204 }
zhjcpi 0:789f6b6f710d 205 }
zhjcpi 0:789f6b6f710d 206 }
zhjcpi 0:789f6b6f710d 207
zhjcpi 0:789f6b6f710d 208 static void _AppShowCmd(void)
zhjcpi 0:789f6b6f710d 209 {
zhjcpi 3:7a3ed8ae071d 210 CSR_APP_LOG_INFO("Location commands:\r\n");
zhjcpi 3:7a3ed8ae071d 211 CSR_APP_LOG_INFO(" help - help to show supported commands\r\n");
zhjcpi 3:7a3ed8ae071d 212 CSR_APP_LOG_INFO(" start - begin location\r\n");
zhjcpi 3:7a3ed8ae071d 213 CSR_APP_LOG_INFO(" stop - end location\r\n");
zhjcpi 3:7a3ed8ae071d 214 CSR_APP_LOG_INFO(" fpm - full power mode\r\n");
zhjcpi 3:7a3ed8ae071d 215 CSR_APP_LOG_INFO(" ptf - ptf low power mode\r\n");
zhjcpi 3:7a3ed8ae071d 216 CSR_APP_LOG_INFO(" getpos - get location immediately in low power ptf mode\r\n");
zhjcpi 3:7a3ed8ae071d 217 CSR_APP_LOG_INFO(" osp - OSP mode\r\n");
zhjcpi 3:7a3ed8ae071d 218 CSR_APP_LOG_INFO(" nmea - NMEA mode\r\n");
zhjcpi 0:789f6b6f710d 219
zhjcpi 0:789f6b6f710d 220 }
zhjcpi 0:789f6b6f710d 221
zhjcpi 9:87d1555b6219 222 static void _AppBtnPushed(void)
zhjcpi 9:87d1555b6219 223 {
zhjcpi 9:87d1555b6219 224 sAppCmd = APP_CMD_PTF_GETPOS;
zhjcpi 9:87d1555b6219 225 // sLedLocOn = !sLedLocOn;
zhjcpi 9:87d1555b6219 226 // wait_ms(10);
zhjcpi 9:87d1555b6219 227 // sLedLocOn = 0;
zhjcpi 9:87d1555b6219 228 }
zhjcpi 9:87d1555b6219 229
zhjcpi 2:b70e3a839116 230 static void _AppOutputCallback(uint32_t msgId, void * const pMsgData, uint32_t msgLength)
zhjcpi 0:789f6b6f710d 231 {
zhjcpi 0:789f6b6f710d 232 switch(msgId)
zhjcpi 0:789f6b6f710d 233 {
zhjcpi 0:789f6b6f710d 234 case LOC_OUTPUT_LOCATION:
zhjcpi 0:789f6b6f710d 235 {
zhjcpi 0:789f6b6f710d 236 tLocPosResp *pPosRsp = (tLocPosResp *)pMsgData;
zhjcpi 3:7a3ed8ae071d 237 CSR_APP_LOG_INFO("Loc: lat=%f, lon=%f, alt=%f\r\n", pPosRsp->lat, pPosRsp->lon, pPosRsp->alt);
zhjcpi 9:87d1555b6219 238 sLedPosReport = 1;
zhjcpi 9:87d1555b6219 239 wait_ms(10);
zhjcpi 9:87d1555b6219 240 sLedPosReport = 0;
zhjcpi 0:789f6b6f710d 241 break;
zhjcpi 0:789f6b6f710d 242 }
zhjcpi 0:789f6b6f710d 243 case LOC_OUTPUT_SV_STATUS:
zhjcpi 0:789f6b6f710d 244 {
zhjcpi 0:789f6b6f710d 245 tLocSvStatus *pSvStatus = (tLocSvStatus *)pMsgData;
zhjcpi 3:7a3ed8ae071d 246 CSR_APP_LOG_INFO("SV:week=%u, tow=%lu, GPS Num=%u, GLO Num=%u, GPS Mask=0x%lx, GLO Mask=0x%lx\r\n",
zhjcpi 0:789f6b6f710d 247 pSvStatus->gps_week, pSvStatus->tow, pSvStatus->numOfSVs, pSvStatus->numOfGloSVs,
zhjcpi 0:789f6b6f710d 248 pSvStatus->svUsedInFixMask, pSvStatus->gloSvUsedInFixMask);
zhjcpi 0:789f6b6f710d 249 break;
zhjcpi 0:789f6b6f710d 250 }
zhjcpi 0:789f6b6f710d 251
zhjcpi 0:789f6b6f710d 252 default :
zhjcpi 0:789f6b6f710d 253 break;
zhjcpi 0:789f6b6f710d 254 }
zhjcpi 0:789f6b6f710d 255 }
zhjcpi 0:789f6b6f710d 256
zhjcpi 2:b70e3a839116 257 static void _AppEventCallback(eCsrLocEventType event, uint32_t data)
zhjcpi 0:789f6b6f710d 258 {
zhjcpi 0:789f6b6f710d 259 switch(event)
zhjcpi 0:789f6b6f710d 260 {
zhjcpi 0:789f6b6f710d 261 case CSR_LOC_EVENT_START_RESULT:
zhjcpi 0:789f6b6f710d 262 if(data != 0)
zhjcpi 0:789f6b6f710d 263 {
zhjcpi 3:7a3ed8ae071d 264 CSR_APP_LOG_INFO("start failed.\r\n");
zhjcpi 0:789f6b6f710d 265 sAppCmd = APP_CMD_START_FAILED;
zhjcpi 0:789f6b6f710d 266 }
zhjcpi 0:789f6b6f710d 267 else
zhjcpi 0:789f6b6f710d 268 {
zhjcpi 3:7a3ed8ae071d 269 CSR_APP_LOG_INFO("start OK.\r\n");
zhjcpi 0:789f6b6f710d 270 }
zhjcpi 0:789f6b6f710d 271 break;
zhjcpi 0:789f6b6f710d 272 case CSR_LOC_EVENT_STOP_RESULT:
zhjcpi 0:789f6b6f710d 273 if(data != 0)
zhjcpi 0:789f6b6f710d 274 {
zhjcpi 3:7a3ed8ae071d 275 CSR_APP_LOG_INFO("stop failed.\r\n");
zhjcpi 0:789f6b6f710d 276 sAppCmd = APP_CMD_STOP_FAILED;
zhjcpi 0:789f6b6f710d 277 }
zhjcpi 0:789f6b6f710d 278 else
zhjcpi 0:789f6b6f710d 279 {
zhjcpi 3:7a3ed8ae071d 280 CSR_APP_LOG_INFO("stop OK.\r\n");
zhjcpi 0:789f6b6f710d 281 }
zhjcpi 0:789f6b6f710d 282 break;
zhjcpi 0:789f6b6f710d 283 default:
zhjcpi 0:789f6b6f710d 284 break;
zhjcpi 0:789f6b6f710d 285 }
zhjcpi 0:789f6b6f710d 286 }
zhjcpi 0:789f6b6f710d 287
zhjcpi 0:789f6b6f710d 288 static void _ConsoleRxHandler(void)
zhjcpi 0:789f6b6f710d 289 {
zhjcpi 0:789f6b6f710d 290 static char cmd[32] = {0};
zhjcpi 0:789f6b6f710d 291 char ch;
zhjcpi 0:789f6b6f710d 292
zhjcpi 0:789f6b6f710d 293 ch = sSerialDebug.getc();
zhjcpi 0:789f6b6f710d 294 sSerialDebug.putc(ch);
zhjcpi 0:789f6b6f710d 295 if(ch == '\r')
zhjcpi 0:789f6b6f710d 296 {
zhjcpi 0:789f6b6f710d 297 sSerialDebug.putc('\n');
zhjcpi 0:789f6b6f710d 298 if(strlen(cmd) > 0)
zhjcpi 0:789f6b6f710d 299 {
zhjcpi 0:789f6b6f710d 300 _AppCmdProcess(cmd);
zhjcpi 0:789f6b6f710d 301 memset(cmd, 0, sizeof(cmd));
zhjcpi 0:789f6b6f710d 302 }
zhjcpi 0:789f6b6f710d 303 }
zhjcpi 0:789f6b6f710d 304 else
zhjcpi 0:789f6b6f710d 305 {
zhjcpi 0:789f6b6f710d 306 cmd[strlen(cmd)] = ch;
zhjcpi 0:789f6b6f710d 307 }
zhjcpi 0:789f6b6f710d 308 }
zhjcpi 0:789f6b6f710d 309
zhjcpi 0:789f6b6f710d 310 static void _AppCmdProcess(char *pCmd)
zhjcpi 0:789f6b6f710d 311 {
zhjcpi 0:789f6b6f710d 312 if(strcmp(pCmd, "help") == 0)
zhjcpi 0:789f6b6f710d 313 {
zhjcpi 0:789f6b6f710d 314 sAppCmd = APP_CMD_HELP;
zhjcpi 0:789f6b6f710d 315 }
zhjcpi 0:789f6b6f710d 316 else if(strcmp(pCmd, "start") == 0)
zhjcpi 0:789f6b6f710d 317 {
zhjcpi 0:789f6b6f710d 318 sAppCmd = APP_CMD_START;
zhjcpi 0:789f6b6f710d 319 }
zhjcpi 0:789f6b6f710d 320 else if(strcmp(pCmd, "stop") == 0)
zhjcpi 0:789f6b6f710d 321 {
zhjcpi 0:789f6b6f710d 322 sAppCmd = APP_CMD_STOP;
zhjcpi 0:789f6b6f710d 323 }
zhjcpi 0:789f6b6f710d 324 else if(strcmp(pCmd, "fpm") == 0)
zhjcpi 0:789f6b6f710d 325 {
zhjcpi 0:789f6b6f710d 326 sAppCmd = APP_CMD_PM_FULL;
zhjcpi 0:789f6b6f710d 327 }
zhjcpi 0:789f6b6f710d 328 else if(strcmp(pCmd, "ptf") == 0)
zhjcpi 0:789f6b6f710d 329 {
zhjcpi 0:789f6b6f710d 330 sAppCmd = APP_CMD_PM_PTF;
zhjcpi 0:789f6b6f710d 331 }
zhjcpi 0:789f6b6f710d 332 else if(strcmp(pCmd, "getpos") == 0)
zhjcpi 0:789f6b6f710d 333 {
zhjcpi 0:789f6b6f710d 334 sAppCmd = APP_CMD_PTF_GETPOS;
zhjcpi 0:789f6b6f710d 335 }
zhjcpi 0:789f6b6f710d 336 else if(strcmp(pCmd, "nmea") == 0)
zhjcpi 0:789f6b6f710d 337 {
zhjcpi 0:789f6b6f710d 338 sAppCmd = APP_CMD_NMEA;
zhjcpi 3:7a3ed8ae071d 339 }
zhjcpi 3:7a3ed8ae071d 340 else if(strcmp(pCmd, "osp") == 0)
zhjcpi 3:7a3ed8ae071d 341 {
zhjcpi 3:7a3ed8ae071d 342 sAppCmd = APP_CMD_OSP;
zhjcpi 3:7a3ed8ae071d 343 }
zhjcpi 3:7a3ed8ae071d 344 else if(strcmp(pCmd, "switchnmea") == 0)
zhjcpi 3:7a3ed8ae071d 345 {
zhjcpi 3:7a3ed8ae071d 346 sAppCmd = APP_CMD_SWITCH_NMEA;
zhjcpi 3:7a3ed8ae071d 347 }
zhjcpi 3:7a3ed8ae071d 348 else if(strcmp(pCmd, "switchosp") == 0)
zhjcpi 3:7a3ed8ae071d 349 {
zhjcpi 3:7a3ed8ae071d 350 sAppCmd = APP_CMD_SWITCH_OSP;
zhjcpi 0:789f6b6f710d 351 }
zhjcpi 0:789f6b6f710d 352 else if(strcmp(pCmd, "onoffon") == 0)
zhjcpi 0:789f6b6f710d 353 {
zhjcpi 0:789f6b6f710d 354 sAppCmd = APP_CMD_ONOFF_ON;
zhjcpi 0:789f6b6f710d 355 }
zhjcpi 0:789f6b6f710d 356 else if(strcmp(pCmd, "onoffoff") == 0)
zhjcpi 0:789f6b6f710d 357 {
zhjcpi 0:789f6b6f710d 358 sAppCmd = APP_CMD_ONOFF_OFF;
zhjcpi 0:789f6b6f710d 359 }
zhjcpi 0:789f6b6f710d 360 else if(strcmp(pCmd, "reseton") == 0)
zhjcpi 0:789f6b6f710d 361 {
zhjcpi 0:789f6b6f710d 362 sAppCmd = APP_CMD_RESET_ON;
zhjcpi 0:789f6b6f710d 363 }
zhjcpi 0:789f6b6f710d 364 else if(strcmp(pCmd, "resetoff") == 0)
zhjcpi 0:789f6b6f710d 365 {
zhjcpi 0:789f6b6f710d 366 sAppCmd = APP_CMD_RESET_OFF;
zhjcpi 0:789f6b6f710d 367 }
zhjcpi 9:87d1555b6219 368 else if(strcmp(pCmd, "pinteston") == 0)
zhjcpi 9:87d1555b6219 369 {
zhjcpi 9:87d1555b6219 370 sAppCmd = APP_CMD_PINTEST_ON;
zhjcpi 9:87d1555b6219 371 }
zhjcpi 9:87d1555b6219 372 else if(strcmp(pCmd, "pintestoff") == 0)
zhjcpi 9:87d1555b6219 373 {
zhjcpi 9:87d1555b6219 374 sAppCmd = APP_CMD_PINTEST_OFF;
zhjcpi 9:87d1555b6219 375 }
zhjcpi 9:87d1555b6219 376 else if(strcmp(pCmd, "pintestoffon") == 0)
zhjcpi 9:87d1555b6219 377 {
zhjcpi 9:87d1555b6219 378 sAppCmd = APP_CMD_PINTEST_OFF_ON;
zhjcpi 9:87d1555b6219 379 }
zhjcpi 0:789f6b6f710d 380 else
zhjcpi 0:789f6b6f710d 381 {
zhjcpi 3:7a3ed8ae071d 382 CSR_APP_LOG_INFO("\r\nUnknown command %s\r\n", pCmd);
zhjcpi 0:789f6b6f710d 383 }
zhjcpi 3:7a3ed8ae071d 384
zhjcpi 3:7a3ed8ae071d 385 CSR_APP_LOG_INFO("\r\n");
zhjcpi 0:789f6b6f710d 386 }