Delta / Mbed OS BLE_HIDScanner_DELTA

Example for BLE HID scanner

Fork of BLE_HIDScanner_DELTA by Silvia Chen

main.cpp@3:9d6e0ddf3fbe, 2017-07-24 (annotated)

Committer:
silviaChen
Date:
Mon Jul 24 02:55:38 2017 +0000
Revision:
3:9d6e0ddf3fbe
Parent:
2:9f46fa6237dd
Child:
4:fd7572166cbb
For BLE scanner

Who changed what in which revision?

UserRevisionLine numberNew contents of line
silviaChen 0:c7bcc0b36b5e 1 /* mbed Microcontroller Library
silviaChen 0:c7bcc0b36b5e 2 * Copyright (c) 2006-2015 ARM Limited
silviaChen 0:c7bcc0b36b5e 3 *
silviaChen 0:c7bcc0b36b5e 4 * Licensed under the Apache License, Version 2.0 (the "License");
silviaChen 0:c7bcc0b36b5e 5 * you may not use this file except in compliance with the License.
silviaChen 0:c7bcc0b36b5e 6 * You may obtain a copy of the License at
silviaChen 0:c7bcc0b36b5e 7 *
silviaChen 0:c7bcc0b36b5e 8 * http://www.apache.org/licenses/LICENSE-2.0
silviaChen 0:c7bcc0b36b5e 9 *
silviaChen 0:c7bcc0b36b5e 10 * Unless required by applicable law or agreed to in writing, software
silviaChen 0:c7bcc0b36b5e 11 * distributed under the License is distributed on an "AS IS" BASIS,
silviaChen 0:c7bcc0b36b5e 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
silviaChen 0:c7bcc0b36b5e 13 * See the License for the specific language governing permissions and
silviaChen 0:c7bcc0b36b5e 14 * limitations under the License.
silviaChen 0:c7bcc0b36b5e 15 */
silviaChen 0:c7bcc0b36b5e 16
silviaChen 0:c7bcc0b36b5e 17 #include "mbed.h"
silviaChen 0:c7bcc0b36b5e 18 #include "ble/BLE.h"
silviaChen 0:c7bcc0b36b5e 19 #include "ble/services/BatteryService.h"
silviaChen 0:c7bcc0b36b5e 20 #include "ble/services/DeviceInformationService.h"
silviaChen 1:8bca989a70be 21 #include "HIDService.h"
silviaChen 0:c7bcc0b36b5e 22
silviaChen 1:8bca989a70be 23 //DigitalOut led1(LED1);
silviaChen 3:9d6e0ddf3fbe 24 Serial uart(USBTX, USBRX);
silviaChen 0:c7bcc0b36b5e 25
silviaChen 1:8bca989a70be 26 HIDService *hidService;
silviaChen 1:8bca989a70be 27 unsigned char keyData;
silviaChen 1:8bca989a70be 28 const static char DEVICE_NAME[] = "HID_Keyboard";
silviaChen 1:8bca989a70be 29 static const uint16_t uuid16_list[] = {GattService::UUID_HUMAN_INTERFACE_DEVICE_SERVICE,
silviaChen 0:c7bcc0b36b5e 30 GattService::UUID_DEVICE_INFORMATION_SERVICE};
silviaChen 0:c7bcc0b36b5e 31 static volatile bool triggerSensorPolling = false;
silviaChen 1:8bca989a70be 32 bool isConnectionSecured = false;
silviaChen 0:c7bcc0b36b5e 33
silviaChen 1:8bca989a70be 34 DeviceInformationService *deviceInfo;
silviaChen 0:c7bcc0b36b5e 35
silviaChen 1:8bca989a70be 36 void passkeyDisplayCallback(Gap::Handle_t handle, const SecurityManager::Passkey_t passkey)
silviaChen 1:8bca989a70be 37 {
silviaChen 1:8bca989a70be 38 uart.printf("Input passKey: ");
silviaChen 1:8bca989a70be 39 for (unsigned i = 0; i < Gap::ADDR_LEN; i++) {
silviaChen 1:8bca989a70be 40 uart.printf("%c ", passkey[i]);
silviaChen 1:8bca989a70be 41 }
silviaChen 1:8bca989a70be 42 uart.printf("\r\n");
silviaChen 1:8bca989a70be 43 }
silviaChen 1:8bca989a70be 44
silviaChen 1:8bca989a70be 45 void securitySetupCompletedCallback(Gap::Handle_t handle, SecurityManager::SecurityCompletionStatus_t status)
silviaChen 1:8bca989a70be 46 {
silviaChen 1:8bca989a70be 47 if (status == SecurityManager::SEC_STATUS_SUCCESS) {
silviaChen 1:8bca989a70be 48 uart.printf("Security success\r\n", status);
silviaChen 3:9d6e0ddf3fbe 49 isConnectionSecured = true;
silviaChen 1:8bca989a70be 50 } else {
silviaChen 1:8bca989a70be 51 uart.printf("Security failed\r\n", status);
silviaChen 1:8bca989a70be 52 }
silviaChen 1:8bca989a70be 53 }
silviaChen 1:8bca989a70be 54
silviaChen 1:8bca989a70be 55 void linkSecuredCallback(Gap::Handle_t handle, SecurityManager::SecurityMode_t securityMode)
silviaChen 1:8bca989a70be 56 {
silviaChen 1:8bca989a70be 57 uart.printf("linkSecuredCallback\r\n");
silviaChen 1:8bca989a70be 58 isConnectionSecured = true;
silviaChen 1:8bca989a70be 59 }
silviaChen 1:8bca989a70be 60
silviaChen 1:8bca989a70be 61 void onConnectionCallback(const Gap::ConnectionCallbackParams_t *params)
silviaChen 1:8bca989a70be 62 {
silviaChen 1:8bca989a70be 63 uart.printf("Connected\r\n");
silviaChen 1:8bca989a70be 64 }
silviaChen 0:c7bcc0b36b5e 65
silviaChen 0:c7bcc0b36b5e 66 void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params)
silviaChen 0:c7bcc0b36b5e 67 {
silviaChen 1:8bca989a70be 68 uart.printf("Disconnected\r\n");
silviaChen 1:8bca989a70be 69 isConnectionSecured = false;
silviaChen 3:9d6e0ddf3fbe 70 BLE::Instance(BLE::DEFAULT_INSTANCE).gap().startAdvertising(); // restart advertising
silviaChen 0:c7bcc0b36b5e 71 }
silviaChen 0:c7bcc0b36b5e 72
silviaChen 1:8bca989a70be 73 void onTimeoutCallback(Gap::TimeoutSource_t source)
silviaChen 1:8bca989a70be 74 {
silviaChen 1:8bca989a70be 75 switch (source) {
silviaChen 1:8bca989a70be 76 case Gap::TIMEOUT_SRC_ADVERTISING:
silviaChen 1:8bca989a70be 77 uart.printf("Advertising timeout\r\n");
silviaChen 1:8bca989a70be 78 break;
silviaChen 1:8bca989a70be 79 case Gap::TIMEOUT_SRC_SECURITY_REQUEST:
silviaChen 1:8bca989a70be 80 uart.printf("Security request timeout\r\n");
silviaChen 1:8bca989a70be 81 break;
silviaChen 1:8bca989a70be 82 case Gap::TIMEOUT_SRC_SCAN:
silviaChen 1:8bca989a70be 83 uart.printf("Scanning timeout\r\n");
silviaChen 1:8bca989a70be 84 break;
silviaChen 1:8bca989a70be 85 case Gap::TIMEOUT_SRC_CONN:
silviaChen 1:8bca989a70be 86 uart.printf("Connection timeout\r\n");
silviaChen 1:8bca989a70be 87 break;
silviaChen 1:8bca989a70be 88 }
silviaChen 1:8bca989a70be 89 }
silviaChen 1:8bca989a70be 90
silviaChen 0:c7bcc0b36b5e 91 void periodicCallback(void)
silviaChen 0:c7bcc0b36b5e 92 {
silviaChen 1:8bca989a70be 93 //led1 = !led1; /* Do blinky on LED1 while we're waiting for BLE events */
silviaChen 0:c7bcc0b36b5e 94
silviaChen 0:c7bcc0b36b5e 95 /* Note that the periodicCallback() executes in interrupt context, so it is safer to do
silviaChen 0:c7bcc0b36b5e 96 * heavy-weight sensor polling from the main thread. */
silviaChen 3:9d6e0ddf3fbe 97 triggerSensorPolling = true;
silviaChen 0:c7bcc0b36b5e 98 }
silviaChen 0:c7bcc0b36b5e 99
silviaChen 3:9d6e0ddf3fbe 100 void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
silviaChen 3:9d6e0ddf3fbe 101 {
silviaChen 3:9d6e0ddf3fbe 102 BLE &ble = params->ble;
silviaChen 3:9d6e0ddf3fbe 103 ble_error_t error = params->error;
silviaChen 3:9d6e0ddf3fbe 104
silviaChen 3:9d6e0ddf3fbe 105 if (error != BLE_ERROR_NONE) {
silviaChen 3:9d6e0ddf3fbe 106 return;
silviaChen 3:9d6e0ddf3fbe 107 }
silviaChen 3:9d6e0ddf3fbe 108
silviaChen 3:9d6e0ddf3fbe 109 bool enableBonding = true;
silviaChen 3:9d6e0ddf3fbe 110 bool requireMITM = false;
silviaChen 3:9d6e0ddf3fbe 111
silviaChen 3:9d6e0ddf3fbe 112 //const uint8_t passkeyValue[6] = {0x00,0x00,0x00,0x00,0x00,0x00};
silviaChen 3:9d6e0ddf3fbe 113 ble.securityManager().init(enableBonding, requireMITM, SecurityManager::IO_CAPS_NONE);
silviaChen 3:9d6e0ddf3fbe 114 ble.securityManager().onPasskeyDisplay(passkeyDisplayCallback);
silviaChen 3:9d6e0ddf3fbe 115 ble.securityManager().onSecuritySetupCompleted(securitySetupCompletedCallback);
silviaChen 3:9d6e0ddf3fbe 116 ble.securityManager().onLinkSecured(linkSecuredCallback);
silviaChen 3:9d6e0ddf3fbe 117 ble.gap().onDisconnection(disconnectionCallback);
silviaChen 3:9d6e0ddf3fbe 118 ble.gap().onConnection(onConnectionCallback);
silviaChen 3:9d6e0ddf3fbe 119 ble.gap().onTimeout(onTimeoutCallback);
silviaChen 3:9d6e0ddf3fbe 120 //ble.gattServer().onDataRead(onDataReadCallback);
silviaChen 3:9d6e0ddf3fbe 121
silviaChen 3:9d6e0ddf3fbe 122 /* Setup primary service. */
silviaChen 3:9d6e0ddf3fbe 123 hidService = new HIDService(ble);
silviaChen 3:9d6e0ddf3fbe 124
silviaChen 3:9d6e0ddf3fbe 125 /* Setup auxiliary service. */
silviaChen 3:9d6e0ddf3fbe 126 deviceInfo = new DeviceInformationService(ble, "DELTA", "NQ620", "SN1", "hw-rev1", "fw-rev1", "soft-rev1");
silviaChen 3:9d6e0ddf3fbe 127
silviaChen 3:9d6e0ddf3fbe 128 /* Setup advertising. */
silviaChen 3:9d6e0ddf3fbe 129 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
silviaChen 3:9d6e0ddf3fbe 130 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
silviaChen 3:9d6e0ddf3fbe 131 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::KEYBOARD);
silviaChen 3:9d6e0ddf3fbe 132 ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
silviaChen 3:9d6e0ddf3fbe 133 ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
silviaChen 3:9d6e0ddf3fbe 134 ble.gap().setAdvertisingInterval(50); /* 50ms */
silviaChen 3:9d6e0ddf3fbe 135 ble.gap().startAdvertising();
silviaChen 3:9d6e0ddf3fbe 136 uart.printf("Start advertising\r\n");
silviaChen 3:9d6e0ddf3fbe 137 }
silviaChen 3:9d6e0ddf3fbe 138
silviaChen 3:9d6e0ddf3fbe 139 static uint8_t key_press_scan_buff[50];
silviaChen 3:9d6e0ddf3fbe 140 static uint8_t modifyKey[50];
silviaChen 3:9d6e0ddf3fbe 141 char msg[25] = "";
silviaChen 3:9d6e0ddf3fbe 142 int index_b = 0;
silviaChen 3:9d6e0ddf3fbe 143 int index_w = 0;
silviaChen 3:9d6e0ddf3fbe 144
silviaChen 3:9d6e0ddf3fbe 145 int main(void)
silviaChen 3:9d6e0ddf3fbe 146 {
silviaChen 3:9d6e0ddf3fbe 147 //led1 = 1;
silviaChen 3:9d6e0ddf3fbe 148 // Ticker ticker;
silviaChen 3:9d6e0ddf3fbe 149 // ticker.attach(periodicCallback, 0.1); // blink LED every second
silviaChen 3:9d6e0ddf3fbe 150
silviaChen 3:9d6e0ddf3fbe 151 uart.baud(115200);
silviaChen 3:9d6e0ddf3fbe 152 uart.printf("Srarting HID Service\r\n");
silviaChen 3:9d6e0ddf3fbe 153
silviaChen 3:9d6e0ddf3fbe 154 BLE& ble = BLE::Instance(BLE::DEFAULT_INSTANCE);
silviaChen 3:9d6e0ddf3fbe 155 ble.init(bleInitComplete);
silviaChen 3:9d6e0ddf3fbe 156
silviaChen 3:9d6e0ddf3fbe 157 /* SpinWait for initialization to complete. This is necessary because the
silviaChen 3:9d6e0ddf3fbe 158 * BLE object is used in the main loop below. */
silviaChen 3:9d6e0ddf3fbe 159 while (ble.hasInitialized() == false) { /* spin loop */ }
silviaChen 3:9d6e0ddf3fbe 160
silviaChen 3:9d6e0ddf3fbe 161 // infinite loop
silviaChen 3:9d6e0ddf3fbe 162 while (1) {
silviaChen 1:8bca989a70be 163 if (isConnectionSecured) {
silviaChen 3:9d6e0ddf3fbe 164 if (uart.readable() == 1) {
silviaChen 3:9d6e0ddf3fbe 165 keyData = uart.getc();
silviaChen 3:9d6e0ddf3fbe 166 uart.putc(keyData);
silviaChen 3:9d6e0ddf3fbe 167 msg[index_w++] = keyData;
silviaChen 1:8bca989a70be 168 if(keyData <= 0x39 && keyData >= 0x30){ //number
silviaChen 1:8bca989a70be 169 if(keyData == 0x30){
silviaChen 1:8bca989a70be 170 modifyKey[index_b] = 0x00;
silviaChen 1:8bca989a70be 171 key_press_scan_buff[index_b] = 0x27;
silviaChen 1:8bca989a70be 172 index_b++;
silviaChen 1:8bca989a70be 173 key_press_scan_buff[index_b] = 0x73;
silviaChen 1:8bca989a70be 174 } else {
silviaChen 1:8bca989a70be 175 modifyKey[index_b] = 0x00;
silviaChen 1:8bca989a70be 176 key_press_scan_buff[index_b] = keyData-0x13;
silviaChen 1:8bca989a70be 177 index_b++;
silviaChen 1:8bca989a70be 178 key_press_scan_buff[index_b] = 0x73;
silviaChen 1:8bca989a70be 179 }
silviaChen 1:8bca989a70be 180 } else if(keyData <= 0x7a && keyData >= 0x61 ){ //lowercase letters
silviaChen 1:8bca989a70be 181 modifyKey[index_b] = 0x00;
silviaChen 1:8bca989a70be 182 key_press_scan_buff[index_b] = keyData-0x5d;
silviaChen 1:8bca989a70be 183 index_b++;
silviaChen 1:8bca989a70be 184 key_press_scan_buff[index_b] = 0x73;
silviaChen 1:8bca989a70be 185 } else if(keyData <= 0x5a && keyData >= 0x41){ //uppercase letters
silviaChen 1:8bca989a70be 186 modifyKey[index_b] = 0x02;
silviaChen 1:8bca989a70be 187 key_press_scan_buff[index_b] = keyData-0x3d;
silviaChen 1:8bca989a70be 188 index_b++;
silviaChen 1:8bca989a70be 189 key_press_scan_buff[index_b] = 0x73;
silviaChen 1:8bca989a70be 190 } else if (keyData == 0x20) { //space
silviaChen 1:8bca989a70be 191 modifyKey[index_b] = 0x00;
silviaChen 1:8bca989a70be 192 key_press_scan_buff[index_b] = 0x2c;
silviaChen 1:8bca989a70be 193 index_b++;
silviaChen 1:8bca989a70be 194 key_press_scan_buff[index_b] = 0x73;
silviaChen 1:8bca989a70be 195 } else {
silviaChen 1:8bca989a70be 196 modifyKey[index_b] = 0x00;
silviaChen 1:8bca989a70be 197 //key_press_scan_buff[index_b] = 0x73; //this is dummy data.
silviaChen 1:8bca989a70be 198 //msg[index_w+1] = '\0';
silviaChen 1:8bca989a70be 199 }
silviaChen 1:8bca989a70be 200 index_b++;
silviaChen 3:9d6e0ddf3fbe 201 if(keyData == 0x0a && ble.getGapState().connected){
silviaChen 3:9d6e0ddf3fbe 202 for(int i = 0; i < index_b ; i++){
silviaChen 3:9d6e0ddf3fbe 203 uart.printf("m[%x] k[%x] ", modifyKey[i], key_press_scan_buff[i]);
silviaChen 3:9d6e0ddf3fbe 204 hidService->updateReport(modifyKey[i], key_press_scan_buff[i]);
silviaChen 3:9d6e0ddf3fbe 205 ble.waitForEvent();
silviaChen 3:9d6e0ddf3fbe 206 wait(0.01);
silviaChen 3:9d6e0ddf3fbe 207 }
silviaChen 1:8bca989a70be 208
silviaChen 3:9d6e0ddf3fbe 209 index_b = 0;
silviaChen 3:9d6e0ddf3fbe 210 index_w = 0;
silviaChen 3:9d6e0ddf3fbe 211 memset(modifyKey, 0, 50);
silviaChen 3:9d6e0ddf3fbe 212 memset(msg, 0, 25);
silviaChen 3:9d6e0ddf3fbe 213 memset(key_press_scan_buff, 0, 50);
silviaChen 3:9d6e0ddf3fbe 214 }
silviaChen 0:c7bcc0b36b5e 215 }
silviaChen 3:9d6e0ddf3fbe 216 } else {
silviaChen 3:9d6e0ddf3fbe 217 ble.waitForEvent(); // low power wait for event
silviaChen 3:9d6e0ddf3fbe 218 wait(1);
silviaChen 0:c7bcc0b36b5e 219 }
silviaChen 1:8bca989a70be 220
silviaChen 0:c7bcc0b36b5e 221 }
silviaChen 0:c7bcc0b36b5e 222 }