Delta / Mbed OS Delta_CLI

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.

Fork of NNN40_CLI by Delta

CLI_Source/ble_cli.cpp@18:4f5b317c04b9, 2016-09-23 (annotated)

Committer:
silviaChen
Date:
Fri Sep 23 01:41:28 2016 +0000
Revision:
18:4f5b317c04b9
Parent:
17:03c8af30087a
Child:
19:e2de6c1776eb
CLI V1.15, Fix the connect command issue

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gillwei7 0:5c195ab2f696 1 /**
gillwei7 0:5c195ab2f696 2 * File: ble-cli.c
gillwei7 0:5c195ab2f696 3 * Description: BLE CLI commands used by all applications BLE of profile.
gillwei7 0:5c195ab2f696 4 *
gillwei7 0:5c195ab2f696 5 * Copyright 2014 by CYNTEC Corporation. All rights reserved.
gillwei7 0:5c195ab2f696 6 */
gillwei7 3:38ec8ad317f4 7
gillwei7 9:ff3ccba5dc16 8 #include "ble_cli.h" // All #include define in ble_cli.h
gillwei7 9:ff3ccba5dc16 9
gillwei7 9:ff3ccba5dc16 10 // Genral configuration parameters
gillwei7 14:397f6514bb2c 11 #define BLE_DEBUG 0
gillwei7 12:a91455702763 12 #define MAX_DEVNAME_LEN 32
silviaChen 18:4f5b317c04b9 13 #define CLI_FWVERION "DELTA_CLI_V1.15"
silviaChen 18:4f5b317c04b9 14
silviaChen 18:4f5b317c04b9 15 //0920 Silvia modify
silviaChen 18:4f5b317c04b9 16 #if defined(TARGET_NRF52_DK)//temp use only
silviaChen 18:4f5b317c04b9 17 #define MODULE_NAME "DFBM-NQ620"
silviaChen 18:4f5b317c04b9 18 #else
gillwei7 9:ff3ccba5dc16 19 #define MODULE_NAME "DFCM-NNN40-DT1R"
silviaChen 18:4f5b317c04b9 20 #endif
silviaChen 18:4f5b317c04b9 21 //0920 Silvia modify
gillwei7 9:ff3ccba5dc16 22
gillwei7 9:ff3ccba5dc16 23 // Advertising configuration parameters
gillwei7 4:b52035367aee 24 #define APP_ADV_INTERVAL 40 /**< The advertising interval (in units of ms). */
gillwei7 0:5c195ab2f696 25 #define APP_ADV_TIMEOUT_IN_SECONDS 180 /**< The advertising timeout (in units of seconds). */
gillwei7 4:b52035367aee 26 #define APP_ADV_INTERVAL_MAX 10240 // correspond to 10.24s
gillwei7 4:b52035367aee 27 #define APP_ADV_INTERVAL_MIN 20 // correspond to 20ms
gillwei7 9:ff3ccba5dc16 28 #define APP_ADV_DATA_OFFSET 2 // Offset for Advertising Data.
gillwei7 9:ff3ccba5dc16 29 //#define ADVERTISING_LED_PIN_NO LED1
gillwei7 9:ff3ccba5dc16 30 // Peripheral mode operation parameters
gillwei7 0:5c195ab2f696 31 #define CLI_SERVICE_MAX_NUM 10
gillwei7 0:5c195ab2f696 32 #define CLI_CHAR_MAX_NUM 10
gillwei7 0:5c195ab2f696 33 #define MAX_VALUE_LENGTH 20
gillwei7 9:ff3ccba5dc16 34 // Central mode operation parameters
gillwei7 3:38ec8ad317f4 35 #define DEFAULT_SCAN_INTERVAL 500
gillwei7 3:38ec8ad317f4 36 #define DEFAULT_SCAN_WINDOW 400
gillwei7 4:b52035367aee 37 #define DEFAULT_SCAN_TIMEOUT 0x0005
gillwei7 3:38ec8ad317f4 38 #define BLE_MAX_ADDRESS_NUMBER 10
gillwei7 4:b52035367aee 39 #define TARGET_DEVNAME_LEN 30
gillwei7 0:5c195ab2f696 40
gillwei7 0:5c195ab2f696 41 typedef struct bufferGattChar {
gillwei7 15:d627ee60bb78 42 uint8_t props;
gillwei7 4:b52035367aee 43 UUID char_uuid;
gillwei7 4:b52035367aee 44 uint8_t value[MAX_VALUE_LENGTH];
gillwei7 7:33214585c606 45 uint16_t char_value_handle;
gillwei7 14:397f6514bb2c 46 uint16_t valueLength;
gillwei7 0:5c195ab2f696 47 } bufferGattChar_t;
gillwei7 0:5c195ab2f696 48
gillwei7 0:5c195ab2f696 49 typedef struct bufferGattService {
gillwei7 4:b52035367aee 50 UUID ser_uuid;
gillwei7 3:38ec8ad317f4 51 bufferGattChar_t bufferGattChar[CLI_CHAR_MAX_NUM];
gillwei7 4:b52035367aee 52 //uint16_t service_handle;
gillwei7 0:5c195ab2f696 53 } bufferGattService_t;
gillwei7 0:5c195ab2f696 54
gillwei7 3:38ec8ad317f4 55 // gill 20150916 for scan
gillwei7 3:38ec8ad317f4 56 typedef struct {
gillwei7 3:38ec8ad317f4 57 const uint8_t * p_data; /**< Pointer to data. */
gillwei7 3:38ec8ad317f4 58 uint8_t data_len; /**< Length of data. */
gillwei7 3:38ec8ad317f4 59 } data_t;
gillwei7 3:38ec8ad317f4 60
gillwei7 9:ff3ccba5dc16 61 /*************** General parameters**********************************/
gillwei7 9:ff3ccba5dc16 62 bufferGattService_t bufferService[CLI_SERVICE_MAX_NUM]; /* save entry services */
gillwei7 9:ff3ccba5dc16 63 static GattCharacteristic *charAry[CLI_SERVICE_MAX_NUM][CLI_CHAR_MAX_NUM];
silviaChen 16:d1682a3e93f5 64 DiscoveredService discoverServiceArr[CLI_SERVICE_MAX_NUM]; //Silvia add
silviaChen 16:d1682a3e93f5 65 DiscoveredCharacteristic discoverCharArr[CLI_SERVICE_MAX_NUM][CLI_CHAR_MAX_NUM]; //Silvia add
gillwei7 4:b52035367aee 66 extern Serial console;
gillwei7 4:b52035367aee 67 BLE deltaBLE; //gill 0904
gillwei7 4:b52035367aee 68 extern const char* cyntecCommandErrorNames[];
gillwei7 9:ff3ccba5dc16 69 //extern uint8_t isValidGPIO(uint8_t);
gillwei7 9:ff3ccba5dc16 70
gillwei7 9:ff3ccba5dc16 71 /*************** GATT Configuration parameters************************/
gillwei7 7:33214585c606 72 static bool connState = false; // gill 0904, define currently connecting state
gillwei7 4:b52035367aee 73 static uint8_t service_count=0;
gillwei7 4:b52035367aee 74 static uint8_t char_count=0;
silviaChen 16:d1682a3e93f5 75 static uint8_t discoverService_count=0; //Silvia add
silviaChen 16:d1682a3e93f5 76 static uint8_t discoverChar_count=0; //Silvia add
gillwei7 9:ff3ccba5dc16 77 static uint16_t test_conn_handle; //Connection handle, assign after trigger onConnectionCallback
gillwei7 5:ee474e3133eb 78 //extern bool advState; // currently no use
gillwei7 3:38ec8ad317f4 79 static Gap::Address_t saveAddr[BLE_MAX_ADDRESS_NUMBER]; // check in advertisementCallback
gillwei7 3:38ec8ad317f4 80 static uint8_t bleDevInd;
silviaChen 16:d1682a3e93f5 81 //static const unsigned ADDR_LEN = BLEProtocol::ADDR_LEN; //Silvia add, Length (in octets) of the BLE MAC address
silviaChen 16:d1682a3e93f5 82 static BLEProtocol::AddressBytes_t targetAddr; //Silvia add, For connect target device
gillwei7 7:33214585c606 83 static char targetDevName[TARGET_DEVNAME_LEN]; // For connect target device
gillwei7 6:1243f9e584f4 84 //static char DEVICE_NAME[] = "nRF5x"; // default device name, same as defined in Gap.h
gillwei7 4:b52035367aee 85 static bool conn_action = false; // Gill add 20151015
gillwei7 9:ff3ccba5dc16 86 static ble_gap_addr_t m_peer_addr;
gillwei7 9:ff3ccba5dc16 87 //DigitalOut led1(p7);
gillwei7 9:ff3ccba5dc16 88 //DigitalOut led2(p13);
gillwei7 10:5f1fa331d07c 89 DigitalOut BLEWriteInt(p13); // used in OnDataWritten()
gillwei7 0:5c195ab2f696 90
silviaChen 16:d1682a3e93f5 91
gillwei7 0:5c195ab2f696 92 /******************************************************
gillwei7 0:5c195ab2f696 93 * Function Definitions
gillwei7 0:5c195ab2f696 94 ******************************************************/
gillwei7 0:5c195ab2f696 95
gillwei7 5:ee474e3133eb 96 //DiscoveredCharacteristic ledCharacteristic;
gillwei7 0:5c195ab2f696 97
gillwei7 4:b52035367aee 98 void serviceDiscoveryCallback(const DiscoveredService *service)
gillwei7 4:b52035367aee 99 {
silviaChen 18:4f5b317c04b9 100 console.printf("serviceDiscoveryCallback\r\n");
gillwei7 4:b52035367aee 101 if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 18:4f5b317c04b9 102 console.printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle());
gillwei7 4:b52035367aee 103 } else {
silviaChen 18:4f5b317c04b9 104 console.printf("S UUID-");
gillwei7 4:b52035367aee 105 const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID();
gillwei7 4:b52035367aee 106 for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) {
silviaChen 18:4f5b317c04b9 107 console.printf("%02x", longUUIDBytes[i]);
gillwei7 4:b52035367aee 108 }
silviaChen 18:4f5b317c04b9 109 console.printf(" attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle());
gillwei7 4:b52035367aee 110 }
silviaChen 16:d1682a3e93f5 111
silviaChen 16:d1682a3e93f5 112 discoverServiceArr[discoverService_count] = *service;
silviaChen 16:d1682a3e93f5 113 discoverService_count++;
silviaChen 16:d1682a3e93f5 114 discoverChar_count = 0;
gillwei7 4:b52035367aee 115 }
gillwei7 4:b52035367aee 116
gillwei7 4:b52035367aee 117 void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP)
gillwei7 4:b52035367aee 118 {
silviaChen 16:d1682a3e93f5 119 //Silvia modify
silviaChen 16:d1682a3e93f5 120 if (characteristicP->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 18:4f5b317c04b9 121 console.printf(" C UUID-%x valueAttr[%u] props[%x]\r\n", characteristicP->getUUID().getShortUUID(), characteristicP->getValueHandle(), (uint8_t)characteristicP->getProperties().broadcast());
silviaChen 16:d1682a3e93f5 122 }
silviaChen 16:d1682a3e93f5 123 else {
silviaChen 18:4f5b317c04b9 124 console.printf(" C UUID-");
silviaChen 16:d1682a3e93f5 125 const uint8_t *longUUIDBytes = characteristicP->getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 126 for (unsigned i = (UUID::LENGTH_OF_LONG_UUID) - 1; i < UUID::LENGTH_OF_LONG_UUID; i--) {
silviaChen 18:4f5b317c04b9 127 console.printf("%02x ", longUUIDBytes[i]);
silviaChen 16:d1682a3e93f5 128 }
silviaChen 18:4f5b317c04b9 129 console.printf(" valueAttr[%u] props[%x]\r\n", characteristicP->getValueHandle(), (uint8_t)characteristicP->getProperties().broadcast());
silviaChen 16:d1682a3e93f5 130 // uvCharacteristic = *characteristicP;
silviaChen 16:d1682a3e93f5 131 }
silviaChen 16:d1682a3e93f5 132
silviaChen 16:d1682a3e93f5 133 discoverCharArr[discoverService_count - 1][discoverChar_count] = *characteristicP;
silviaChen 16:d1682a3e93f5 134 discoverChar_count++;
gillwei7 4:b52035367aee 135 }
gillwei7 4:b52035367aee 136 void discoveryTerminationCallback(Gap::Handle_t connectionHandle)
gillwei7 4:b52035367aee 137 {
silviaChen 18:4f5b317c04b9 138 console.printf("terminated SD for handle %u\r\n", connectionHandle);
gillwei7 4:b52035367aee 139 }
gillwei7 4:b52035367aee 140
gillwei7 0:5c195ab2f696 141 void onConnectionCallback(const Gap::ConnectionCallbackParams_t *params)
gillwei7 0:5c195ab2f696 142 {
gillwei7 0:5c195ab2f696 143 test_conn_handle = params->handle;
gillwei7 0:5c195ab2f696 144 connState = true;
gillwei7 14:397f6514bb2c 145 #if BLE_DEBUG
gillwei7 4:b52035367aee 146 console.printf("Connect: connState write to %d\r\n",connState);
gillwei7 4:b52035367aee 147 #endif
silviaChen 16:d1682a3e93f5 148 //Silvia modify
silviaChen 16:d1682a3e93f5 149 if (params->role == Gap::CENTRAL) {
silviaChen 16:d1682a3e93f5 150 deltaBLE.gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback);
silviaChen 16:d1682a3e93f5 151 deltaBLE.gattClient().launchServiceDiscovery(test_conn_handle, serviceDiscoveryCallback, characteristicDiscoveryCallback);
silviaChen 16:d1682a3e93f5 152 }
silviaChen 16:d1682a3e93f5 153 //Silvia modify
gillwei7 0:5c195ab2f696 154 }
gillwei7 0:5c195ab2f696 155
gillwei7 5:ee474e3133eb 156 void onTimeoutCallback(Gap::TimeoutSource_t source)
gillwei7 5:ee474e3133eb 157 {
gillwei7 7:33214585c606 158 //led1 = !led1;
silviaChen 16:d1682a3e93f5 159
silviaChen 16:d1682a3e93f5 160 //Silvia add
silviaChen 16:d1682a3e93f5 161 switch (source) {
silviaChen 16:d1682a3e93f5 162 case Gap::TIMEOUT_SRC_ADVERTISING:
silviaChen 18:4f5b317c04b9 163 console.printf("Advertising timeout\r\n");
silviaChen 16:d1682a3e93f5 164 break;
silviaChen 16:d1682a3e93f5 165 case Gap::TIMEOUT_SRC_SECURITY_REQUEST:
silviaChen 18:4f5b317c04b9 166 console.printf("Security request timeout\r\n");
silviaChen 16:d1682a3e93f5 167 break;
silviaChen 16:d1682a3e93f5 168 case Gap::TIMEOUT_SRC_SCAN:
silviaChen 18:4f5b317c04b9 169 console.printf("Scanning timeout\r\n");
silviaChen 16:d1682a3e93f5 170 break;
silviaChen 16:d1682a3e93f5 171 case Gap::TIMEOUT_SRC_CONN:
silviaChen 18:4f5b317c04b9 172 console.printf("Connection timeout\r\n");
silviaChen 16:d1682a3e93f5 173 break;
silviaChen 16:d1682a3e93f5 174 }
silviaChen 16:d1682a3e93f5 175 //Silvia add
gillwei7 5:ee474e3133eb 176 }
gillwei7 5:ee474e3133eb 177
gillwei7 4:b52035367aee 178 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params)
gillwei7 0:5c195ab2f696 179 {
silviaChen 18:4f5b317c04b9 180 console.printf("Disconnected\r\n"); //Silvia add
gillwei7 0:5c195ab2f696 181 //console.printf("connState:%d\r\n",connState);
gillwei7 3:38ec8ad317f4 182 //Gap::GapState_t->connected = 0;
gillwei7 0:5c195ab2f696 183 connState = false;
gillwei7 0:5c195ab2f696 184 }
gillwei7 0:5c195ab2f696 185
gillwei7 7:33214585c606 186 void onDataWrittenCallback(const GattWriteCallbackParams *params)
gillwei7 7:33214585c606 187 {
gillwei7 14:397f6514bb2c 188 #if BLE_DEBUG
gillwei7 7:33214585c606 189 console.printf("onDataWritten\r\n");
gillwei7 7:33214585c606 190 #endif
gillwei7 7:33214585c606 191 // trigger Host GPIO interrupt
gillwei7 10:5f1fa331d07c 192 BLEWriteInt = !BLEWriteInt;
gillwei7 10:5f1fa331d07c 193 BLEWriteInt = !BLEWriteInt;
gillwei7 14:397f6514bb2c 194 #if BLE_DEBUG
gillwei7 7:33214585c606 195 console.printf("handle:%04X\r\n",params->handle);
gillwei7 7:33214585c606 196 console.printf("conn_handle:%04X,writeOp:%d,offset:%04X\r\n",params->connHandle,params->writeOp,params->offset);
gillwei7 7:33214585c606 197 #endif
gillwei7 12:a91455702763 198 console.printf("w%d,",params->writeOp);
gillwei7 7:33214585c606 199 const uint8_t* cpSerBaseUUID;
gillwei7 7:33214585c606 200 const uint8_t* cpCharBaseUUID;
gillwei7 12:a91455702763 201
gillwei7 7:33214585c606 202 // Find specific handle Characteristic
gillwei7 7:33214585c606 203 for ( int i = 0 ; i < service_count ; i++ ) {
gillwei7 7:33214585c606 204 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
gillwei7 7:33214585c606 205 GattAttribute& tempValueAttr = charAry[i][j]->getValueAttribute();
gillwei7 7:33214585c606 206 if (tempValueAttr.getHandle()==params->handle) {
gillwei7 14:397f6514bb2c 207 #if BLE_DEBUG
gillwei7 7:33214585c606 208 console.printf("ser_count,char_count:%d,%d\r\n",i,j);
gillwei7 5:ee474e3133eb 209 #endif
gillwei7 7:33214585c606 210 if (bufferService[i].ser_uuid.shortOrLong()==0)
gillwei7 7:33214585c606 211 console.printf("%04X",bufferService[i].ser_uuid.getShortUUID());
gillwei7 7:33214585c606 212 else {
gillwei7 7:33214585c606 213 cpSerBaseUUID = bufferService[i].ser_uuid.getBaseUUID();
gillwei7 7:33214585c606 214 for (int i=15; i>=0; i--) {
gillwei7 7:33214585c606 215 console.printf("%02X",cpSerBaseUUID[i]);
gillwei7 7:33214585c606 216 }
gillwei7 7:33214585c606 217 }
gillwei7 7:33214585c606 218 console.printf(",");
gillwei7 7:33214585c606 219 //console.printf("char_uuid:");
gillwei7 7:33214585c606 220 if (bufferService[i].bufferGattChar[j].char_uuid.shortOrLong()==0) // Short UUID
gillwei7 7:33214585c606 221 console.printf("%04X",bufferService[i].bufferGattChar[j].char_uuid.getShortUUID());
gillwei7 7:33214585c606 222 else { // Long UUID
gillwei7 7:33214585c606 223 cpCharBaseUUID = bufferService[i].bufferGattChar[j].char_uuid.getBaseUUID();
gillwei7 7:33214585c606 224 for (int i=15; i>=0; i--) {
gillwei7 7:33214585c606 225 console.printf("%02X",cpCharBaseUUID[i]);
gillwei7 7:33214585c606 226 }
gillwei7 7:33214585c606 227 }
gillwei7 7:33214585c606 228 console.printf(",");
gillwei7 14:397f6514bb2c 229 // update char value length
gillwei7 14:397f6514bb2c 230 bufferService[i].bufferGattChar[j].valueLength = params->len;
gillwei7 7:33214585c606 231 break;
gillwei7 7:33214585c606 232 }
gillwei7 7:33214585c606 233 }
gillwei7 7:33214585c606 234 }
gillwei7 7:33214585c606 235 console.printf("%d,",params->len);
gillwei7 7:33214585c606 236 for(int i=0; i<params->len; i++) {
gillwei7 7:33214585c606 237 console.printf("%02X",params->data[i]);
gillwei7 7:33214585c606 238 }
gillwei7 7:33214585c606 239 console.printf(";\r\n");
gillwei7 5:ee474e3133eb 240 }
gillwei7 0:5c195ab2f696 241
gillwei7 0:5c195ab2f696 242 static void cyntecPrintOk(void)
gillwei7 0:5c195ab2f696 243 {
gillwei7 3:38ec8ad317f4 244 console.printf("\r\nOK\r\n\r\n");
gillwei7 0:5c195ab2f696 245 }
gillwei7 0:5c195ab2f696 246
gillwei7 0:5c195ab2f696 247 static void cyntecPrintError(uint8_t errIdx)
gillwei7 0:5c195ab2f696 248 {
gillwei7 3:38ec8ad317f4 249 console.printf("\r\nERROR;");
gillwei7 3:38ec8ad317f4 250 console.printf(cyntecCommandErrorNames[errIdx]);
gillwei7 3:38ec8ad317f4 251 console.printf("\r\n\r\n");
gillwei7 3:38ec8ad317f4 252 }
gillwei7 3:38ec8ad317f4 253
gillwei7 0:5c195ab2f696 254 static void cynAdvertiseStartCommand(void)
gillwei7 0:5c195ab2f696 255 {
gillwei7 3:38ec8ad317f4 256 uint8_t argLen = 0;
gillwei7 3:38ec8ad317f4 257 uint8_t *arg;
gillwei7 3:38ec8ad317f4 258 uint16_t advInterval;
gillwei7 3:38ec8ad317f4 259 uint16_t advTimeout;
gillwei7 3:38ec8ad317f4 260
gillwei7 3:38ec8ad317f4 261 switch (cyntecGetCommandTokenCnt()) {
gillwei7 3:38ec8ad317f4 262 case 2:
gillwei7 3:38ec8ad317f4 263 advInterval = APP_ADV_INTERVAL;
gillwei7 3:38ec8ad317f4 264 advTimeout = APP_ADV_TIMEOUT_IN_SECONDS;
gillwei7 3:38ec8ad317f4 265 break;
gillwei7 3:38ec8ad317f4 266 case 3:
gillwei7 3:38ec8ad317f4 267 /* arg1 is adv interval parameter */
gillwei7 4:b52035367aee 268 arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 3:38ec8ad317f4 269 advInterval = cyntecAtoiUint16( arg, argLen );
gillwei7 3:38ec8ad317f4 270 advTimeout = APP_ADV_TIMEOUT_IN_SECONDS;
gillwei7 3:38ec8ad317f4 271 break;
gillwei7 3:38ec8ad317f4 272 case 4:
gillwei7 4:b52035367aee 273 arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 4:b52035367aee 274 advInterval = cyntecAtoiUint16( arg, argLen );
gillwei7 3:38ec8ad317f4 275 arg = cyntecGetCommandArgument(1,&argLen);
gillwei7 3:38ec8ad317f4 276 advTimeout = cyntecAtoiUint16( arg, argLen );
gillwei7 3:38ec8ad317f4 277 break;
gillwei7 3:38ec8ad317f4 278 default:
gillwei7 3:38ec8ad317f4 279 advInterval = APP_ADV_INTERVAL;
gillwei7 3:38ec8ad317f4 280 advTimeout = APP_ADV_TIMEOUT_IN_SECONDS;
gillwei7 3:38ec8ad317f4 281 break;
gillwei7 3:38ec8ad317f4 282 }
gillwei7 3:38ec8ad317f4 283
gillwei7 3:38ec8ad317f4 284 //if ( advInterval< APP_ADV_INTERVAL_MIN | advInterval> APP_ADV_INTERVAL_MAX | advTimeout < 1| advTimeout > BLE_GAP_ADV_TIMEOUT_LIMITED_MAX ) {
gillwei7 3:38ec8ad317f4 285 // cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
gillwei7 3:38ec8ad317f4 286 // return;
gillwei7 3:38ec8ad317f4 287 // }
gillwei7 14:397f6514bb2c 288 #if BLE_DEBUG
gillwei7 4:b52035367aee 289 console.printf("advInterval:%d,advTimeout:%d",advInterval,advTimeout);
gillwei7 4:b52035367aee 290 #endif
gillwei7 6:1243f9e584f4 291 uint8_t bleName[BLE_GAP_DEVNAME_MAX_LEN] = {"\0"};
gillwei7 7:33214585c606 292 uint16_t bleLen = BLE_GAP_DEVNAME_MAX_LEN - APP_ADV_DATA_OFFSET;
gillwei7 7:33214585c606 293 uint32_t err_code;
gillwei7 6:1243f9e584f4 294
gillwei7 7:33214585c606 295 err_code = sd_ble_gap_device_name_get(&bleName[APP_ADV_DATA_OFFSET], &bleLen);
gillwei7 14:397f6514bb2c 296 #if BLE_DEBUG
gillwei7 6:1243f9e584f4 297 console.printf("%08X,%s\r\n",err_code,bleName+APP_ADV_DATA_OFFSET);
gillwei7 6:1243f9e584f4 298 #endif
gillwei7 4:b52035367aee 299 deltaBLE.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
gillwei7 4:b52035367aee 300 //deltaBLE.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
gillwei7 6:1243f9e584f4 301 deltaBLE.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, bleName+APP_ADV_DATA_OFFSET, bleLen);
gillwei7 4:b52035367aee 302 deltaBLE.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
gillwei7 4:b52035367aee 303 deltaBLE.gap().setAdvertisingInterval(advInterval); /* minisecond. */
gillwei7 4:b52035367aee 304 deltaBLE.gap().setAdvertisingTimeout(advTimeout); /* second. */
gillwei7 4:b52035367aee 305 deltaBLE.gap().startAdvertising();
gillwei7 4:b52035367aee 306 cyntecPrintOk();
gillwei7 9:ff3ccba5dc16 307 //nrf_gpio_pin_set(ADVERTISING_LED_PIN_NO);
gillwei7 0:5c195ab2f696 308 }
gillwei7 0:5c195ab2f696 309
gillwei7 0:5c195ab2f696 310 /**@brief Function for stop advertising.
gillwei7 0:5c195ab2f696 311 */
gillwei7 0:5c195ab2f696 312 static void cynAdvertiseStopCommand(void)
gillwei7 0:5c195ab2f696 313 {
gillwei7 4:b52035367aee 314 deltaBLE.gap().stopAdvertising();
gillwei7 4:b52035367aee 315 cyntecPrintOk();
gillwei7 9:ff3ccba5dc16 316 //nrf_gpio_pin_clear(ADVERTISING_LED_PIN_NO);
gillwei7 0:5c195ab2f696 317 }
gillwei7 0:5c195ab2f696 318
silviaChen 16:d1682a3e93f5 319 //Silvia modify
gillwei7 0:5c195ab2f696 320 static void cynBLENameCommand(void)
gillwei7 0:5c195ab2f696 321 {
gillwei7 12:a91455702763 322 uint8_t nameLen = 0; // Name char number, max is TARGET_DEVNAME_LEN
gillwei7 12:a91455702763 323 uint8_t nameLenCharNum = 0; // Name length number is 1 or 2
gillwei7 12:a91455702763 324 uint8_t *nameLeng = cyntecGetCommandArgument(0,&nameLenCharNum);
gillwei7 12:a91455702763 325 nameLen = cyntecAtoi(nameLeng,nameLenCharNum);
gillwei7 12:a91455702763 326 #ifdef BLE_DEUG
gillwei7 12:a91455702763 327 console.printf("nameLenCharNum:%i\r\nOK;",nameLenCharNum);
gillwei7 12:a91455702763 328 console.printf("nameLen:%i\r\nOK;",nameLen);
gillwei7 12:a91455702763 329 #endif
gillwei7 12:a91455702763 330 uint8_t bleName[BLE_GAP_DEVNAME_MAX_LEN] = {"\0"};
gillwei7 12:a91455702763 331 uint16_t bleLen = BLE_GAP_DEVNAME_MAX_LEN - APP_ADV_DATA_OFFSET;
gillwei7 12:a91455702763 332 ble_gap_conn_sec_mode_t sec_mode;
gillwei7 12:a91455702763 333 uint32_t err_code;
gillwei7 12:a91455702763 334 uint8_t * argName2 = cyntecGetCommandTotalBuffer();
gillwei7 7:33214585c606 335
gillwei7 12:a91455702763 336 // Get name string
gillwei7 12:a91455702763 337 if (cyntecGetCommandTokenCnt() == 2) {
gillwei7 3:38ec8ad317f4 338 err_code = sd_ble_gap_device_name_get(&bleName[APP_ADV_DATA_OFFSET], &bleLen);
gillwei7 3:38ec8ad317f4 339 console.printf("\r\nOK;");
gillwei7 3:38ec8ad317f4 340 console.printf("%s",bleName+APP_ADV_DATA_OFFSET);
gillwei7 3:38ec8ad317f4 341 console.printf(";\r\n");
gillwei7 12:a91455702763 342 }
gillwei7 12:a91455702763 343 // Set name
gillwei7 12:a91455702763 344 if (cyntecGetCommandTokenCnt() >= 3) {
gillwei7 12:a91455702763 345 if (nameLen>TARGET_DEVNAME_LEN || nameLen <=0)
gillwei7 12:a91455702763 346 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
gillwei7 12:a91455702763 347 BLE_GAP_CONN_SEC_MODE_SET_OPEN(&sec_mode);
gillwei7 12:a91455702763 348 err_code = sd_ble_gap_device_name_set(&sec_mode,
gillwei7 12:a91455702763 349 (const uint8_t *) &argName2[11+nameLenCharNum],
gillwei7 12:a91455702763 350 (uint16_t) nameLen);//(uint16_t) (cyntecGetTotalIndex()-11-nameLenCharNum));
gillwei7 12:a91455702763 351 if (err_code == NRF_SUCCESS)
gillwei7 12:a91455702763 352 cyntecPrintOk();
gillwei7 12:a91455702763 353 else
gillwei7 12:a91455702763 354 cyntecPrintError(CYNTEC_CMD_ERR_CALL_FAIL);
gillwei7 12:a91455702763 355 #ifdef BLE_DEUG
gillwei7 12:a91455702763 356 console.printf("LengNum:%i,string:%s,index:%i\r\n",nameLenCharNum,(const uint8_t *) &argName2[11+nameLenCharNum],cyntecGetTotalIndex());
gillwei7 12:a91455702763 357 #endif
gillwei7 3:38ec8ad317f4 358 }
gillwei7 0:5c195ab2f696 359 }
gillwei7 12:a91455702763 360
gillwei7 0:5c195ab2f696 361 static void cynBLEInfoCommand(void)
gillwei7 0:5c195ab2f696 362 {
silviaChen 18:4f5b317c04b9 363 console.printf("\r\nOK;%s;%s\r\n\r\n", CLI_FWVERION, MODULE_NAME);
gillwei7 0:5c195ab2f696 364 }
silviaChen 18:4f5b317c04b9 365 //Silvia modify
gillwei7 0:5c195ab2f696 366
gillwei7 0:5c195ab2f696 367 /**@brief Set the radio's transmit power.
gillwei7 0:5c195ab2f696 368 *
gillwei7 0:5c195ab2f696 369 * @param[in] tx_power Radio transmit power in dBm (accepted values are -40, -30, -20, -16, -12, -8, -4, 0, and 4 dBm).
gillwei7 0:5c195ab2f696 370 *
gillwei7 0:5c195ab2f696 371 * @note -40 dBm will not actually give -40 dBm, but will instead be remapped to -30 dBm.
gillwei7 0:5c195ab2f696 372 */
gillwei7 0:5c195ab2f696 373 static void cynBLESetTxPowerCommand (void)
gillwei7 0:5c195ab2f696 374 {
gillwei7 4:b52035367aee 375 if (cyntecGetCommandTokenCnt() != 3) {
gillwei7 3:38ec8ad317f4 376 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 3:38ec8ad317f4 377 return;
gillwei7 3:38ec8ad317f4 378 }
gillwei7 4:b52035367aee 379 uint32_t err_code;
gillwei7 4:b52035367aee 380 uint8_t txLen=0;
gillwei7 4:b52035367aee 381 uint8_t *arg = cyntecGetCommandArgument(0,&txLen);
gillwei7 4:b52035367aee 382 const uint8_t NUM_TXPOW = 9;
gillwei7 4:b52035367aee 383 bool inputSwitch = false; // if find matched case in TxPow, assign true
gillwei7 4:b52035367aee 384
gillwei7 4:b52035367aee 385 int8_t validTxPow[NUM_TXPOW] = {-40, -30, -20, -16, -12, -8, -4, 0, 4};
gillwei7 4:b52035367aee 386 uint8_t i;
gillwei7 4:b52035367aee 387 int8_t setValue;
gillwei7 4:b52035367aee 388
gillwei7 4:b52035367aee 389 if ( arg != NULL ) {
gillwei7 4:b52035367aee 390 setValue = atoi((const char *)arg);
gillwei7 4:b52035367aee 391 for (i = 0; i < NUM_TXPOW; i++) {
gillwei7 4:b52035367aee 392 if (setValue == validTxPow[i]) {
gillwei7 4:b52035367aee 393 err_code = sd_ble_gap_tx_power_set(setValue);
gillwei7 6:1243f9e584f4 394 //APP_ERROR_CHECK(err_code);
gillwei7 4:b52035367aee 395 inputSwitch = true;
gillwei7 4:b52035367aee 396 break;
gillwei7 4:b52035367aee 397 }
gillwei7 4:b52035367aee 398 }
gillwei7 4:b52035367aee 399
gillwei7 4:b52035367aee 400 if ( inputSwitch )
gillwei7 4:b52035367aee 401 cyntecPrintOk();
gillwei7 4:b52035367aee 402 else
gillwei7 4:b52035367aee 403 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
gillwei7 4:b52035367aee 404
gillwei7 4:b52035367aee 405 }
gillwei7 4:b52035367aee 406 clearBuffer(); // clear the commandState.buffer
gillwei7 4:b52035367aee 407 return;
gillwei7 0:5c195ab2f696 408 }
gillwei7 0:5c195ab2f696 409
gillwei7 0:5c195ab2f696 410 static void cynBLEAddressCommand(void)
gillwei7 0:5c195ab2f696 411 {
gillwei7 3:38ec8ad317f4 412 if (cyntecGetCommandTokenCnt() == 3) {
gillwei7 3:38ec8ad317f4 413 uint8_t argLen = 0;
gillwei7 3:38ec8ad317f4 414 uint8_t *arg = cyntecGetCommandArgument(0, &argLen);
gillwei7 3:38ec8ad317f4 415 uint32_t err_code;
gillwei7 3:38ec8ad317f4 416 uint8_t addr,i;
gillwei7 3:38ec8ad317f4 417
gillwei7 3:38ec8ad317f4 418 /* should with "0x" + 12 len addr */
gillwei7 3:38ec8ad317f4 419 if (argLen == 14) {
gillwei7 3:38ec8ad317f4 420 if (arg[0] != '0' || arg[1] != 'x') {
gillwei7 3:38ec8ad317f4 421 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
gillwei7 3:38ec8ad317f4 422 return;
gillwei7 3:38ec8ad317f4 423 }
gillwei7 0:5c195ab2f696 424
gillwei7 3:38ec8ad317f4 425 m_peer_addr.addr_type = BLE_GAP_ADDR_TYPE_PUBLIC;
gillwei7 3:38ec8ad317f4 426
gillwei7 3:38ec8ad317f4 427 for ( i = 1 ; i < 7 ; i++) {
gillwei7 3:38ec8ad317f4 428 addr = cyntecArgToUint8(arg+2*i, 2);
gillwei7 3:38ec8ad317f4 429 /* 5 - (i-1) */
gillwei7 3:38ec8ad317f4 430 m_peer_addr.addr[6-i] = addr;
gillwei7 3:38ec8ad317f4 431 }
gillwei7 3:38ec8ad317f4 432
gillwei7 3:38ec8ad317f4 433 err_code = sd_ble_gap_address_set(BLE_GAP_ADDR_CYCLE_MODE_NONE, &m_peer_addr);
gillwei7 6:1243f9e584f4 434 //APP_ERROR_CHECK(err_code);
gillwei7 3:38ec8ad317f4 435
gillwei7 3:38ec8ad317f4 436 } else { //argLen != 14
gillwei7 3:38ec8ad317f4 437 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
gillwei7 3:38ec8ad317f4 438 return;
gillwei7 3:38ec8ad317f4 439 }
gillwei7 0:5c195ab2f696 440
gillwei7 14:397f6514bb2c 441 //#if BLE_DEBUG
gillwei7 0:5c195ab2f696 442 // uint8_t buf2[20];
gillwei7 0:5c195ab2f696 443 // console.printf("\r\nSet BLE Address: ");
gillwei7 3:38ec8ad317f4 444 // sprintf((char *)&buf2[0],(const char *)"[%02X %02X %02X %02X %02X %02X]",
gillwei7 3:38ec8ad317f4 445 // m_peer_addr.addr[0], m_peer_addr.addr[1], m_peer_addr.addr[2],
gillwei7 3:38ec8ad317f4 446 // m_peer_addr.addr[3], m_peer_addr.addr[4], m_peer_addr.addr[5]);
gillwei7 0:5c195ab2f696 447 // console.printf(buf2);
gillwei7 3:38ec8ad317f4 448 //#endif
gillwei7 3:38ec8ad317f4 449
gillwei7 3:38ec8ad317f4 450 cyntecPrintOk();
gillwei7 3:38ec8ad317f4 451 } else if (cyntecGetCommandTokenCnt() == 2) {
gillwei7 0:5c195ab2f696 452
gillwei7 3:38ec8ad317f4 453 uint32_t err_code;
gillwei7 3:38ec8ad317f4 454 err_code = sd_ble_gap_address_get(&m_peer_addr);
gillwei7 6:1243f9e584f4 455 //APP_ERROR_CHECK(err_code);
gillwei7 3:38ec8ad317f4 456
silviaChen 16:d1682a3e93f5 457 // cyntecPrintOk();
gillwei7 3:38ec8ad317f4 458
silviaChen 16:d1682a3e93f5 459 console.printf("OK;[%02X %02X %02X %02X %02X %02X];\r\n",
gillwei7 3:38ec8ad317f4 460 m_peer_addr.addr[5], m_peer_addr.addr[4], m_peer_addr.addr[3],
gillwei7 3:38ec8ad317f4 461 m_peer_addr.addr[2], m_peer_addr.addr[1], m_peer_addr.addr[0]);
gillwei7 3:38ec8ad317f4 462 } else { //cyntecGetCommandTokenCnt() not equal to 2 or 3
gillwei7 3:38ec8ad317f4 463 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 3:38ec8ad317f4 464 }
gillwei7 3:38ec8ad317f4 465 return;
gillwei7 0:5c195ab2f696 466 }
gillwei7 0:5c195ab2f696 467
gillwei7 4:b52035367aee 468 static uint32_t adv_report_parse(uint8_t type, data_t * p_advdata, data_t * p_typedata)
gillwei7 4:b52035367aee 469 {
gillwei7 4:b52035367aee 470 uint32_t index = 0;
gillwei7 4:b52035367aee 471 const uint8_t * p_data;
gillwei7 4:b52035367aee 472
gillwei7 4:b52035367aee 473 p_data = p_advdata->p_data;
gillwei7 4:b52035367aee 474
gillwei7 4:b52035367aee 475 while (index < p_advdata->data_len) {
gillwei7 4:b52035367aee 476 uint8_t field_length = p_data[index];
gillwei7 4:b52035367aee 477 uint8_t field_type = p_data[index+1];
gillwei7 4:b52035367aee 478
gillwei7 4:b52035367aee 479 if (field_type == type) {
gillwei7 4:b52035367aee 480 p_typedata->p_data = &p_data[index+2];
gillwei7 4:b52035367aee 481 p_typedata->data_len = field_length-1;
gillwei7 4:b52035367aee 482 return NRF_SUCCESS;
gillwei7 4:b52035367aee 483 }
gillwei7 4:b52035367aee 484 index += field_length+1;
gillwei7 4:b52035367aee 485 }
gillwei7 4:b52035367aee 486 return NRF_ERROR_NOT_FOUND;
gillwei7 4:b52035367aee 487 }
gillwei7 4:b52035367aee 488
gillwei7 4:b52035367aee 489 void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params)
gillwei7 4:b52035367aee 490 {
silviaChen 16:d1682a3e93f5 491 //Silvia modify
gillwei7 4:b52035367aee 492 Gap::Address_t newAddr[6];
gillwei7 4:b52035367aee 493 memcpy(newAddr,params->peerAddr,6);
silviaChen 16:d1682a3e93f5 494
silviaChen 16:d1682a3e93f5 495 if (conn_action == true) {
silviaChen 16:d1682a3e93f5 496 conn_action = false;
silviaChen 16:d1682a3e93f5 497
silviaChen 16:d1682a3e93f5 498 if (memcmp(targetAddr,newAddr,6)==0) {
silviaChen 18:4f5b317c04b9 499 deltaBLE.gap().connect(params->peerAddr, Gap::ADDR_TYPE_PUBLIC, NULL, NULL); //0920 Silvia change address type
silviaChen 16:d1682a3e93f5 500 return;
gillwei7 4:b52035367aee 501 }
silviaChen 16:d1682a3e93f5 502 } else {
silviaChen 16:d1682a3e93f5 503 bool flagRepeat=false;
silviaChen 16:d1682a3e93f5 504
silviaChen 16:d1682a3e93f5 505 for(int i=0; i<BLE_MAX_ADDRESS_NUMBER; i++) {
silviaChen 16:d1682a3e93f5 506 if (memcmp(newAddr,saveAddr[i],6)==0) {
silviaChen 16:d1682a3e93f5 507 #if BLE_DEBUG
silviaChen 16:d1682a3e93f5 508 console.printf("Repeated\r\n");
silviaChen 16:d1682a3e93f5 509 #endif
silviaChen 16:d1682a3e93f5 510 flagRepeat = true;
silviaChen 16:d1682a3e93f5 511 //return;
silviaChen 16:d1682a3e93f5 512 }
silviaChen 16:d1682a3e93f5 513 }
gillwei7 4:b52035367aee 514
silviaChen 16:d1682a3e93f5 515 #if BLE_DEBUG
silviaChen 16:d1682a3e93f5 516 console.printf("addr cmp result :%i\r\n",memcmp(newAddr,params->peerAddr,6));
silviaChen 16:d1682a3e93f5 517 console.printf("ADV data:%X,%i\r\n",&(params->advertisingData),params->advertisingDataLen);
silviaChen 16:d1682a3e93f5 518 #endif
silviaChen 16:d1682a3e93f5 519 data_t adv_data;
silviaChen 16:d1682a3e93f5 520 data_t type_data;
silviaChen 16:d1682a3e93f5 521 //Initialize advertisement report for parsing.
silviaChen 16:d1682a3e93f5 522 adv_data.p_data = params->advertisingData;
silviaChen 16:d1682a3e93f5 523 adv_data.data_len = params->advertisingDataLen;
silviaChen 16:d1682a3e93f5 524 // Parsing Device Name
silviaChen 16:d1682a3e93f5 525 uint32_t err_code = adv_report_parse(BLE_GAP_AD_TYPE_COMPLETE_LOCAL_NAME,
silviaChen 16:d1682a3e93f5 526 &adv_data,
silviaChen 16:d1682a3e93f5 527 &type_data);
silviaChen 16:d1682a3e93f5 528 #if BLE_DEBUG
silviaChen 16:d1682a3e93f5 529 console.printf("error code:%X\r\n",err_code);
silviaChen 16:d1682a3e93f5 530 console.printf("type_data.data_len:%i\r\n",type_data.data_len);
silviaChen 16:d1682a3e93f5 531 #endif
silviaChen 16:d1682a3e93f5 532 if (flagRepeat == false) {
silviaChen 16:d1682a3e93f5 533 if (err_code == 0) {
silviaChen 16:d1682a3e93f5 534 for (int i=0; i<type_data.data_len; i++) {
silviaChen 16:d1682a3e93f5 535 console.printf("%c",type_data.p_data[i]);
silviaChen 16:d1682a3e93f5 536 }
silviaChen 16:d1682a3e93f5 537 //console.printf("\r\n");
silviaChen 16:d1682a3e93f5 538 }
silviaChen 16:d1682a3e93f5 539 console.printf(",ADV,[%02X %02X %02X %02X %02X %02X],%d,%u\r\n",params->peerAddr[5], params->peerAddr[4], params->peerAddr[3],
silviaChen 16:d1682a3e93f5 540 params->peerAddr[2], params->peerAddr[1], params->peerAddr[0],params->rssi,params->type);
silviaChen 16:d1682a3e93f5 541 memcpy(saveAddr[bleDevInd],params->peerAddr,6);
silviaChen 16:d1682a3e93f5 542 bleDevInd++;
silviaChen 16:d1682a3e93f5 543 }
gillwei7 4:b52035367aee 544 }
gillwei7 4:b52035367aee 545
gillwei7 4:b52035367aee 546 /*
gillwei7 4:b52035367aee 547 Check short name, not implemented
gillwei7 4:b52035367aee 548 */
gillwei7 4:b52035367aee 549 //else
gillwei7 4:b52035367aee 550 // {
gillwei7 4:b52035367aee 551 // uint32_t err_code_2 = adv_report_parse(BLE_GAP_AD_TYPE_SHORT_LOCAL_NAME,
gillwei7 4:b52035367aee 552 // &adv_data,
gillwei7 4:b52035367aee 553 // &type_data);
gillwei7 4:b52035367aee 554 // console.printf("error code:%X\r\n",err_code_2);
gillwei7 4:b52035367aee 555 // console.printf("%i\r\n",type_data.data_len);
gillwei7 4:b52035367aee 556 // console.printf("%s\r\n",type_data.p_data);
gillwei7 4:b52035367aee 557 //
gillwei7 4:b52035367aee 558 // }
gillwei7 4:b52035367aee 559 }
gillwei7 4:b52035367aee 560
gillwei7 3:38ec8ad317f4 561
gillwei7 3:38ec8ad317f4 562 /**@brief Function to start scanning.
gillwei7 0:5c195ab2f696 563 */
gillwei7 0:5c195ab2f696 564 static void scan_start(void)
gillwei7 0:5c195ab2f696 565 {
silviaChen 16:d1682a3e93f5 566 memset(saveAddr,0,sizeof(saveAddr)); //Silvia add, Clear saving address set
gillwei7 3:38ec8ad317f4 567 deltaBLE.gap().startScan(advertisementCallback);
gillwei7 3:38ec8ad317f4 568 //APP_ERROR_CHECK(err_code);
gillwei7 0:5c195ab2f696 569 }
gillwei7 0:5c195ab2f696 570
gillwei7 0:5c195ab2f696 571 static void scan_stop(void)
gillwei7 0:5c195ab2f696 572 {
gillwei7 3:38ec8ad317f4 573 deltaBLE.stopScan();
gillwei7 3:38ec8ad317f4 574 //APP_ERROR_CHECK(err_code);
gillwei7 0:5c195ab2f696 575 }
gillwei7 0:5c195ab2f696 576
gillwei7 3:38ec8ad317f4 577 // gill 20150916 modify
gillwei7 0:5c195ab2f696 578 static void cynBLEScanCommand(void)
gillwei7 0:5c195ab2f696 579 {
gillwei7 3:38ec8ad317f4 580 uint16_t setInterval = DEFAULT_SCAN_INTERVAL;
gillwei7 3:38ec8ad317f4 581 uint16_t setWindow = DEFAULT_SCAN_WINDOW;
gillwei7 3:38ec8ad317f4 582 uint16_t setTimeout = DEFAULT_SCAN_TIMEOUT;
gillwei7 4:b52035367aee 583 if (cyntecGetCommandTokenCnt()!= 2 & cyntecGetCommandTokenCnt()!= 5) {
gillwei7 4:b52035367aee 584 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 4:b52035367aee 585 return;
gillwei7 4:b52035367aee 586 }
gillwei7 7:33214585c606 587 // If user input scan parameters, overwrite the default value
gillwei7 4:b52035367aee 588 if (cyntecGetCommandTokenCnt()== 5) {
gillwei7 4:b52035367aee 589 uint8_t argLen = 0;
gillwei7 4:b52035367aee 590 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 4:b52035367aee 591 setInterval = cyntecAtoiUint16( arg, argLen );
gillwei7 4:b52035367aee 592 arg = cyntecGetCommandArgument(1,&argLen);
gillwei7 4:b52035367aee 593 setWindow = cyntecAtoiUint16( arg, argLen );
gillwei7 4:b52035367aee 594 arg = cyntecGetCommandArgument(2,&argLen);
gillwei7 4:b52035367aee 595 setTimeout = cyntecAtoiUint16( arg, argLen );
gillwei7 4:b52035367aee 596 }
gillwei7 14:397f6514bb2c 597 #if BLE_DEBUG
gillwei7 4:b52035367aee 598 console.printf("Interval:%d,Window:%d,timeout:%d\r\n",setInterval,setWindow,setTimeout);
gillwei7 3:38ec8ad317f4 599 #endif
silviaChen 16:d1682a3e93f5 600 // memset(saveAddr,0,sizeof(saveAddr)); // Clear saving address set
gillwei7 4:b52035367aee 601 //deltaBLE.gap().setScanParams(setInterval,setWindow,setTimeout,false);
gillwei7 4:b52035367aee 602 deltaBLE.gap().setScanInterval(setInterval);
gillwei7 4:b52035367aee 603 deltaBLE.gap().setScanWindow(setWindow);
gillwei7 4:b52035367aee 604 deltaBLE.gap().setScanTimeout(setTimeout);
gillwei7 5:ee474e3133eb 605 console.printf("Start Scan\r\n");
gillwei7 3:38ec8ad317f4 606 scan_start();
gillwei7 4:b52035367aee 607
gillwei7 3:38ec8ad317f4 608 }
gillwei7 3:38ec8ad317f4 609
gillwei7 3:38ec8ad317f4 610 static void cynBLEScanStopCommand(void)
gillwei7 3:38ec8ad317f4 611 {
gillwei7 4:b52035367aee 612 console.printf("\r\nStop Scanning\r\n");
gillwei7 3:38ec8ad317f4 613 scan_stop();
gillwei7 0:5c195ab2f696 614 }
gillwei7 0:5c195ab2f696 615
gillwei7 4:b52035367aee 616 static void cynBLEConnectCommand(void)
gillwei7 4:b52035367aee 617 {
silviaChen 16:d1682a3e93f5 618 //Silvia modify for specific address
gillwei7 4:b52035367aee 619 if (cyntecGetCommandTokenCnt() != 3) {
gillwei7 4:b52035367aee 620 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 4:b52035367aee 621 return;
gillwei7 4:b52035367aee 622 }
silviaChen 16:d1682a3e93f5 623 uint8_t argLen = 0;
silviaChen 16:d1682a3e93f5 624 uint8_t *arg = cyntecGetCommandArgument(0, &argLen);
silviaChen 16:d1682a3e93f5 625 ble_error_t err_code;
silviaChen 16:d1682a3e93f5 626 uint8_t addr,i;
gillwei7 4:b52035367aee 627
silviaChen 16:d1682a3e93f5 628 /* should with "0x" + 12 len addr */
silviaChen 16:d1682a3e93f5 629 if (argLen == 14) {
silviaChen 16:d1682a3e93f5 630 if (arg[0] != '0' || arg[1] != 'x') {
silviaChen 16:d1682a3e93f5 631 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
silviaChen 16:d1682a3e93f5 632 return;
silviaChen 16:d1682a3e93f5 633 }
silviaChen 16:d1682a3e93f5 634 memset(targetAddr,0,sizeof(targetAddr));
gillwei7 4:b52035367aee 635
silviaChen 16:d1682a3e93f5 636 for ( i = 1 ; i < 7 ; i++) {
silviaChen 16:d1682a3e93f5 637 addr = cyntecArgToUint8(arg+2*i, 2);
silviaChen 16:d1682a3e93f5 638 /* 5 - (i-1) */
silviaChen 16:d1682a3e93f5 639 targetAddr[6-i] = addr;
silviaChen 16:d1682a3e93f5 640 }
silviaChen 16:d1682a3e93f5 641
silviaChen 16:d1682a3e93f5 642 for(int i=0; i<BLE_MAX_ADDRESS_NUMBER; i++) {
silviaChen 16:d1682a3e93f5 643 if (memcmp(targetAddr,saveAddr[i],6)==0) {
silviaChen 18:4f5b317c04b9 644 err_code = deltaBLE.gap().connect(targetAddr, Gap::ADDR_TYPE_PUBLIC, NULL, NULL); //0920 Silvia change address type
silviaChen 16:d1682a3e93f5 645
silviaChen 16:d1682a3e93f5 646 if (err_code != 0) {
silviaChen 18:4f5b317c04b9 647 console.printf("Error:%d\r\n",err_code);
silviaChen 16:d1682a3e93f5 648 } else {
silviaChen 16:d1682a3e93f5 649 cyntecPrintOk();
silviaChen 16:d1682a3e93f5 650 }
silviaChen 16:d1682a3e93f5 651
silviaChen 16:d1682a3e93f5 652 return;
silviaChen 16:d1682a3e93f5 653 }
silviaChen 16:d1682a3e93f5 654 }
silviaChen 16:d1682a3e93f5 655
silviaChen 16:d1682a3e93f5 656 conn_action = true;
silviaChen 16:d1682a3e93f5 657 scan_start();
silviaChen 16:d1682a3e93f5 658 } else { //argLen != 14
silviaChen 16:d1682a3e93f5 659 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
silviaChen 16:d1682a3e93f5 660 return;
silviaChen 16:d1682a3e93f5 661 }
silviaChen 16:d1682a3e93f5 662
silviaChen 16:d1682a3e93f5 663 //if (cyntecGetCommandTokenCnt() != 3) {
silviaChen 16:d1682a3e93f5 664 // cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
silviaChen 16:d1682a3e93f5 665 // return;
silviaChen 16:d1682a3e93f5 666 // }
silviaChen 16:d1682a3e93f5 667 //
silviaChen 16:d1682a3e93f5 668 // uint8_t devNameLen = 0;
silviaChen 16:d1682a3e93f5 669 // uint8_t *argDevName = cyntecGetCommandArgument(0, &devNameLen);
silviaChen 16:d1682a3e93f5 670 //
silviaChen 16:d1682a3e93f5 671 // //if ( argDevName != NULL ) {
silviaChen 16:d1682a3e93f5 672 //// uint8_t i;
silviaChen 16:d1682a3e93f5 673 //// for (i = 0; i < devNameLen; i++) {
silviaChen 16:d1682a3e93f5 674 //// targetDevName[i] = argDevName[i];
silviaChen 16:d1682a3e93f5 675 //// }
silviaChen 16:d1682a3e93f5 676 //// if (i < devNameLen)
silviaChen 16:d1682a3e93f5 677 //// targetDevName[i] = '\0';
silviaChen 16:d1682a3e93f5 678 //// }
silviaChen 16:d1682a3e93f5 679 //
silviaChen 16:d1682a3e93f5 680 // memset( targetDevName , 0, TARGET_DEVNAME_LEN);
silviaChen 16:d1682a3e93f5 681 // memcpy( targetDevName, argDevName, devNameLen);
silviaChen 16:d1682a3e93f5 682 //#if BLE_DEBUG
silviaChen 16:d1682a3e93f5 683 // console.printf("Search for device name:%s\r\n",argDevName);
silviaChen 16:d1682a3e93f5 684 // console.printf("Target:%s\r\n",targetDevName);
silviaChen 16:d1682a3e93f5 685 //#endif
silviaChen 16:d1682a3e93f5 686 // conn_action = true;
silviaChen 16:d1682a3e93f5 687 // scan_start();
gillwei7 4:b52035367aee 688
gillwei7 4:b52035367aee 689 }
gillwei7 3:38ec8ad317f4 690
gillwei7 0:5c195ab2f696 691
gillwei7 0:5c195ab2f696 692 static void cynBLEDisconnectCommand(void)
gillwei7 0:5c195ab2f696 693 {
gillwei7 4:b52035367aee 694 ble_error_t err_code;
gillwei7 4:b52035367aee 695 err_code = deltaBLE.gap().disconnect(Gap::REMOTE_USER_TERMINATED_CONNECTION);
gillwei7 4:b52035367aee 696 //err_code = sd_ble_gap_disconnect(test_conn_handle, BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
gillwei7 4:b52035367aee 697 //err_code = sd_ble_gap_connect_cancel(); // No function defined currently
gillwei7 14:397f6514bb2c 698 #if BLE_DEBUG
gillwei7 4:b52035367aee 699 console.printf("Error:%d\r\n",err_code);
gillwei7 4:b52035367aee 700 #endif
gillwei7 4:b52035367aee 701 cyntecPrintOk();
gillwei7 0:5c195ab2f696 702 }
gillwei7 0:5c195ab2f696 703
gillwei7 9:ff3ccba5dc16 704 //uint8_t isValidGPIO(uint8_t num)
gillwei7 9:ff3ccba5dc16 705 //{
gillwei7 9:ff3ccba5dc16 706 // uint8_t cfgPin[] = {0,4,5,6,7,13,21,23,24,25,29,30,31};
gillwei7 9:ff3ccba5dc16 707 // uint8_t i;
gillwei7 9:ff3ccba5dc16 708 //
gillwei7 9:ff3ccba5dc16 709 // for ( i = 0; i < sizeof(cfgPin) ; i++ ) {
gillwei7 9:ff3ccba5dc16 710 // if ( num == cfgPin[i] )
gillwei7 9:ff3ccba5dc16 711 // return 1;
gillwei7 9:ff3ccba5dc16 712 // }
gillwei7 9:ff3ccba5dc16 713 //
gillwei7 9:ff3ccba5dc16 714 // return 0;
gillwei7 9:ff3ccba5dc16 715 //}
gillwei7 0:5c195ab2f696 716
gillwei7 0:5c195ab2f696 717 static void cynBLESystemOffCommand(void)
gillwei7 0:5c195ab2f696 718 {
gillwei7 3:38ec8ad317f4 719 if (cyntecGetCommandTokenCnt() == 3) {
gillwei7 3:38ec8ad317f4 720 uint8_t argLen = 0;
gillwei7 3:38ec8ad317f4 721 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 3:38ec8ad317f4 722 uint8_t gpioNum = cyntecAtoi( arg, argLen );
gillwei7 3:38ec8ad317f4 723 // Can only use 0,1,2,3,4,5,6,7,13,16,17,23,24,25,29
gillwei7 3:38ec8ad317f4 724 if (!isValidGPIO(gpioNum)) {
gillwei7 3:38ec8ad317f4 725 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
gillwei7 3:38ec8ad317f4 726 return;
gillwei7 3:38ec8ad317f4 727 }
gillwei7 3:38ec8ad317f4 728 nrf_gpio_cfg_sense_input(gpioNum,
gillwei7 3:38ec8ad317f4 729 NRF_GPIO_PIN_PULLUP,
gillwei7 3:38ec8ad317f4 730 NRF_GPIO_PIN_SENSE_LOW);
gillwei7 3:38ec8ad317f4 731 cyntecPrintOk();
gillwei7 3:38ec8ad317f4 732 } else if (cyntecGetCommandTokenCnt() == 2) {
gillwei7 3:38ec8ad317f4 733 /* default wake up pin is uart Rx pin */
gillwei7 3:38ec8ad317f4 734 nrf_gpio_cfg_sense_input(RX_PIN_NUMBER,
gillwei7 3:38ec8ad317f4 735 NRF_GPIO_PIN_PULLUP,
gillwei7 3:38ec8ad317f4 736 NRF_GPIO_PIN_SENSE_LOW);
gillwei7 3:38ec8ad317f4 737 cyntecPrintOk();
gillwei7 3:38ec8ad317f4 738 } else {
gillwei7 3:38ec8ad317f4 739 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 12:a91455702763 740 return;
gillwei7 3:38ec8ad317f4 741 }
gillwei7 3:38ec8ad317f4 742 sd_power_system_off();
gillwei7 0:5c195ab2f696 743 }
gillwei7 0:5c195ab2f696 744
gillwei7 0:5c195ab2f696 745 static void cynBLEGPIOCommand(void)
gillwei7 0:5c195ab2f696 746 {
gillwei7 3:38ec8ad317f4 747
gillwei7 3:38ec8ad317f4 748 if (cyntecGetCommandTokenCnt() == 4) {
gillwei7 3:38ec8ad317f4 749 uint8_t argLen = 0;
gillwei7 3:38ec8ad317f4 750 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 3:38ec8ad317f4 751 uint8_t gpioNum = cyntecAtoi( arg, argLen );
gillwei7 3:38ec8ad317f4 752
gillwei7 3:38ec8ad317f4 753 if (!isValidGPIO(gpioNum)) {
gillwei7 3:38ec8ad317f4 754 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
gillwei7 3:38ec8ad317f4 755 return;
gillwei7 3:38ec8ad317f4 756 }
gillwei7 3:38ec8ad317f4 757
gillwei7 3:38ec8ad317f4 758 /* arg2 is set or clear */
gillwei7 3:38ec8ad317f4 759 uint8_t *action = cyntecGetCommandArgument(1,&argLen);
gillwei7 3:38ec8ad317f4 760
gillwei7 3:38ec8ad317f4 761 if ( cyntecStrCmp(action,(unsigned char *)"set",argLen) == 1 ) {
gillwei7 3:38ec8ad317f4 762 nrf_gpio_cfg_output(gpioNum);
gillwei7 3:38ec8ad317f4 763 nrf_gpio_pin_set(gpioNum);
gillwei7 3:38ec8ad317f4 764 cyntecPrintOk();
gillwei7 3:38ec8ad317f4 765 } else if ( cyntecStrCmp(action,(unsigned char *)"clear",argLen) == 1 ) {
gillwei7 3:38ec8ad317f4 766 nrf_gpio_cfg_output(gpioNum);
gillwei7 3:38ec8ad317f4 767 nrf_gpio_pin_clear(gpioNum);
gillwei7 3:38ec8ad317f4 768 cyntecPrintOk();
gillwei7 3:38ec8ad317f4 769 } else {
gillwei7 3:38ec8ad317f4 770 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
gillwei7 3:38ec8ad317f4 771 }
gillwei7 3:38ec8ad317f4 772 } else {
gillwei7 3:38ec8ad317f4 773 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 3:38ec8ad317f4 774 }
gillwei7 0:5c195ab2f696 775 }
gillwei7 0:5c195ab2f696 776
gillwei7 0:5c195ab2f696 777 static void cynResetCommand(void)
gillwei7 0:5c195ab2f696 778 {
gillwei7 3:38ec8ad317f4 779 cyntecPrintOk();
gillwei7 3:38ec8ad317f4 780 // On assert, the system can only recover with a reset.
gillwei7 3:38ec8ad317f4 781 NVIC_SystemReset();
gillwei7 0:5c195ab2f696 782 }
gillwei7 0:5c195ab2f696 783
gillwei7 4:b52035367aee 784 void triggerRead(const GattReadCallbackParams *response)
gillwei7 4:b52035367aee 785 {
gillwei7 4:b52035367aee 786 //if (response->handle == ledCharacteristic.getValueHandle()) {
gillwei7 4:b52035367aee 787 #if DUMP_READ_DATA
gillwei7 4:b52035367aee 788 printf("triggerToggledWrite: handle %u, offset %u, len %u\r\n", response->handle, response->offset, response->len);
gillwei7 4:b52035367aee 789 for (unsigned index = 0; index < response->len; index++) {
gillwei7 4:b52035367aee 790 printf("%c[%02x]", response->data[index], response->data[index]);
gillwei7 4:b52035367aee 791 }
gillwei7 4:b52035367aee 792 printf("\r\n");
gillwei7 4:b52035367aee 793 #endif
gillwei7 4:b52035367aee 794 //
gillwei7 4:b52035367aee 795 // uint8_t toggledValue = response->data[0] ^ 0x1;
gillwei7 4:b52035367aee 796 // ledCharacteristic.write(1, &toggledValue);
gillwei7 4:b52035367aee 797 // }
gillwei7 4:b52035367aee 798 }
silviaChen 16:d1682a3e93f5 799
silviaChen 16:d1682a3e93f5 800 //Silvia modify
silviaChen 16:d1682a3e93f5 801 void centralReadCallback(const GattReadCallbackParams *response) {
silviaChen 16:d1682a3e93f5 802 // printf("centralReadCallback Handle: %d\r\n", response->handle);
silviaChen 16:d1682a3e93f5 803
silviaChen 16:d1682a3e93f5 804 for (unsigned index = 0; index < response->len; index++) {
silviaChen 18:4f5b317c04b9 805 console.printf("[%02x]", response->data[index]);
silviaChen 16:d1682a3e93f5 806 }
silviaChen 18:4f5b317c04b9 807 console.printf("\r\n");
silviaChen 16:d1682a3e93f5 808 }
silviaChen 16:d1682a3e93f5 809
silviaChen 16:d1682a3e93f5 810 void centralWriteCallback(const GattWriteCallbackParams *response) {
silviaChen 16:d1682a3e93f5 811 // printf("centralWriteCallback: %d\r\n", response->len);
silviaChen 16:d1682a3e93f5 812
silviaChen 16:d1682a3e93f5 813 for (unsigned index = 0; index < response->len; index++) {
silviaChen 18:4f5b317c04b9 814 console.printf("[%02x]", response->data[index]);
silviaChen 16:d1682a3e93f5 815 }
silviaChen 18:4f5b317c04b9 816 console.printf("\r\n");
silviaChen 16:d1682a3e93f5 817 }
silviaChen 16:d1682a3e93f5 818
silviaChen 16:d1682a3e93f5 819 void centralHvxCallback(const GattHVXCallbackParams *response) {
silviaChen 16:d1682a3e93f5 820 // printf("centralHvxCallback handle %u, type %02x, len %u\r\n", response->handle, response->type, response->len);
silviaChen 16:d1682a3e93f5 821 for (unsigned index = 0; index < response->len; index++) {
silviaChen 18:4f5b317c04b9 822 console.printf("[%02x]", response->data[index]);
silviaChen 16:d1682a3e93f5 823 }
silviaChen 18:4f5b317c04b9 824 console.printf("\r\n");
silviaChen 16:d1682a3e93f5 825 }
silviaChen 16:d1682a3e93f5 826 //Silvia modify
silviaChen 16:d1682a3e93f5 827
gillwei7 14:397f6514bb2c 828 static void cynBLEUpdateDataCommand(void)
gillwei7 0:5c195ab2f696 829 {
gillwei7 14:397f6514bb2c 830 if (cyntecGetCommandTokenCnt() != 6) {
gillwei7 3:38ec8ad317f4 831 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 3:38ec8ad317f4 832 return;
gillwei7 4:b52035367aee 833 }
gillwei7 4:b52035367aee 834 UUID buf_ser_uuid ;
gillwei7 4:b52035367aee 835 uint8_t bufferUuidVs[16];
gillwei7 4:b52035367aee 836 UUID buf_char_uuid;
gillwei7 4:b52035367aee 837 uint8_t bufVal[MAX_VALUE_LENGTH] = {0};
gillwei7 4:b52035367aee 838 uint16_t valueLen = 0;
gillwei7 4:b52035367aee 839 bool readmatchFlag = false;
gillwei7 4:b52035367aee 840 uint8_t argLen = 0;
gillwei7 4:b52035367aee 841 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 3:38ec8ad317f4 842
gillwei7 4:b52035367aee 843 // Handle input parameter - Service UUID
gillwei7 4:b52035367aee 844 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
gillwei7 4:b52035367aee 845 buf_ser_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 4:b52035367aee 846 }
gillwei7 4:b52035367aee 847 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
gillwei7 4:b52035367aee 848 for (uint8_t i=0; i<16; i++) {
gillwei7 4:b52035367aee 849 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
gillwei7 3:38ec8ad317f4 850 }
gillwei7 4:b52035367aee 851 buf_ser_uuid.setupLong(bufferUuidVs);
gillwei7 4:b52035367aee 852 }
gillwei7 3:38ec8ad317f4 853
gillwei7 4:b52035367aee 854 // Handle input parameter - Characteristic UUID
gillwei7 4:b52035367aee 855 argLen = 0;
gillwei7 4:b52035367aee 856 arg = cyntecGetCommandArgument(1,&argLen);
gillwei7 4:b52035367aee 857 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
gillwei7 4:b52035367aee 858 buf_char_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 4:b52035367aee 859 }
gillwei7 4:b52035367aee 860 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
gillwei7 4:b52035367aee 861 for (uint8_t i=0; i<16; i++) {
gillwei7 4:b52035367aee 862 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
gillwei7 4:b52035367aee 863 }
gillwei7 4:b52035367aee 864 buf_char_uuid.setupLong(bufferUuidVs);
gillwei7 4:b52035367aee 865 }
gillwei7 14:397f6514bb2c 866 // Input Value Type
gillwei7 14:397f6514bb2c 867 arg = cyntecGetCommandArgument(2,&argLen);
gillwei7 14:397f6514bb2c 868 uint8_t type = *arg;
gillwei7 14:397f6514bb2c 869 //type = cyntecArgToUint8(arg,2);
gillwei7 14:397f6514bb2c 870 //printf("type:%d\r\n",type);
gillwei7 14:397f6514bb2c 871 if(type != '0' && type != '1') // Original Data
gillwei7 14:397f6514bb2c 872 {
gillwei7 14:397f6514bb2c 873 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
gillwei7 14:397f6514bb2c 874 }
gillwei7 14:397f6514bb2c 875
gillwei7 4:b52035367aee 876 // Input value
gillwei7 14:397f6514bb2c 877 arg = cyntecGetCommandArgument(3,&argLen);
gillwei7 14:397f6514bb2c 878 if(type == '0') // Original Data
gillwei7 14:397f6514bb2c 879 {
gillwei7 14:397f6514bb2c 880 valueLen = argLen;
gillwei7 14:397f6514bb2c 881 memcpy(bufVal,arg,argLen);
gillwei7 14:397f6514bb2c 882 }
gillwei7 14:397f6514bb2c 883 if(type == '1') // Char Data
gillwei7 14:397f6514bb2c 884 {
gillwei7 14:397f6514bb2c 885 valueLen = (argLen-2)/2; // uint8_t to uint16_t transform
gillwei7 14:397f6514bb2c 886 for (int i=0 ; i < valueLen; i++) {
gillwei7 14:397f6514bb2c 887 bufVal[i] = cyntecArgToUint8(arg+2+2*i,2);
gillwei7 14:397f6514bb2c 888 }
gillwei7 14:397f6514bb2c 889 }
gillwei7 14:397f6514bb2c 890 #if BLE_DEBUG
gillwei7 14:397f6514bb2c 891 printf("type:%i,bufVal:",type);
gillwei7 14:397f6514bb2c 892 printf("valueLength:%i\r\n",valueLen);
gillwei7 14:397f6514bb2c 893 for (int i=0 ; i < valueLen; i++) {
gillwei7 14:397f6514bb2c 894 printf("%02X ",bufVal[i]);
gillwei7 14:397f6514bb2c 895 }
gillwei7 14:397f6514bb2c 896 printf("\r\n");
gillwei7 14:397f6514bb2c 897 #endif
gillwei7 7:33214585c606 898
gillwei7 4:b52035367aee 899 for ( int i = 0 ; i < service_count ; i++ ) {
gillwei7 4:b52035367aee 900 if ( (bufferService[i].ser_uuid == buf_ser_uuid) & (readmatchFlag == false)) {
gillwei7 4:b52035367aee 901 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
gillwei7 4:b52035367aee 902 if (( bufferService[i].bufferGattChar[j].char_uuid == buf_char_uuid)& (readmatchFlag == false)) {
gillwei7 4:b52035367aee 903 GattAttribute& valueAttr = charAry[i][j]->getValueAttribute();
gillwei7 7:33214585c606 904 ble_error_t err;
gillwei7 7:33214585c606 905 if (!connState)
gillwei7 7:33214585c606 906 err = deltaBLE.gattServer().write(valueAttr.getHandle(),bufVal,valueLen,true);
gillwei7 4:b52035367aee 907 else
gillwei7 7:33214585c606 908 err = deltaBLE.gattServer().write(test_conn_handle,valueAttr.getHandle(),bufVal,valueLen,false);
gillwei7 14:397f6514bb2c 909
gillwei7 14:397f6514bb2c 910 // update valueLength
gillwei7 14:397f6514bb2c 911 bufferService[i].bufferGattChar[j].valueLength = valueLen;
gillwei7 5:ee474e3133eb 912
gillwei7 14:397f6514bb2c 913 #if BLE_DEBUG
gillwei7 7:33214585c606 914 console.printf("Write ERR:%i\r\n",err);
gillwei7 14:397f6514bb2c 915 printf("valueLen:%i\r\n",valueLen);
gillwei7 4:b52035367aee 916 #endif
gillwei7 7:33214585c606 917 console.printf("\r\nOK;");
gillwei7 7:33214585c606 918 for (uint16_t n=0; n<valueLen; n++) {
gillwei7 7:33214585c606 919 console.printf("%02X",bufVal[n]);
gillwei7 7:33214585c606 920 }
gillwei7 4:b52035367aee 921 console.printf("\r\n");
gillwei7 4:b52035367aee 922 readmatchFlag = true;
gillwei7 4:b52035367aee 923 return;
gillwei7 3:38ec8ad317f4 924 }
gillwei7 3:38ec8ad317f4 925 }
gillwei7 3:38ec8ad317f4 926 }
gillwei7 4:b52035367aee 927 }
gillwei7 4:b52035367aee 928 // no matched case, can not read
gillwei7 4:b52035367aee 929 if (readmatchFlag == false) {
gillwei7 4:b52035367aee 930 cyntecPrintError(CYNTEC_CMD_ERR_NO_MATCHED_ARGUMENT);
gillwei7 3:38ec8ad317f4 931 }
gillwei7 0:5c195ab2f696 932 }
gillwei7 0:5c195ab2f696 933
gillwei7 0:5c195ab2f696 934 static void cynBLEReadDataCommand(void)
gillwei7 3:38ec8ad317f4 935 {
gillwei7 14:397f6514bb2c 936 //#if BLE_DEBUG
gillwei7 14:397f6514bb2c 937 // printf("Saved Char:\r\n");
gillwei7 14:397f6514bb2c 938 // for (int i=0; i<service_count; i++) {
gillwei7 14:397f6514bb2c 939 // console.printf("ser_uuid:%04X",bufferService[service_count-1].ser_uuid.getShortUUID());
gillwei7 14:397f6514bb2c 940 // for (int j=0; j<CLI_CHAR_MAX_NUM; j++) {
gillwei7 14:397f6514bb2c 941 // printf(" %i,char_uuid%04X,",j,bufferService[service_count-1].bufferGattChar[char_count-1].char_uuid.getShortUUID());
gillwei7 14:397f6514bb2c 942 // printf("len%d,",bufferService[service_count-1].bufferGattChar[char_count-1].valueLength);
gillwei7 14:397f6514bb2c 943 // printf("val%02X;",bufferService[service_count-1].bufferGattChar[char_count-1].value[0]);
gillwei7 14:397f6514bb2c 944 // }
gillwei7 14:397f6514bb2c 945 // }
gillwei7 14:397f6514bb2c 946 // printf("\r\n");
gillwei7 14:397f6514bb2c 947 //#endif
gillwei7 3:38ec8ad317f4 948 if (cyntecGetCommandTokenCnt() != 4) {
gillwei7 3:38ec8ad317f4 949 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 4:b52035367aee 950 return;
gillwei7 4:b52035367aee 951 }
gillwei7 4:b52035367aee 952 UUID buf_ser_uuid ;
gillwei7 4:b52035367aee 953 uint8_t bufferUuidVs[16];
gillwei7 4:b52035367aee 954 UUID buf_char_uuid;
gillwei7 4:b52035367aee 955 uint8_t bufVal[MAX_VALUE_LENGTH] = {0};
gillwei7 4:b52035367aee 956 uint16_t valueLen=0;
gillwei7 14:397f6514bb2c 957 //uint16_t * valueLenPtr;
gillwei7 4:b52035367aee 958 bool readmatchFlag = false;
gillwei7 4:b52035367aee 959 uint8_t argLen = 0;
gillwei7 4:b52035367aee 960 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 3:38ec8ad317f4 961
gillwei7 4:b52035367aee 962 // Handle input parameter - Service UUID
gillwei7 4:b52035367aee 963 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
gillwei7 4:b52035367aee 964 buf_ser_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 4:b52035367aee 965 }
gillwei7 4:b52035367aee 966 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
gillwei7 4:b52035367aee 967 for (uint8_t i=0; i<16; i++) {
gillwei7 4:b52035367aee 968 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
gillwei7 3:38ec8ad317f4 969 }
gillwei7 4:b52035367aee 970 buf_ser_uuid.setupLong(bufferUuidVs);
gillwei7 4:b52035367aee 971 }
gillwei7 3:38ec8ad317f4 972
gillwei7 4:b52035367aee 973 // Handle input parameter - Characteristic UUID
gillwei7 4:b52035367aee 974 argLen = 0;
gillwei7 4:b52035367aee 975 arg = cyntecGetCommandArgument(1,&argLen);
gillwei7 4:b52035367aee 976 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
gillwei7 4:b52035367aee 977 buf_char_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 4:b52035367aee 978 }
gillwei7 4:b52035367aee 979 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
gillwei7 4:b52035367aee 980 for (uint8_t i=0; i<16; i++) {
gillwei7 4:b52035367aee 981 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
gillwei7 3:38ec8ad317f4 982 }
gillwei7 4:b52035367aee 983 buf_char_uuid.setupLong(bufferUuidVs);
gillwei7 4:b52035367aee 984 }
gillwei7 14:397f6514bb2c 985
gillwei7 4:b52035367aee 986 for ( int i = 0 ; i < service_count ; i++ ) {
gillwei7 4:b52035367aee 987 if ( (bufferService[i].ser_uuid == buf_ser_uuid) & (readmatchFlag == false)) {
gillwei7 4:b52035367aee 988 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
gillwei7 4:b52035367aee 989 if (( bufferService[i].bufferGattChar[j].char_uuid == buf_char_uuid)& (readmatchFlag == false)) {
gillwei7 4:b52035367aee 990 GattAttribute& valueAttr = charAry[i][j]->getValueAttribute();
gillwei7 14:397f6514bb2c 991 // valueLenPtr = valueAttr.getLengthPtr();
silviaChen 16:d1682a3e93f5 992 valueLen = bufferService[i].bufferGattChar[j].valueLength;
silviaChen 16:d1682a3e93f5 993 uint16_t * valueLenPtr = &bufferService[i].bufferGattChar[j].valueLength;
gillwei7 4:b52035367aee 994 ble_error_t err = deltaBLE.gattServer().read(valueAttr.getHandle(),bufVal,valueLenPtr);
gillwei7 14:397f6514bb2c 995 #if BLE_DEBUG
gillwei7 7:33214585c606 996 console.printf("Read ERR:%i\r\n",err);
silviaChen 16:d1682a3e93f5 997 printf("valueLen:%i\r\n",valueLen);
gillwei7 4:b52035367aee 998 #endif
gillwei7 7:33214585c606 999 console.printf("\r\nOK;");
gillwei7 4:b52035367aee 1000 console.printf("0x");
gillwei7 4:b52035367aee 1001 for (uint16_t n=0; n<valueLen; n++) {
gillwei7 4:b52035367aee 1002 console.printf("%02X",bufVal[n]);
gillwei7 3:38ec8ad317f4 1003 }
gillwei7 4:b52035367aee 1004 console.printf("\r\n");
gillwei7 4:b52035367aee 1005 readmatchFlag = true;
gillwei7 4:b52035367aee 1006 return;
gillwei7 3:38ec8ad317f4 1007 }
gillwei7 3:38ec8ad317f4 1008 }
gillwei7 3:38ec8ad317f4 1009 }
gillwei7 4:b52035367aee 1010
gillwei7 3:38ec8ad317f4 1011 }
gillwei7 4:b52035367aee 1012 // no matched case, can not read
gillwei7 4:b52035367aee 1013 if (readmatchFlag == false) {
gillwei7 4:b52035367aee 1014 cyntecPrintError(CYNTEC_CMD_ERR_NO_MATCHED_ARGUMENT);
gillwei7 4:b52035367aee 1015 }
gillwei7 0:5c195ab2f696 1016 }
gillwei7 0:5c195ab2f696 1017
gillwei7 0:5c195ab2f696 1018 static void cynGattCharCommand(void)
gillwei7 0:5c195ab2f696 1019 {
gillwei7 4:b52035367aee 1020 uint8_t i;
gillwei7 4:b52035367aee 1021 uint8_t valueLengthBuffer;
gillwei7 3:38ec8ad317f4 1022
gillwei7 3:38ec8ad317f4 1023 if (cyntecGetCommandTokenCnt() != 5) {
gillwei7 3:38ec8ad317f4 1024 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 3:38ec8ad317f4 1025 return;
gillwei7 4:b52035367aee 1026 }
silviaChen 18:4f5b317c04b9 1027
silviaChen 18:4f5b317c04b9 1028 //Silvia add
silviaChen 18:4f5b317c04b9 1029 if (service_count == 0) {
silviaChen 18:4f5b317c04b9 1030 cyntecPrintError(CYNTEC_CMD_ERR_INVALID_STATE_TO_PERFORM_OPERATION);
silviaChen 18:4f5b317c04b9 1031 return;
silviaChen 18:4f5b317c04b9 1032 }
silviaChen 18:4f5b317c04b9 1033 //Silvia add
gillwei7 7:33214585c606 1034
gillwei7 4:b52035367aee 1035 /* handle parameter - UUID */
gillwei7 4:b52035367aee 1036 /* Only support 16-bit or 128-bit UUID type */
gillwei7 4:b52035367aee 1037 uint8_t argLen = 0;
gillwei7 4:b52035367aee 1038 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 4:b52035367aee 1039 if (arg[0] != '0' || arg[1] != 'x' || (argLen != 6 && argLen != 34)) {
gillwei7 4:b52035367aee 1040 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
gillwei7 4:b52035367aee 1041 return;
gillwei7 4:b52035367aee 1042 }
gillwei7 4:b52035367aee 1043 /* len: 6 => 0xXXXX */
gillwei7 4:b52035367aee 1044 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
gillwei7 4:b52035367aee 1045 UUID::ShortUUIDBytes_t buffer_uuid_short;
gillwei7 4:b52035367aee 1046 buffer_uuid_short = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 4:b52035367aee 1047 UUID uuid_short(buffer_uuid_short);
gillwei7 4:b52035367aee 1048 bufferService[service_count-1].bufferGattChar[char_count].char_uuid = uuid_short;
gillwei7 4:b52035367aee 1049 }
gillwei7 4:b52035367aee 1050 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
gillwei7 4:b52035367aee 1051 // Initialize LongUUIDBytes_t, then use default constructor to setupLong(longUUID)
gillwei7 4:b52035367aee 1052 UUID::LongUUIDBytes_t buffer_uuid_vs;
gillwei7 4:b52035367aee 1053 for (uint8_t i=0; i<16; i++) {
gillwei7 4:b52035367aee 1054 buffer_uuid_vs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
gillwei7 3:38ec8ad317f4 1055 }
gillwei7 4:b52035367aee 1056 bufferService[service_count-1].bufferGattChar[char_count].char_uuid.setupLong(buffer_uuid_vs);
gillwei7 3:38ec8ad317f4 1057 }
gillwei7 3:38ec8ad317f4 1058
gillwei7 4:b52035367aee 1059 /* handle 3rd parameter - attribute mode */
gillwei7 4:b52035367aee 1060 argLen = 0;
gillwei7 4:b52035367aee 1061 arg = cyntecGetCommandArgument(1,&argLen);
gillwei7 4:b52035367aee 1062 if (arg[0] != '0' || arg[1] != 'x' ) {
gillwei7 4:b52035367aee 1063 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
gillwei7 4:b52035367aee 1064 return;
gillwei7 4:b52035367aee 1065 }
gillwei7 15:d627ee60bb78 1066 uint8_t prop = cyntecArgToUint8(arg+2,2);
gillwei7 0:5c195ab2f696 1067
gillwei7 4:b52035367aee 1068 /* handle 4th parameter - attribute value */
gillwei7 4:b52035367aee 1069 argLen = 0;
gillwei7 4:b52035367aee 1070 arg = cyntecGetCommandArgument(2,&argLen);
gillwei7 4:b52035367aee 1071 if (arg[0] != '0' || arg[1] != 'x' | argLen%2 != 0) {
gillwei7 4:b52035367aee 1072 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_SYNTAX_ERROR);
gillwei7 3:38ec8ad317f4 1073 return;
gillwei7 4:b52035367aee 1074 }
gillwei7 4:b52035367aee 1075 valueLengthBuffer = (argLen-2)/2;
gillwei7 4:b52035367aee 1076 memset(bufferService[service_count-1].bufferGattChar[char_count].value,0,MAX_VALUE_LENGTH);
gillwei7 4:b52035367aee 1077 for (i=0 ; i < (argLen-2)/2; i++) {
gillwei7 4:b52035367aee 1078 bufferService[service_count-1].bufferGattChar[char_count].value[i] = cyntecArgToUint8(arg+2*(i+1), 2);
gillwei7 4:b52035367aee 1079 //console.printf("%02X ",bufferService[service_count-1].bufferGattChar[char_count].value[i]);
gillwei7 3:38ec8ad317f4 1080 }
gillwei7 14:397f6514bb2c 1081 #if BLE_DEBUG
gillwei7 15:d627ee60bb78 1082 printf("prop:%02X\r\n",prop);
gillwei7 4:b52035367aee 1083 console.printf("valueLengthBuffer:%d\r\n",valueLengthBuffer);
gillwei7 4:b52035367aee 1084 console.printf("value:");
gillwei7 4:b52035367aee 1085 for (i=0 ; i < valueLengthBuffer; i++) {
gillwei7 4:b52035367aee 1086 console.printf("%02X",bufferService[service_count-1].bufferGattChar[char_count].value[i]);
gillwei7 4:b52035367aee 1087 }
gillwei7 4:b52035367aee 1088 #endif
gillwei7 4:b52035367aee 1089 bufferService[service_count-1].bufferGattChar[char_count].valueLength = valueLengthBuffer;
gillwei7 4:b52035367aee 1090 bufferService[service_count-1].bufferGattChar[char_count].props = prop;
gillwei7 4:b52035367aee 1091 //bufferService[service_count-1].bufferGattChar[char_count].char_value_handle = testHandle;
gillwei7 4:b52035367aee 1092 if (char_count>CLI_CHAR_MAX_NUM) {
gillwei7 4:b52035367aee 1093 cyntecPrintError(CYNTEC_CMD_ERR_CALL_FAIL);
gillwei7 14:397f6514bb2c 1094 #if BLE_DEBUG
gillwei7 7:33214585c606 1095 console.printf("Error: char_count>CLI_CHAR_MAX_NUM\r\n");
gillwei7 7:33214585c606 1096 #endif
gillwei7 4:b52035367aee 1097 return;
gillwei7 4:b52035367aee 1098 }
gillwei7 4:b52035367aee 1099 cyntecPrintOk();
gillwei7 4:b52035367aee 1100 char_count++;
gillwei7 0:5c195ab2f696 1101 }
gillwei7 0:5c195ab2f696 1102
gillwei7 4:b52035367aee 1103 static void cynRegServiceCommand(void)
gillwei7 3:38ec8ad317f4 1104 {
gillwei7 4:b52035367aee 1105 //GattCharacteristic *charAry[char_count];
gillwei7 4:b52035367aee 1106 //GattCharacteristic **charAry;
gillwei7 4:b52035367aee 1107 //charAry = new GattCharacteristic *[char_count];
gillwei7 14:397f6514bb2c 1108 #if BLE_DEBUG
gillwei7 4:b52035367aee 1109 console.printf("Current char_count:%d\r\n",char_count);
gillwei7 4:b52035367aee 1110 console.printf("Current service_count:%d\r\n",service_count);
gillwei7 4:b52035367aee 1111 #endif
gillwei7 4:b52035367aee 1112 for (uint8_t i=0; i<char_count; i++) {
gillwei7 4:b52035367aee 1113 charAry[service_count-1][i] = new GattCharacteristic (
gillwei7 4:b52035367aee 1114 bufferService[service_count-1].bufferGattChar[i].char_uuid,
gillwei7 4:b52035367aee 1115 bufferService[service_count-1].bufferGattChar[i].value,
gillwei7 4:b52035367aee 1116 bufferService[service_count-1].bufferGattChar[i].valueLength,
gillwei7 4:b52035367aee 1117 MAX_VALUE_LENGTH,
gillwei7 4:b52035367aee 1118 bufferService[service_count-1].bufferGattChar[i].props
gillwei7 4:b52035367aee 1119 );
gillwei7 4:b52035367aee 1120 }
gillwei7 4:b52035367aee 1121 GattService newService(bufferService[service_count-1].ser_uuid, charAry[service_count-1], char_count );
gillwei7 4:b52035367aee 1122 ble_error_t err_code;
gillwei7 4:b52035367aee 1123 err_code = deltaBLE.addService(newService);
gillwei7 7:33214585c606 1124 if (err_code != 0) {
gillwei7 14:397f6514bb2c 1125 #if BLE_DEBUG
gillwei7 7:33214585c606 1126 console.printf("addService error:%d\r\n",err_code);
gillwei7 4:b52035367aee 1127 #endif
gillwei7 7:33214585c606 1128 cyntecPrintError(CYNTEC_CMD_ERR_CALL_FAIL);
gillwei7 7:33214585c606 1129 } else
gillwei7 7:33214585c606 1130 cyntecPrintOk();
gillwei7 4:b52035367aee 1131 //char_count = 0; // already did in gattService
gillwei7 0:5c195ab2f696 1132 }
gillwei7 0:5c195ab2f696 1133
gillwei7 0:5c195ab2f696 1134 static void cynGattServiceCommand(void)
gillwei7 0:5c195ab2f696 1135 {
gillwei7 3:38ec8ad317f4 1136 if (cyntecGetCommandTokenCnt() != 3) {
gillwei7 3:38ec8ad317f4 1137 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
gillwei7 3:38ec8ad317f4 1138 return;
gillwei7 4:b52035367aee 1139 }
gillwei7 4:b52035367aee 1140 /* handle first parameter - Service UUID */
gillwei7 4:b52035367aee 1141 uint8_t argLen = 0;
gillwei7 4:b52035367aee 1142 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
gillwei7 3:38ec8ad317f4 1143
gillwei7 4:b52035367aee 1144 /* Service uuid is 16 bits */
gillwei7 4:b52035367aee 1145 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
gillwei7 4:b52035367aee 1146 UUID::ShortUUIDBytes_t buffer_uuid_short;
gillwei7 4:b52035367aee 1147 buffer_uuid_short = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 14:397f6514bb2c 1148 #if BLE_DEBUG
gillwei7 4:b52035367aee 1149 console.printf("%4X",buffer_uuid_short);
gillwei7 0:5c195ab2f696 1150 #endif
gillwei7 4:b52035367aee 1151 UUID uuid_short(buffer_uuid_short);
gillwei7 4:b52035367aee 1152 bufferService[service_count].ser_uuid = uuid_short;
gillwei7 4:b52035367aee 1153 //buffer_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
gillwei7 4:b52035367aee 1154 }
gillwei7 3:38ec8ad317f4 1155
gillwei7 4:b52035367aee 1156 /* Service uuid is 128 bits */
gillwei7 4:b52035367aee 1157 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
gillwei7 4:b52035367aee 1158 // Initialize LongUUIDBytes_t, then use default constructor to setupLong(longUUID)
gillwei7 4:b52035367aee 1159 UUID::LongUUIDBytes_t buffer_uuid_vs;
gillwei7 4:b52035367aee 1160 for (uint8_t i=0; i<16; i++) {
gillwei7 4:b52035367aee 1161 buffer_uuid_vs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
gillwei7 14:397f6514bb2c 1162 #if BLE_DEBUG
gillwei7 4:b52035367aee 1163 console.printf("%2X ",buffer_uuid_vs[i]);
gillwei7 4:b52035367aee 1164 #endif
gillwei7 3:38ec8ad317f4 1165 }
gillwei7 4:b52035367aee 1166 UUID uuid_long(buffer_uuid_vs);
gillwei7 4:b52035367aee 1167 bufferService[service_count].ser_uuid = uuid_long;
gillwei7 3:38ec8ad317f4 1168 }
gillwei7 4:b52035367aee 1169 cyntecPrintOk();
gillwei7 4:b52035367aee 1170 service_count++;
gillwei7 4:b52035367aee 1171 char_count = 0;
gillwei7 3:38ec8ad317f4 1172 }
gillwei7 0:5c195ab2f696 1173
tsungta 17:03c8af30087a 1174 /*Tsungta, @0913 modify to compatiable with mbed os 5.0*/
tsungta 17:03c8af30087a 1175 #include <mbed-events/events.h>
tsungta 17:03c8af30087a 1176 void onBleInitError(BLE &ble, ble_error_t error)
tsungta 17:03c8af30087a 1177 {
tsungta 17:03c8af30087a 1178 (void)ble;
tsungta 17:03c8af30087a 1179 (void)error;
tsungta 17:03c8af30087a 1180 /* Initialization error handling should go here */
tsungta 17:03c8af30087a 1181 }
tsungta 17:03c8af30087a 1182
tsungta 17:03c8af30087a 1183 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
gillwei7 0:5c195ab2f696 1184 {
tsungta 17:03c8af30087a 1185
tsungta 17:03c8af30087a 1186 }
tsungta 17:03c8af30087a 1187
tsungta 17:03c8af30087a 1188 static EventQueue eventQueue(
tsungta 17:03c8af30087a 1189 /* event count */ 16 * /* event size */ 32
tsungta 17:03c8af30087a 1190 );
tsungta 17:03c8af30087a 1191
tsungta 17:03c8af30087a 1192 void scheduleBleEventsProcessing(BLE::OnEventsToProcessCallbackContext* context) {
tsungta 17:03c8af30087a 1193 BLE &deltaBLE = BLE::Instance();
tsungta 17:03c8af30087a 1194 eventQueue.post(Callback<void()>(&deltaBLE, &BLE::processEvents));
tsungta 17:03c8af30087a 1195 }
tsungta 17:03c8af30087a 1196
tsungta 17:03c8af30087a 1197 void cynBLEInitCommand(void)
silviaChen 18:4f5b317c04b9 1198 {
tsungta 17:03c8af30087a 1199 BLE &deltaBLE = BLE::Instance();
tsungta 17:03c8af30087a 1200
tsungta 17:03c8af30087a 1201 deltaBLE.onEventsToProcess(scheduleBleEventsProcessing);
tsungta 17:03c8af30087a 1202 deltaBLE.init(bleInitComplete);
gillwei7 3:38ec8ad317f4 1203 deltaBLE.onDisconnection(disconnectionCallback);
gillwei7 3:38ec8ad317f4 1204 deltaBLE.onConnection(onConnectionCallback);
gillwei7 3:38ec8ad317f4 1205 deltaBLE.onTimeout(onTimeoutCallback);
gillwei7 7:33214585c606 1206 deltaBLE.gattServer().onDataRead(triggerRead);
gillwei7 12:a91455702763 1207
silviaChen 18:4f5b317c04b9 1208 console.printf("\r\nOK;%s;%s\r\n\r\n", CLI_FWVERION, MODULE_NAME); //0920 Silvia add
tsungta 17:03c8af30087a 1209 while (true) {
tsungta 17:03c8af30087a 1210 eventQueue.dispatch();
tsungta 17:03c8af30087a 1211 }
gillwei7 0:5c195ab2f696 1212 }
tsungta 17:03c8af30087a 1213 /*Tsungta, end of @0913 modification*/
silviaChen 16:d1682a3e93f5 1214
silviaChen 16:d1682a3e93f5 1215 //Silvia modify
silviaChen 16:d1682a3e93f5 1216 static void cynBLECenInitCommand(void)
silviaChen 16:d1682a3e93f5 1217 {
silviaChen 16:d1682a3e93f5 1218 deltaBLE.init();
silviaChen 16:d1682a3e93f5 1219 deltaBLE.onDisconnection(disconnectionCallback);
silviaChen 16:d1682a3e93f5 1220 deltaBLE.onConnection(onConnectionCallback);
silviaChen 16:d1682a3e93f5 1221 deltaBLE.onTimeout(onTimeoutCallback);
silviaChen 16:d1682a3e93f5 1222 deltaBLE.gattClient().onDataRead(centralReadCallback);
silviaChen 16:d1682a3e93f5 1223 deltaBLE.gattClient().onDataWrite(centralWriteCallback);
silviaChen 16:d1682a3e93f5 1224 deltaBLE.gattClient().onHVX(centralHvxCallback);
silviaChen 16:d1682a3e93f5 1225
silviaChen 16:d1682a3e93f5 1226 cyntecPrintOk();
silviaChen 16:d1682a3e93f5 1227 }
silviaChen 16:d1682a3e93f5 1228
silviaChen 16:d1682a3e93f5 1229 static void cynBLECenReadDataCommand(void)
silviaChen 16:d1682a3e93f5 1230 {
silviaChen 16:d1682a3e93f5 1231 if (cyntecGetCommandTokenCnt() != 4) {
silviaChen 16:d1682a3e93f5 1232 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
silviaChen 16:d1682a3e93f5 1233 return;
silviaChen 16:d1682a3e93f5 1234 }
silviaChen 16:d1682a3e93f5 1235 UUID buf_ser_uuid ;
silviaChen 16:d1682a3e93f5 1236 uint8_t bufferUuidVs[16];
silviaChen 16:d1682a3e93f5 1237 UUID buf_char_uuid;
silviaChen 16:d1682a3e93f5 1238 bool readmatchFlag = false;
silviaChen 16:d1682a3e93f5 1239 uint8_t argLen = 0;
silviaChen 16:d1682a3e93f5 1240 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
silviaChen 16:d1682a3e93f5 1241
silviaChen 16:d1682a3e93f5 1242 // Handle input parameter - Service UUID
silviaChen 16:d1682a3e93f5 1243 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1244 buf_ser_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1245 }
silviaChen 16:d1682a3e93f5 1246 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1247 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1248 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1249 }
silviaChen 16:d1682a3e93f5 1250 buf_ser_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1251 }
silviaChen 16:d1682a3e93f5 1252
silviaChen 16:d1682a3e93f5 1253 // Handle input parameter - Characteristic UUID
silviaChen 16:d1682a3e93f5 1254 argLen = 0;
silviaChen 16:d1682a3e93f5 1255 arg = cyntecGetCommandArgument(1,&argLen);
silviaChen 16:d1682a3e93f5 1256 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1257 buf_char_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1258 }
silviaChen 16:d1682a3e93f5 1259 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1260 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1261 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1262 }
silviaChen 16:d1682a3e93f5 1263 buf_char_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1264 }
silviaChen 16:d1682a3e93f5 1265
silviaChen 16:d1682a3e93f5 1266 for ( int i = 0 ; i < discoverService_count ; i++ ) {
silviaChen 16:d1682a3e93f5 1267 UUID sUUID, cUUID;
silviaChen 16:d1682a3e93f5 1268 if (discoverServiceArr[i].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1269 sUUID = UUID(discoverServiceArr[i].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1270 } else {
silviaChen 16:d1682a3e93f5 1271 const uint8_t *longUUIDBytes = discoverServiceArr[i].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1272 sUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1273 }
silviaChen 16:d1682a3e93f5 1274 if ((sUUID == buf_ser_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1275 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
silviaChen 16:d1682a3e93f5 1276 if (discoverCharArr[i][j].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1277 cUUID = UUID(discoverCharArr[i][j].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1278 } else {
silviaChen 16:d1682a3e93f5 1279 const uint8_t *longUUIDBytes = discoverCharArr[i][j].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1280 cUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1281 }
silviaChen 16:d1682a3e93f5 1282 if ((cUUID == buf_char_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1283 cyntecPrintOk();
silviaChen 16:d1682a3e93f5 1284 discoverCharArr[i][j].read();
silviaChen 16:d1682a3e93f5 1285
silviaChen 16:d1682a3e93f5 1286 readmatchFlag = true;
silviaChen 16:d1682a3e93f5 1287 return;
silviaChen 16:d1682a3e93f5 1288 }
silviaChen 16:d1682a3e93f5 1289 }
silviaChen 16:d1682a3e93f5 1290 }
silviaChen 16:d1682a3e93f5 1291 }
silviaChen 16:d1682a3e93f5 1292
silviaChen 16:d1682a3e93f5 1293 // no matched case, can not read
silviaChen 16:d1682a3e93f5 1294 if (readmatchFlag == false) {
silviaChen 16:d1682a3e93f5 1295 cyntecPrintError(CYNTEC_CMD_ERR_NO_MATCHED_ARGUMENT);
silviaChen 16:d1682a3e93f5 1296 }
silviaChen 16:d1682a3e93f5 1297 }
silviaChen 16:d1682a3e93f5 1298
silviaChen 16:d1682a3e93f5 1299 static void cynBLECenWriteDataCommand(void) {
silviaChen 16:d1682a3e93f5 1300 if (cyntecGetCommandTokenCnt() != 6) {
silviaChen 16:d1682a3e93f5 1301 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
silviaChen 16:d1682a3e93f5 1302 return;
silviaChen 16:d1682a3e93f5 1303 }
silviaChen 16:d1682a3e93f5 1304 UUID buf_ser_uuid ;
silviaChen 16:d1682a3e93f5 1305 uint8_t bufferUuidVs[16];
silviaChen 16:d1682a3e93f5 1306 UUID buf_char_uuid;
silviaChen 16:d1682a3e93f5 1307 bool readmatchFlag = false;
silviaChen 16:d1682a3e93f5 1308 uint16_t valueLen = 0;
silviaChen 16:d1682a3e93f5 1309 uint8_t argLen = 0;
silviaChen 16:d1682a3e93f5 1310 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
silviaChen 16:d1682a3e93f5 1311 uint8_t bufVal[MAX_VALUE_LENGTH] = {0};
silviaChen 16:d1682a3e93f5 1312
silviaChen 16:d1682a3e93f5 1313 // Handle input parameter - Service UUID
silviaChen 16:d1682a3e93f5 1314 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1315 buf_ser_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1316 }
silviaChen 16:d1682a3e93f5 1317 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1318 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1319 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1320 }
silviaChen 16:d1682a3e93f5 1321 buf_ser_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1322 }
silviaChen 16:d1682a3e93f5 1323
silviaChen 16:d1682a3e93f5 1324 // Handle input parameter - Characteristic UUID
silviaChen 16:d1682a3e93f5 1325 argLen = 0;
silviaChen 16:d1682a3e93f5 1326 arg = cyntecGetCommandArgument(1,&argLen);
silviaChen 16:d1682a3e93f5 1327 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1328 buf_char_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1329 }
silviaChen 16:d1682a3e93f5 1330 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1331 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1332 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1333 }
silviaChen 16:d1682a3e93f5 1334 buf_char_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1335 }
silviaChen 16:d1682a3e93f5 1336
silviaChen 16:d1682a3e93f5 1337 //// Input Value Type
silviaChen 16:d1682a3e93f5 1338 arg = cyntecGetCommandArgument(2,&argLen);
silviaChen 16:d1682a3e93f5 1339 uint8_t type = *arg;
silviaChen 16:d1682a3e93f5 1340 //type = cyntecArgToUint8(arg,2);
silviaChen 16:d1682a3e93f5 1341 // printf("type:%d\r\n",type);
silviaChen 16:d1682a3e93f5 1342 if(type != '0' && type != '1') {
silviaChen 16:d1682a3e93f5 1343 cyntecPrintError(CYNTEC_CMD_ERR_ARGUMENT_OUT_OF_RANGE);
silviaChen 16:d1682a3e93f5 1344 }
silviaChen 16:d1682a3e93f5 1345
silviaChen 16:d1682a3e93f5 1346 // Input value
silviaChen 16:d1682a3e93f5 1347 arg = cyntecGetCommandArgument(3,&argLen);
silviaChen 16:d1682a3e93f5 1348 if(type == '0') {
silviaChen 16:d1682a3e93f5 1349 valueLen = argLen;
silviaChen 16:d1682a3e93f5 1350 memcpy(bufVal,arg,argLen);
silviaChen 16:d1682a3e93f5 1351 }
silviaChen 16:d1682a3e93f5 1352 if(type == '1') {
silviaChen 16:d1682a3e93f5 1353 valueLen = (argLen-2)/2; // uint8_t to uint16_t transform
silviaChen 16:d1682a3e93f5 1354 for (int i=0 ; i < valueLen; i++) {
silviaChen 16:d1682a3e93f5 1355 bufVal[i] = cyntecArgToUint8(arg+2+2*i,2);
silviaChen 16:d1682a3e93f5 1356 }
silviaChen 16:d1682a3e93f5 1357 }
silviaChen 16:d1682a3e93f5 1358 #if BLE_DEBUG
silviaChen 16:d1682a3e93f5 1359 printf("type:%i,bufVal:",type);
silviaChen 16:d1682a3e93f5 1360 printf("valueLength:%i\r\n",valueLen);
silviaChen 16:d1682a3e93f5 1361 for (int i=0 ; i < valueLen; i++) {
silviaChen 16:d1682a3e93f5 1362 printf("%02X ",bufVal[i]);
silviaChen 16:d1682a3e93f5 1363 }
silviaChen 16:d1682a3e93f5 1364 printf("\r\n");
silviaChen 16:d1682a3e93f5 1365 #endif
silviaChen 16:d1682a3e93f5 1366
silviaChen 16:d1682a3e93f5 1367 for ( int i = 0 ; i < discoverService_count ; i++ ) {
silviaChen 16:d1682a3e93f5 1368 UUID sUUID, cUUID;
silviaChen 16:d1682a3e93f5 1369 if (discoverServiceArr[i].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1370 sUUID = UUID(discoverServiceArr[i].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1371 } else {
silviaChen 16:d1682a3e93f5 1372 const uint8_t *longUUIDBytes = discoverServiceArr[i].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1373 sUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1374 }
silviaChen 16:d1682a3e93f5 1375 if ((sUUID == buf_ser_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1376 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
silviaChen 16:d1682a3e93f5 1377 if (discoverCharArr[i][j].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1378 cUUID = UUID(discoverCharArr[i][j].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1379 } else {
silviaChen 16:d1682a3e93f5 1380 const uint8_t *longUUIDBytes = discoverCharArr[i][j].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1381 cUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1382 }
silviaChen 16:d1682a3e93f5 1383 if ((cUUID == buf_char_uuid) & (readmatchFlag == false)) {
silviaChen 18:4f5b317c04b9 1384 console.printf("OK;");
silviaChen 16:d1682a3e93f5 1385 for (int i=0 ; i < valueLen; i++) {
silviaChen 18:4f5b317c04b9 1386 console.printf("%02X",bufVal[i]);
silviaChen 16:d1682a3e93f5 1387 }
silviaChen 18:4f5b317c04b9 1388 console.printf("\r\n");
silviaChen 16:d1682a3e93f5 1389 deltaBLE.gattClient().write(GattClient::GATT_OP_WRITE_REQ, discoverCharArr[i][j].getConnectionHandle(), discoverCharArr[i][j].getValueHandle(), valueLen, bufVal);
silviaChen 16:d1682a3e93f5 1390 readmatchFlag = true;
silviaChen 16:d1682a3e93f5 1391 return;
silviaChen 16:d1682a3e93f5 1392 }
silviaChen 16:d1682a3e93f5 1393 }
silviaChen 16:d1682a3e93f5 1394 }
silviaChen 16:d1682a3e93f5 1395 }
silviaChen 16:d1682a3e93f5 1396
silviaChen 16:d1682a3e93f5 1397 // no matched case, can not read
silviaChen 16:d1682a3e93f5 1398 if (readmatchFlag == false) {
silviaChen 16:d1682a3e93f5 1399 cyntecPrintError(CYNTEC_CMD_ERR_NO_MATCHED_ARGUMENT);
silviaChen 16:d1682a3e93f5 1400 }
silviaChen 16:d1682a3e93f5 1401 }
silviaChen 16:d1682a3e93f5 1402
silviaChen 16:d1682a3e93f5 1403 static void cynBLECenEnNotifyCommand(void)
silviaChen 16:d1682a3e93f5 1404 {
silviaChen 16:d1682a3e93f5 1405 if (cyntecGetCommandTokenCnt() != 4) {
silviaChen 16:d1682a3e93f5 1406 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
silviaChen 16:d1682a3e93f5 1407 return;
silviaChen 16:d1682a3e93f5 1408 }
silviaChen 16:d1682a3e93f5 1409 UUID buf_ser_uuid ;
silviaChen 16:d1682a3e93f5 1410 uint8_t bufferUuidVs[16];
silviaChen 16:d1682a3e93f5 1411 UUID buf_char_uuid;
silviaChen 16:d1682a3e93f5 1412 bool readmatchFlag = false;
silviaChen 16:d1682a3e93f5 1413 uint8_t argLen = 0;
silviaChen 16:d1682a3e93f5 1414 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
silviaChen 16:d1682a3e93f5 1415
silviaChen 16:d1682a3e93f5 1416 // Handle input parameter - Service UUID
silviaChen 16:d1682a3e93f5 1417 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1418 buf_ser_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1419 }
silviaChen 16:d1682a3e93f5 1420 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1421 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1422 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1423 }
silviaChen 16:d1682a3e93f5 1424 buf_ser_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1425 }
silviaChen 16:d1682a3e93f5 1426
silviaChen 16:d1682a3e93f5 1427 // Handle input parameter - Characteristic UUID
silviaChen 16:d1682a3e93f5 1428 argLen = 0;
silviaChen 16:d1682a3e93f5 1429 arg = cyntecGetCommandArgument(1,&argLen);
silviaChen 16:d1682a3e93f5 1430 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1431 buf_char_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1432 }
silviaChen 16:d1682a3e93f5 1433 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1434 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1435 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1436 }
silviaChen 16:d1682a3e93f5 1437 buf_char_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1438 }
silviaChen 16:d1682a3e93f5 1439
silviaChen 16:d1682a3e93f5 1440 for ( int i = 0 ; i < discoverService_count ; i++ ) {
silviaChen 16:d1682a3e93f5 1441 UUID sUUID, cUUID;
silviaChen 16:d1682a3e93f5 1442 if (discoverServiceArr[i].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1443 sUUID = UUID(discoverServiceArr[i].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1444 } else {
silviaChen 16:d1682a3e93f5 1445 const uint8_t *longUUIDBytes = discoverServiceArr[i].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1446 sUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1447 }
silviaChen 16:d1682a3e93f5 1448 if ((sUUID == buf_ser_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1449 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
silviaChen 16:d1682a3e93f5 1450 if (discoverCharArr[i][j].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1451 cUUID = UUID(discoverCharArr[i][j].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1452 } else {
silviaChen 16:d1682a3e93f5 1453 const uint8_t *longUUIDBytes = discoverCharArr[i][j].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1454 cUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1455 }
silviaChen 16:d1682a3e93f5 1456 if ((cUUID == buf_char_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1457 cyntecPrintOk();
silviaChen 16:d1682a3e93f5 1458 uint16_t value = BLE_HVX_NOTIFICATION;
silviaChen 16:d1682a3e93f5 1459 deltaBLE.gattClient().write(GattClient::GATT_OP_WRITE_REQ, discoverCharArr[i][j].getConnectionHandle(), discoverCharArr[i][j].getValueHandle() + 1, 2, (uint8_t *)&value);
silviaChen 16:d1682a3e93f5 1460 readmatchFlag = true;
silviaChen 16:d1682a3e93f5 1461 return;
silviaChen 16:d1682a3e93f5 1462 }
silviaChen 16:d1682a3e93f5 1463 }
silviaChen 16:d1682a3e93f5 1464 }
silviaChen 16:d1682a3e93f5 1465 }
silviaChen 16:d1682a3e93f5 1466
silviaChen 16:d1682a3e93f5 1467 // no matched case, can not read
silviaChen 16:d1682a3e93f5 1468 if (readmatchFlag == false) {
silviaChen 16:d1682a3e93f5 1469 cyntecPrintError(CYNTEC_CMD_ERR_NO_MATCHED_ARGUMENT);
silviaChen 16:d1682a3e93f5 1470 }
silviaChen 16:d1682a3e93f5 1471 }
silviaChen 16:d1682a3e93f5 1472
silviaChen 16:d1682a3e93f5 1473 static void cynBLECenDisNotifyCommand(void) {
silviaChen 16:d1682a3e93f5 1474 if (cyntecGetCommandTokenCnt() != 4) {
silviaChen 16:d1682a3e93f5 1475 cyntecPrintError(CYNTEC_CMD_ERR_WRONG_NUMBER_OF_ARGUMENTS);
silviaChen 16:d1682a3e93f5 1476 return;
silviaChen 16:d1682a3e93f5 1477 }
silviaChen 16:d1682a3e93f5 1478 UUID buf_ser_uuid ;
silviaChen 16:d1682a3e93f5 1479 uint8_t bufferUuidVs[16];
silviaChen 16:d1682a3e93f5 1480 UUID buf_char_uuid;
silviaChen 16:d1682a3e93f5 1481 bool readmatchFlag = false;
silviaChen 16:d1682a3e93f5 1482 uint8_t argLen = 0;
silviaChen 16:d1682a3e93f5 1483 uint8_t *arg = cyntecGetCommandArgument(0,&argLen);
silviaChen 16:d1682a3e93f5 1484
silviaChen 16:d1682a3e93f5 1485 // Handle input parameter - Service UUID
silviaChen 16:d1682a3e93f5 1486 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1487 buf_ser_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1488 }
silviaChen 16:d1682a3e93f5 1489 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1490 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1491 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1492 }
silviaChen 16:d1682a3e93f5 1493 buf_ser_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1494 }
silviaChen 16:d1682a3e93f5 1495
silviaChen 16:d1682a3e93f5 1496 // Handle input parameter - Characteristic UUID
silviaChen 16:d1682a3e93f5 1497 argLen = 0;
silviaChen 16:d1682a3e93f5 1498 arg = cyntecGetCommandArgument(1,&argLen);
silviaChen 16:d1682a3e93f5 1499 if ( argLen == 6 && arg[0] == '0' && arg[1] == 'x') {
silviaChen 16:d1682a3e93f5 1500 buf_char_uuid = cyntecArgToUint16( (arg + 2), (argLen - 2));
silviaChen 16:d1682a3e93f5 1501 }
silviaChen 16:d1682a3e93f5 1502 if ( argLen == 34 && arg[0] == '0' && arg[1] == 'x' ) {
silviaChen 16:d1682a3e93f5 1503 for (uint8_t i=0; i<16; i++) {
silviaChen 16:d1682a3e93f5 1504 bufferUuidVs[i] = cyntecArgToUint8( (arg + 2+2*i), 2);
silviaChen 16:d1682a3e93f5 1505 }
silviaChen 16:d1682a3e93f5 1506 buf_char_uuid.setupLong(bufferUuidVs);
silviaChen 16:d1682a3e93f5 1507 }
silviaChen 16:d1682a3e93f5 1508
silviaChen 16:d1682a3e93f5 1509 for ( int i = 0 ; i < discoverService_count ; i++ ) {
silviaChen 16:d1682a3e93f5 1510 UUID sUUID, cUUID;
silviaChen 16:d1682a3e93f5 1511 if (discoverServiceArr[i].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1512 sUUID = UUID(discoverServiceArr[i].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1513 } else {
silviaChen 16:d1682a3e93f5 1514 const uint8_t *longUUIDBytes = discoverServiceArr[i].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1515 sUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1516 }
silviaChen 16:d1682a3e93f5 1517 if ((sUUID == buf_ser_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1518 for (int j = 0 ; j < CLI_CHAR_MAX_NUM ; j++ ) {
silviaChen 16:d1682a3e93f5 1519 if (discoverCharArr[i][j].getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) {
silviaChen 16:d1682a3e93f5 1520 cUUID = UUID(discoverCharArr[i][j].getUUID().getShortUUID());
silviaChen 16:d1682a3e93f5 1521 } else {
silviaChen 16:d1682a3e93f5 1522 const uint8_t *longUUIDBytes = discoverCharArr[i][j].getUUID().getBaseUUID();
silviaChen 16:d1682a3e93f5 1523 cUUID = UUID(longUUIDBytes);
silviaChen 16:d1682a3e93f5 1524 }
silviaChen 16:d1682a3e93f5 1525 if ((cUUID == buf_char_uuid) & (readmatchFlag == false)) {
silviaChen 16:d1682a3e93f5 1526 cyntecPrintOk();
silviaChen 16:d1682a3e93f5 1527 uint16_t value = 0x00;
silviaChen 16:d1682a3e93f5 1528 deltaBLE.gattClient().write(GattClient::GATT_OP_WRITE_REQ, discoverCharArr[i][j].getConnectionHandle(), discoverCharArr[i][j].getValueHandle() + 1, 2, (uint8_t *)&value);
silviaChen 16:d1682a3e93f5 1529 readmatchFlag = true;
silviaChen 16:d1682a3e93f5 1530 return;
silviaChen 16:d1682a3e93f5 1531 }
silviaChen 16:d1682a3e93f5 1532 }
silviaChen 16:d1682a3e93f5 1533 }
silviaChen 16:d1682a3e93f5 1534 }
silviaChen 16:d1682a3e93f5 1535
silviaChen 16:d1682a3e93f5 1536 // no matched case, can not read
silviaChen 16:d1682a3e93f5 1537 if (readmatchFlag == false) {
silviaChen 16:d1682a3e93f5 1538 cyntecPrintError(CYNTEC_CMD_ERR_NO_MATCHED_ARGUMENT);
silviaChen 16:d1682a3e93f5 1539 }
silviaChen 16:d1682a3e93f5 1540 }
silviaChen 16:d1682a3e93f5 1541 //Silvia modify
silviaChen 16:d1682a3e93f5 1542
gillwei7 7:33214585c606 1543 static void cynBLEDataIntCommand(void)
gillwei7 7:33214585c606 1544 {
gillwei7 12:a91455702763 1545 cyntecPrintOk();
gillwei7 12:a91455702763 1546 deltaBLE.gattServer().onDataWritten().add(onDataWrittenCallback);
gillwei7 7:33214585c606 1547 }
gillwei7 7:33214585c606 1548 static void cynBLEDisDataIntCommand(void)
gillwei7 7:33214585c606 1549 {
gillwei7 12:a91455702763 1550 cyntecPrintOk();
gillwei7 12:a91455702763 1551 deltaBLE.gattServer().onDataWritten().detach(onDataWrittenCallback);
gillwei7 7:33214585c606 1552 }
gillwei7 0:5c195ab2f696 1553
gillwei7 14:397f6514bb2c 1554 #if BLE_DEBUG
gillwei7 4:b52035367aee 1555 static void cynBLETestCommand(void)
gillwei7 4:b52035367aee 1556 {
gillwei7 4:b52035367aee 1557 // gill test 1021
gillwei7 4:b52035367aee 1558 uint8_t bufVal[20] = {0};
gillwei7 7:33214585c606 1559 //uint8_t valWrite[2] = {0x22,0x33};
gillwei7 4:b52035367aee 1560 //uint16_t bufhandle = 0x0001;
gillwei7 7:33214585c606 1561 //uint8_t valRead[2] = {0,0};
gillwei7 4:b52035367aee 1562
gillwei7 7:33214585c606 1563 // uint16_t handle = charAry[0][0]->getValueHandle(); // No used?
gillwei7 4:b52035367aee 1564 GattAttribute& valueAttr = charAry[0][0]->getValueAttribute();
gillwei7 4:b52035367aee 1565 //valueAttr.setHandle(bufhandle);
gillwei7 4:b52035367aee 1566 console.printf("Handle:%04X ",valueAttr.getHandle());
gillwei7 4:b52035367aee 1567 console.printf("UUID:%04X ",valueAttr.getUUID().getShortUUID());
gillwei7 4:b52035367aee 1568
gillwei7 4:b52035367aee 1569 uint16_t* valueLenPtr = valueAttr.getLengthPtr();
gillwei7 4:b52035367aee 1570 deltaBLE.gattServer().read(valueAttr.getHandle(),bufVal,valueLenPtr);
gillwei7 7:33214585c606 1571 console.printf("gatt val[0][1]:%02X %02X\r\n",bufVal[0],bufVal[1]);
gillwei7 4:b52035367aee 1572 }
gillwei7 5:ee474e3133eb 1573 #endif
gillwei7 4:b52035367aee 1574
gillwei7 0:5c195ab2f696 1575 CyntecCommandEntry bleCommandSets[] = {
gillwei7 4:b52035367aee 1576 // General
gillwei7 14:397f6514bb2c 1577 #if BLE_DEBUG
gillwei7 4:b52035367aee 1578 {"TEST", cynBLETestCommand, NULL, "test"},
gillwei7 4:b52035367aee 1579 #endif
gillwei7 4:b52035367aee 1580 //
gillwei7 4:b52035367aee 1581 #if SIMPLE_CMD_NAME
tsungta 17:03c8af30087a 1582 //{"INT", cynBLEInitCommand, NULL, "Init BLE stack"},//Tsungta, INT is called in main.cpp
gillwei7 4:b52035367aee 1583 {"GIO", cynBLEGPIOCommand, NULL, "Config gpio, Usage: <GPIO NO> <set|clear>"},
gillwei7 4:b52035367aee 1584 {"SLP", cynBLESystemOffCommand, NULL, "System off mode, Usage: <GPIO NO>"},
gillwei7 4:b52035367aee 1585 {"RST", cynResetCommand, NULL, "Soft reset"},
silviaChen 16:d1682a3e93f5 1586 {"INF", cynBLEInfoCommand, NULL, "Get module information"},
silviaChen 16:d1682a3e93f5 1587 {"POW", cynBLESetTxPowerCommand, NULL, "Set BLE tx power, Usage: <TX POWER>"},
silviaChen 16:d1682a3e93f5 1588 {"NAM", cynBLENameCommand, NULL, "Set/Get friendly for BLE module, Usage: <LENGTH> <NAME>"},
gillwei7 4:b52035367aee 1589 // GATT
gillwei7 4:b52035367aee 1590 {"GRS", cynRegServiceCommand, NULL, "Register standby service"},
silviaChen 16:d1682a3e93f5 1591 {"GAC", cynGattCharCommand, NULL, "Set SIG defined characteristic or Create your own,Usage: <CHAR UUID> <PROPS> <VALUE>"},
silviaChen 16:d1682a3e93f5 1592 {"GAS", cynGattServiceCommand, NULL, "Set SIG defined service or Create your own,Usage: <SERVICE UUID>"},
silviaChen 16:d1682a3e93f5 1593 {"ADS", cynAdvertiseStartCommand, NULL, "Start broadcast advertise packet,Usage: <INTERVAL> <WINDOW>"},
gillwei7 4:b52035367aee 1594 {"ADP", cynAdvertiseStopCommand, NULL, "Stop broadcast advertise packet"},
silviaChen 16:d1682a3e93f5 1595 {"SCS", cynBLEScanCommand, NULL, "Start to scan BLE device, Usage: <INTERVAL> <WINDOW> <TIMEOUT>"},
gillwei7 4:b52035367aee 1596 {"SCP", cynBLEScanStopCommand, NULL, "Stop to scan BLE device"},
silviaChen 16:d1682a3e93f5 1597 {"CON", cynBLEConnectCommand, NULL, "Connect to specific BLE device by Device Address, Usage: <ADDR>"},
silviaChen 16:d1682a3e93f5 1598 {"DCN", cynBLEDisconnectCommand, NULL, "Disconnection"},
silviaChen 16:d1682a3e93f5 1599 {"ADR", cynBLEAddressCommand, NULL, "Set/Get Bluetooth address, Usage: <ADDR>"},
silviaChen 16:d1682a3e93f5 1600 {"WRT", cynBLEUpdateDataCommand, NULL, "Update value of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID> <TYPE> <VALUE>"},
silviaChen 16:d1682a3e93f5 1601 {"RED", cynBLEReadDataCommand, NULL, "Read value of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
gillwei7 7:33214585c606 1602 {"EDI", cynBLEDataIntCommand, NULL, "Trigger remote write detection, give interrupt to Host."},
gillwei7 7:33214585c606 1603 {"DDI", cynBLEDisDataIntCommand, NULL, "Disable remote write detection."},
silviaChen 16:d1682a3e93f5 1604 //Silvia add BLE central commands
silviaChen 16:d1682a3e93f5 1605 {"CIN", cynBLECenInitCommand, NULL, "Init BLE Central stack"},
silviaChen 16:d1682a3e93f5 1606 {"CRD", cynBLECenReadDataCommand, NULL, "BLE Central read value of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
silviaChen 16:d1682a3e93f5 1607 {"CWD", cynBLECenWriteDataCommand, NULL, "BLE Central write value to specific characteristics, Usage: <SERVICE UUID> <CHAR UUID> <TYPE> <VALUE>"},
silviaChen 16:d1682a3e93f5 1608 {"CEN", cynBLECenEnNotifyCommand, NULL, "BLE Central enable notification of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
silviaChen 16:d1682a3e93f5 1609 {"CDN", cynBLECenDisNotifyCommand, NULL, "BLE Central disable notification of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
gillwei7 4:b52035367aee 1610 {NULL, NULL, NULL, NULL},
gillwei7 4:b52035367aee 1611 #else
tsungta 17:03c8af30087a 1612 //{"init", cynBLEInitCommand, NULL, "Init BLE stack"},//Tsungta, init is called in main.cpp
gillwei7 5:ee474e3133eb 1613 {"gpio", cynBLEGPIOCommand, NULL, "Config gpio, Usage: <GPIO NO> <set|clear>"},
gillwei7 5:ee474e3133eb 1614 {"sleep", cynBLESystemOffCommand, NULL, "System off mode, Usage: <GPIO NO>"},
gillwei7 5:ee474e3133eb 1615 {"reset", cynResetCommand, NULL, "Soft reset"},
gillwei7 5:ee474e3133eb 1616 {"info", cynBLEInfoCommand, NULL, "Get module information"},
silviaChen 16:d1682a3e93f5 1617 {"txPow", cynBLESetTxPowerCommand, NULL, "Set BLE tx power, Usage: <TX POWER>"},
silviaChen 16:d1682a3e93f5 1618 {"name", cynBLENameCommand, NULL, "Set/Get friendly for BLE module, Usage: <LENGTH> <NAME>"},
gillwei7 4:b52035367aee 1619 // GATT
gillwei7 5:ee474e3133eb 1620 {"regService", cynRegServiceCommand, NULL, "Register standby service"},
gillwei7 5:ee474e3133eb 1621 {"gattChar", cynGattCharCommand, NULL, "Set SIG defined characteristic or Create your own,Usage: <CHAR UUID> <PROPS> <VALUE>"},
gillwei7 5:ee474e3133eb 1622 {"gattService", cynGattServiceCommand, NULL, "Set SIG defined service or Create your own,Usage: <SERVICE UUID>"},
gillwei7 5:ee474e3133eb 1623 {"advStart", cynAdvertiseStartCommand, NULL, "Start broadcast advertise packet,Usage: <INTERVAL> <WINDOW>"},
gillwei7 3:38ec8ad317f4 1624 {"advStop", cynAdvertiseStopCommand, NULL, "Stop broadcast advertise packet"},
silviaChen 16:d1682a3e93f5 1625 {"scanStart", cynBLEScanCommand, NULL, "Start to scan BLE device, Usage: <INTERVAL> <WINDOW> <TIMEOUT>"}, //BLE central
silviaChen 16:d1682a3e93f5 1626 {"scanStop", cynBLEScanStopCommand, NULL, "Stop to scan BLE device"}, //BLE central
silviaChen 16:d1682a3e93f5 1627 {"connect", cynBLEConnectCommand, NULL, "Connect to specific BLE device by Device Address, Usage: <ADDR>"}, //Silvia modify, BLE central
gillwei7 4:b52035367aee 1628 {"disconn", cynBLEDisconnectCommand, NULL, "Disconnection, Usage: cynb disconn"},
gillwei7 5:ee474e3133eb 1629 {"bleAddr", cynBLEAddressCommand, NULL, "Set/Get Bluetooth address, Usage: <ADDR>"},
silviaChen 16:d1682a3e93f5 1630 {"update", cynBLEUpdateDataCommand, NULL, "Update value of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID> <TYPE> <VALUE>"},
gillwei7 5:ee474e3133eb 1631 {"readData", cynBLEReadDataCommand, NULL, "Read value of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
gillwei7 7:33214585c606 1632 {"enInt", cynBLEDataIntCommand, NULL, "Trigger remote write detection, give interrupt to Host."},
gillwei7 7:33214585c606 1633 {"disInt", cynBLEDisDataIntCommand, NULL, "Disable remote write detection."},
silviaChen 16:d1682a3e93f5 1634 //Silvia add BLE central commands
silviaChen 16:d1682a3e93f5 1635 {"initBleCen", cynBLECenInitCommand, NULL, "Init BLE Central stack"},
silviaChen 16:d1682a3e93f5 1636 {"cenReadData", cynBLECenReadDataCommand, NULL, "BLE Central read value of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
silviaChen 16:d1682a3e93f5 1637 {"cenWriteData", cynBLECenWriteDataCommand, NULL, "BLE Central write value to specific characteristics, Usage: <SERVICE UUID> <CHAR UUID> <TYPE> <VALUE>"},
silviaChen 16:d1682a3e93f5 1638 {"cenEnNotify", cynBLECenEnNotifyCommand, NULL, "BLE Central enable notification of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
silviaChen 16:d1682a3e93f5 1639 {"cenDisNotify", cynBLECenDisNotifyCommand, NULL, "BLE Central disable notification of specific characteristics, Usage: <SERVICE UUID> <CHAR UUID>"},
gillwei7 3:38ec8ad317f4 1640 {NULL, NULL, NULL, NULL},
gillwei7 4:b52035367aee 1641 #endif
gillwei7 0:5c195ab2f696 1642 };