TYBLE16 on os5 sample programs
Dependencies: BME280 TextLCD nRF51_Vdd
Fork of TYBLE16_mbedlized_os5_BASE by
Please refer following notebook.
/users/kenjiArai/notebook/tyble16-module-as-mbed-os-5-board-mbedlization/
7_Uart_Client/original.cpp@1:9011c83e4178, 2018-04-14 (annotated)
- Committer:
- kenjiArai
- Date:
- Sat Apr 14 04:56:34 2018 +0000
- Revision:
- 1:9011c83e4178
added samples
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kenjiArai | 1:9011c83e4178 | 1 | #if 0 |
kenjiArai | 1:9011c83e4178 | 2 | //------------------------------------------------------------------------------------------------- |
kenjiArai | 1:9011c83e4178 | 3 | // ORIGINAL PROGRAM |
kenjiArai | 1:9011c83e4178 | 4 | // S130 potential unstability case [closed] by Fabien Comte |
kenjiArai | 1:9011c83e4178 | 5 | // https://devzone.nordicsemi.com/question/49705/s130-potential-unstability-case/ |
kenjiArai | 1:9011c83e4178 | 6 | // |
kenjiArai | 1:9011c83e4178 | 7 | #include "mbed.h" |
kenjiArai | 1:9011c83e4178 | 8 | #include "BLE.h" |
kenjiArai | 1:9011c83e4178 | 9 | #include "UARTService.h" |
kenjiArai | 1:9011c83e4178 | 10 | #include "ble/DiscoveredCharacteristic.h" |
kenjiArai | 1:9011c83e4178 | 11 | #include "ble/DiscoveredService.h" |
kenjiArai | 1:9011c83e4178 | 12 | #include "ble/service/UARTService.h" |
kenjiArai | 1:9011c83e4178 | 13 | |
kenjiArai | 1:9011c83e4178 | 14 | #define SOFT_DEVICE_FATHER_HANDLE 3 |
kenjiArai | 1:9011c83e4178 | 15 | |
kenjiArai | 1:9011c83e4178 | 16 | #define BOARDS_COUNT 3 |
kenjiArai | 1:9011c83e4178 | 17 | |
kenjiArai | 1:9011c83e4178 | 18 | const Gap::Address_t mac_board_0 = {0xb8, 0xac, 0x4e, 0x8d, 0x8b, 0xeb}; |
kenjiArai | 1:9011c83e4178 | 19 | const Gap::Address_t mac_board_1 = {0x9c, 0x43, 0x62, 0x30, 0xaf, 0xd2}; |
kenjiArai | 1:9011c83e4178 | 20 | const Gap::Address_t mac_board_2 = {0x5f, 0x1a, 0x9e, 0x6a, 0x63, 0xdd}; |
kenjiArai | 1:9011c83e4178 | 21 | |
kenjiArai | 1:9011c83e4178 | 22 | |
kenjiArai | 1:9011c83e4178 | 23 | // tiny ble board |
kenjiArai | 1:9011c83e4178 | 24 | #define LED_GREEN p21 |
kenjiArai | 1:9011c83e4178 | 25 | #define LED_RED p22 |
kenjiArai | 1:9011c83e4178 | 26 | #define LED_BLUE p23 |
kenjiArai | 1:9011c83e4178 | 27 | #define BUTTON_PIN p17 |
kenjiArai | 1:9011c83e4178 | 28 | #define BATTERY_PIN p1 |
kenjiArai | 1:9011c83e4178 | 29 | |
kenjiArai | 1:9011c83e4178 | 30 | #define MPU6050_SDA p12 |
kenjiArai | 1:9011c83e4178 | 31 | #define MPU6050_SCL p13 |
kenjiArai | 1:9011c83e4178 | 32 | |
kenjiArai | 1:9011c83e4178 | 33 | #define UART_TX p9 |
kenjiArai | 1:9011c83e4178 | 34 | #define UART_RX p11 |
kenjiArai | 1:9011c83e4178 | 35 | #define UART_CTS p8 |
kenjiArai | 1:9011c83e4178 | 36 | #define UART_RTS p10 |
kenjiArai | 1:9011c83e4178 | 37 | |
kenjiArai | 1:9011c83e4178 | 38 | DigitalOut led(LED_RED); |
kenjiArai | 1:9011c83e4178 | 39 | DigitalOut alivenessLED(LED_GREEN); |
kenjiArai | 1:9011c83e4178 | 40 | InterruptIn button(BUTTON_PIN); |
kenjiArai | 1:9011c83e4178 | 41 | AnalogIn battery(BATTERY_PIN); |
kenjiArai | 1:9011c83e4178 | 42 | Serial pc(UART_TX, UART_RX); |
kenjiArai | 1:9011c83e4178 | 43 | |
kenjiArai | 1:9011c83e4178 | 44 | bool mac_equals(const Gap::Address_t mac_1, const Gap::Address_t mac_2) |
kenjiArai | 1:9011c83e4178 | 45 | { |
kenjiArai | 1:9011c83e4178 | 46 | #if 0 |
kenjiArai | 1:9011c83e4178 | 47 | if (mac_1[0] != mac_2[0]) |
kenjiArai | 1:9011c83e4178 | 48 | { |
kenjiArai | 1:9011c83e4178 | 49 | return false; |
kenjiArai | 1:9011c83e4178 | 50 | } |
kenjiArai | 1:9011c83e4178 | 51 | if (mac_1[1] != mac_2[1]) |
kenjiArai | 1:9011c83e4178 | 52 | { |
kenjiArai | 1:9011c83e4178 | 53 | return false; |
kenjiArai | 1:9011c83e4178 | 54 | } |
kenjiArai | 1:9011c83e4178 | 55 | if (mac_1[2] != mac_2[2]) |
kenjiArai | 1:9011c83e4178 | 56 | { |
kenjiArai | 1:9011c83e4178 | 57 | return false; |
kenjiArai | 1:9011c83e4178 | 58 | } |
kenjiArai | 1:9011c83e4178 | 59 | if (mac_1[3] != mac_2[3]) |
kenjiArai | 1:9011c83e4178 | 60 | { |
kenjiArai | 1:9011c83e4178 | 61 | return false; |
kenjiArai | 1:9011c83e4178 | 62 | } |
kenjiArai | 1:9011c83e4178 | 63 | if (mac_1[4] != mac_2[4]) |
kenjiArai | 1:9011c83e4178 | 64 | { |
kenjiArai | 1:9011c83e4178 | 65 | return false; |
kenjiArai | 1:9011c83e4178 | 66 | } |
kenjiArai | 1:9011c83e4178 | 67 | if (mac_1[5] != mac_2[5]) |
kenjiArai | 1:9011c83e4178 | 68 | { |
kenjiArai | 1:9011c83e4178 | 69 | return false; |
kenjiArai | 1:9011c83e4178 | 70 | } |
kenjiArai | 1:9011c83e4178 | 71 | #else |
kenjiArai | 1:9011c83e4178 | 72 | for (int i = 0; i < 6; i++) |
kenjiArai | 1:9011c83e4178 | 73 | { |
kenjiArai | 1:9011c83e4178 | 74 | if (mac_1[i] != mac_2[i]) |
kenjiArai | 1:9011c83e4178 | 75 | { |
kenjiArai | 1:9011c83e4178 | 76 | //pc.printf("0x%02x != 0x%02x at %d\r\n", mac_1[i], mac_2[i], i); |
kenjiArai | 1:9011c83e4178 | 77 | return false; |
kenjiArai | 1:9011c83e4178 | 78 | } |
kenjiArai | 1:9011c83e4178 | 79 | else |
kenjiArai | 1:9011c83e4178 | 80 | { |
kenjiArai | 1:9011c83e4178 | 81 | //pc.printf("0x%02x == 0x%02x at %d\r\n", mac_1[i], mac_2[i], i); |
kenjiArai | 1:9011c83e4178 | 82 | } |
kenjiArai | 1:9011c83e4178 | 83 | } |
kenjiArai | 1:9011c83e4178 | 84 | #endif |
kenjiArai | 1:9011c83e4178 | 85 | return true; |
kenjiArai | 1:9011c83e4178 | 86 | } |
kenjiArai | 1:9011c83e4178 | 87 | |
kenjiArai | 1:9011c83e4178 | 88 | int get_board_index(const Gap::Address_t mac) |
kenjiArai | 1:9011c83e4178 | 89 | { |
kenjiArai | 1:9011c83e4178 | 90 | if (mac_equals(mac, mac_board_0)) |
kenjiArai | 1:9011c83e4178 | 91 | { |
kenjiArai | 1:9011c83e4178 | 92 | return 0; |
kenjiArai | 1:9011c83e4178 | 93 | } |
kenjiArai | 1:9011c83e4178 | 94 | if (mac_equals(mac, mac_board_1)) |
kenjiArai | 1:9011c83e4178 | 95 | { |
kenjiArai | 1:9011c83e4178 | 96 | return 1; |
kenjiArai | 1:9011c83e4178 | 97 | } |
kenjiArai | 1:9011c83e4178 | 98 | if (mac_equals(mac, mac_board_2)) |
kenjiArai | 1:9011c83e4178 | 99 | { |
kenjiArai | 1:9011c83e4178 | 100 | return 2; |
kenjiArai | 1:9011c83e4178 | 101 | } |
kenjiArai | 1:9011c83e4178 | 102 | |
kenjiArai | 1:9011c83e4178 | 103 | return -1; |
kenjiArai | 1:9011c83e4178 | 104 | } |
kenjiArai | 1:9011c83e4178 | 105 | |
kenjiArai | 1:9011c83e4178 | 106 | void periodicCallback(void) |
kenjiArai | 1:9011c83e4178 | 107 | { |
kenjiArai | 1:9011c83e4178 | 108 | alivenessLED = !alivenessLED; /* do blinky on alivenessLED while we're waiting for BLE events */ |
kenjiArai | 1:9011c83e4178 | 109 | } |
kenjiArai | 1:9011c83e4178 | 110 | |
kenjiArai | 1:9011c83e4178 | 111 | |
kenjiArai | 1:9011c83e4178 | 112 | // Mixed role **************************************************** |
kenjiArai | 1:9011c83e4178 | 113 | BLE ble; |
kenjiArai | 1:9011c83e4178 | 114 | Gap::Address_t my_mac; |
kenjiArai | 1:9011c83e4178 | 115 | int my_board_index = -1; |
kenjiArai | 1:9011c83e4178 | 116 | |
kenjiArai | 1:9011c83e4178 | 117 | // Device role **************************************************** |
kenjiArai | 1:9011c83e4178 | 118 | UARTService * uartServicePtr = NULL; |
kenjiArai | 1:9011c83e4178 | 119 | const static char DEVICE_NAME[] = "ChangeMe!!"; // change this |
kenjiArai | 1:9011c83e4178 | 120 | static const uint16_t uuid16_list[] = {UARTServiceShortUUID}; |
kenjiArai | 1:9011c83e4178 | 121 | volatile int central_handle = -1; |
kenjiArai | 1:9011c83e4178 | 122 | |
kenjiArai | 1:9011c83e4178 | 123 | |
kenjiArai | 1:9011c83e4178 | 124 | // Central role **************************************************** |
kenjiArai | 1:9011c83e4178 | 125 | Gap::Handle_t connectionHandle = 0xFFFF; |
kenjiArai | 1:9011c83e4178 | 126 | DiscoveredCharacteristic uartTXCharacteristic; |
kenjiArai | 1:9011c83e4178 | 127 | DiscoveredCharacteristic uartRXCharacteristic; |
kenjiArai | 1:9011c83e4178 | 128 | bool foundUartRXCharacteristic = false; |
kenjiArai | 1:9011c83e4178 | 129 | volatile int device_handle = -1; |
kenjiArai | 1:9011c83e4178 | 130 | |
kenjiArai | 1:9011c83e4178 | 131 | |
kenjiArai | 1:9011c83e4178 | 132 | // Device role **************************************************** |
kenjiArai | 1:9011c83e4178 | 133 | void onReceivedDataFromCentralCallback(const GattWriteCallbackParams *params) |
kenjiArai | 1:9011c83e4178 | 134 | { |
kenjiArai | 1:9011c83e4178 | 135 | if (uartServicePtr != NULL) |
kenjiArai | 1:9011c83e4178 | 136 | { |
kenjiArai | 1:9011c83e4178 | 137 | if ((params->handle == uartServicePtr->getTXCharacteristicHandle()) && (params->len >= 1)) |
kenjiArai | 1:9011c83e4178 | 138 | { |
kenjiArai | 1:9011c83e4178 | 139 | if (params->data[0] != '0') |
kenjiArai | 1:9011c83e4178 | 140 | { |
kenjiArai | 1:9011c83e4178 | 141 | led = 1; |
kenjiArai | 1:9011c83e4178 | 142 | } |
kenjiArai | 1:9011c83e4178 | 143 | else |
kenjiArai | 1:9011c83e4178 | 144 | { |
kenjiArai | 1:9011c83e4178 | 145 | led = 0; |
kenjiArai | 1:9011c83e4178 | 146 | } |
kenjiArai | 1:9011c83e4178 | 147 | |
kenjiArai | 1:9011c83e4178 | 148 | for(int i = 0; i < params->len; i++) |
kenjiArai | 1:9011c83e4178 | 149 | { |
kenjiArai | 1:9011c83e4178 | 150 | pc.printf("%c", params->data[i]); |
kenjiArai | 1:9011c83e4178 | 151 | } |
kenjiArai | 1:9011c83e4178 | 152 | |
kenjiArai | 1:9011c83e4178 | 153 | pc.printf(" (%d, %d)\r\n", params->handle, params->connHandle); |
kenjiArai | 1:9011c83e4178 | 154 | } |
kenjiArai | 1:9011c83e4178 | 155 | } |
kenjiArai | 1:9011c83e4178 | 156 | } |
kenjiArai | 1:9011c83e4178 | 157 | |
kenjiArai | 1:9011c83e4178 | 158 | // Central role **************************************************** |
kenjiArai | 1:9011c83e4178 | 159 | void advertisementCallback(const Gap::AdvertisementCallbackParams_t *params) |
kenjiArai | 1:9011c83e4178 | 160 | { |
kenjiArai | 1:9011c83e4178 | 161 | // do connections like a triangle |
kenjiArai | 1:9011c83e4178 | 162 | int peer_board_index = get_board_index(params->peerAddr); |
kenjiArai | 1:9011c83e4178 | 163 | |
kenjiArai | 1:9011c83e4178 | 164 | int next_board_index = my_board_index + 1; |
kenjiArai | 1:9011c83e4178 | 165 | if (next_board_index >= BOARDS_COUNT) |
kenjiArai | 1:9011c83e4178 | 166 | { |
kenjiArai | 1:9011c83e4178 | 167 | next_board_index = 0; |
kenjiArai | 1:9011c83e4178 | 168 | } |
kenjiArai | 1:9011c83e4178 | 169 | |
kenjiArai | 1:9011c83e4178 | 170 | //pc.printf("adv %d, %d, %d\r\n", peer_board_index, my_board_index, next_board_index); |
kenjiArai | 1:9011c83e4178 | 171 | |
kenjiArai | 1:9011c83e4178 | 172 | // force order |
kenjiArai | 1:9011c83e4178 | 173 | if ((central_handle != -1) || (peer_board_index == 0)) |
kenjiArai | 1:9011c83e4178 | 174 | { |
kenjiArai | 1:9011c83e4178 | 175 | if (peer_board_index == next_board_index) |
kenjiArai | 1:9011c83e4178 | 176 | { |
kenjiArai | 1:9011c83e4178 | 177 | //pc.printf("adv peerAddr[%02x %02x %02x %02x %02x %02x] rssi %d, isScanResponse %u, AdvertisementType %u\r\n", |
kenjiArai | 1:9011c83e4178 | 178 | // params->peerAddr[5], params->peerAddr[4], params->peerAddr[3], params->peerAddr[2], params->peerAddr[1], params->peerAddr[0], |
kenjiArai | 1:9011c83e4178 | 179 | // params->rssi, params->isScanResponse, params->type); |
kenjiArai | 1:9011c83e4178 | 180 | |
kenjiArai | 1:9011c83e4178 | 181 | ble.gap().connect(params->peerAddr, Gap::ADDR_TYPE_RANDOM_STATIC, NULL, NULL); |
kenjiArai | 1:9011c83e4178 | 182 | } |
kenjiArai | 1:9011c83e4178 | 183 | } |
kenjiArai | 1:9011c83e4178 | 184 | } |
kenjiArai | 1:9011c83e4178 | 185 | |
kenjiArai | 1:9011c83e4178 | 186 | void serviceDiscoveryCallback(const DiscoveredService *service) |
kenjiArai | 1:9011c83e4178 | 187 | { |
kenjiArai | 1:9011c83e4178 | 188 | if (service->getUUID().shortOrLong() == UUID::UUID_TYPE_SHORT) |
kenjiArai | 1:9011c83e4178 | 189 | { |
kenjiArai | 1:9011c83e4178 | 190 | pc.printf("S UUID-%x attrs[%u %u]\r\n", service->getUUID().getShortUUID(), service->getStartHandle(), service->getEndHandle()); |
kenjiArai | 1:9011c83e4178 | 191 | } |
kenjiArai | 1:9011c83e4178 | 192 | else |
kenjiArai | 1:9011c83e4178 | 193 | { |
kenjiArai | 1:9011c83e4178 | 194 | //pc.printf("S UUID-"); |
kenjiArai | 1:9011c83e4178 | 195 | const uint8_t *longUUIDBytes = service->getUUID().getBaseUUID(); |
kenjiArai | 1:9011c83e4178 | 196 | for (unsigned i = 0; i < UUID::LENGTH_OF_LONG_UUID; i++) |
kenjiArai | 1:9011c83e4178 | 197 | { |
kenjiArai | 1:9011c83e4178 | 198 | pc.printf("%02x", longUUIDBytes[i]); |
kenjiArai | 1:9011c83e4178 | 199 | } |
kenjiArai | 1:9011c83e4178 | 200 | pc.printf(" attrs[%u %u]\r\n", service->getStartHandle(), service->getEndHandle()); |
kenjiArai | 1:9011c83e4178 | 201 | } |
kenjiArai | 1:9011c83e4178 | 202 | } |
kenjiArai | 1:9011c83e4178 | 203 | |
kenjiArai | 1:9011c83e4178 | 204 | void characteristicDiscoveryCallback(const DiscoveredCharacteristic *characteristicP) |
kenjiArai | 1:9011c83e4178 | 205 | { |
kenjiArai | 1:9011c83e4178 | 206 | //pc.printf(" C UUID-%x valueAttr[%u] props[%x]\r\n", characteristicP->getUUID().getShortUUID(), characteristicP->getValueHandle(), (uint8_t)characteristicP->getProperties().broadcast()); |
kenjiArai | 1:9011c83e4178 | 207 | if (characteristicP->getUUID().getShortUUID() == UARTServiceTXCharacteristicShortUUID) |
kenjiArai | 1:9011c83e4178 | 208 | { |
kenjiArai | 1:9011c83e4178 | 209 | pc.printf("fit TX 0x%04x\r\n", UARTServiceTXCharacteristicShortUUID); |
kenjiArai | 1:9011c83e4178 | 210 | /* !ALERT! Alter this filter to suit your device. */ |
kenjiArai | 1:9011c83e4178 | 211 | uartTXCharacteristic = *characteristicP; |
kenjiArai | 1:9011c83e4178 | 212 | } |
kenjiArai | 1:9011c83e4178 | 213 | else if (characteristicP->getUUID().getShortUUID() == UARTServiceRXCharacteristicShortUUID) |
kenjiArai | 1:9011c83e4178 | 214 | { |
kenjiArai | 1:9011c83e4178 | 215 | pc.printf("fit RX 0x%04x\r\n", UARTServiceRXCharacteristicShortUUID); |
kenjiArai | 1:9011c83e4178 | 216 | /* !ALERT! Alter this filter to suit your device. */ |
kenjiArai | 1:9011c83e4178 | 217 | uartRXCharacteristic = *characteristicP; |
kenjiArai | 1:9011c83e4178 | 218 | foundUartRXCharacteristic = true; |
kenjiArai | 1:9011c83e4178 | 219 | } |
kenjiArai | 1:9011c83e4178 | 220 | } |
kenjiArai | 1:9011c83e4178 | 221 | |
kenjiArai | 1:9011c83e4178 | 222 | void discoveryTerminationCallback(Gap::Handle_t connectionHandle) |
kenjiArai | 1:9011c83e4178 | 223 | { |
kenjiArai | 1:9011c83e4178 | 224 | pc.printf("terminated SD for handle %u\r\n", connectionHandle); |
kenjiArai | 1:9011c83e4178 | 225 | } |
kenjiArai | 1:9011c83e4178 | 226 | |
kenjiArai | 1:9011c83e4178 | 227 | void onReceivedDataFromDeviceCallback(const GattHVXCallbackParams *params) |
kenjiArai | 1:9011c83e4178 | 228 | { |
kenjiArai | 1:9011c83e4178 | 229 | //pc.printf("received HVX callback for handle %u; type %s\r\r\n", params->handle, (params->type == BLE_HVX_NOTIFICATION) ? "notification" : "indication"); |
kenjiArai | 1:9011c83e4178 | 230 | if (params->type == BLE_HVX_NOTIFICATION) |
kenjiArai | 1:9011c83e4178 | 231 | { |
kenjiArai | 1:9011c83e4178 | 232 | if ((params->handle == uartRXCharacteristic.getValueHandle()) && (params->len > 0)) |
kenjiArai | 1:9011c83e4178 | 233 | { |
kenjiArai | 1:9011c83e4178 | 234 | for (int i = 0; i < params->len; i++) |
kenjiArai | 1:9011c83e4178 | 235 | { |
kenjiArai | 1:9011c83e4178 | 236 | pc.printf("%c", params->data[i]); |
kenjiArai | 1:9011c83e4178 | 237 | } |
kenjiArai | 1:9011c83e4178 | 238 | |
kenjiArai | 1:9011c83e4178 | 239 | pc.printf(" (%d, %d)\r\n", params->handle, params->connHandle); |
kenjiArai | 1:9011c83e4178 | 240 | } |
kenjiArai | 1:9011c83e4178 | 241 | } |
kenjiArai | 1:9011c83e4178 | 242 | else |
kenjiArai | 1:9011c83e4178 | 243 | { |
kenjiArai | 1:9011c83e4178 | 244 | pc.printf("%d\r\n", params->type); |
kenjiArai | 1:9011c83e4178 | 245 | } |
kenjiArai | 1:9011c83e4178 | 246 | } |
kenjiArai | 1:9011c83e4178 | 247 | |
kenjiArai | 1:9011c83e4178 | 248 | // Mixed role **************************************************** |
kenjiArai | 1:9011c83e4178 | 249 | void connectionCallback(const Gap::ConnectionCallbackParams_t *params) |
kenjiArai | 1:9011c83e4178 | 250 | { |
kenjiArai | 1:9011c83e4178 | 251 | if (params->role == Gap::CENTRAL) |
kenjiArai | 1:9011c83e4178 | 252 | { |
kenjiArai | 1:9011c83e4178 | 253 | if (central_handle == -1) |
kenjiArai | 1:9011c83e4178 | 254 | { |
kenjiArai | 1:9011c83e4178 | 255 | ble.stopAdvertising(); // stop advertising during discovery, incoming connection breaks discovery |
kenjiArai | 1:9011c83e4178 | 256 | } |
kenjiArai | 1:9011c83e4178 | 257 | |
kenjiArai | 1:9011c83e4178 | 258 | device_handle = params->handle; |
kenjiArai | 1:9011c83e4178 | 259 | pc.printf("connected as central (handle = %d)\r\n\r", params->handle); |
kenjiArai | 1:9011c83e4178 | 260 | connectionHandle = params->handle; |
kenjiArai | 1:9011c83e4178 | 261 | ble.gattClient().onServiceDiscoveryTermination(discoveryTerminationCallback); |
kenjiArai | 1:9011c83e4178 | 262 | int ret = ble.gattClient().launchServiceDiscovery(params->handle, serviceDiscoveryCallback, characteristicDiscoveryCallback, UARTServiceShortUUID/*, 0xa001*/); |
kenjiArai | 1:9011c83e4178 | 263 | |
kenjiArai | 1:9011c83e4178 | 264 | if (ret != BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 265 | { |
kenjiArai | 1:9011c83e4178 | 266 | pc.printf("launchServiceDiscovery failed error = %d\r\n\r", ret); |
kenjiArai | 1:9011c83e4178 | 267 | } |
kenjiArai | 1:9011c83e4178 | 268 | } |
kenjiArai | 1:9011c83e4178 | 269 | else |
kenjiArai | 1:9011c83e4178 | 270 | { |
kenjiArai | 1:9011c83e4178 | 271 | central_handle = params->handle; |
kenjiArai | 1:9011c83e4178 | 272 | pc.printf("connected as device (handle = %d)\r\n\r", params->handle); |
kenjiArai | 1:9011c83e4178 | 273 | |
kenjiArai | 1:9011c83e4178 | 274 | //pc.printf("Conn. params => min=%d, max=%d, slave=%d, supervision=%d\r\n", params->connectionParams->minConnectionInterval, params->connectionParams->maxConnectionInterval, params->connectionParams->slaveLatency, params->connectionParams->connectionSupervisionTimeout); |
kenjiArai | 1:9011c83e4178 | 275 | /* |
kenjiArai | 1:9011c83e4178 | 276 | Gap::ConnectionParams_t connectionParams; |
kenjiArai | 1:9011c83e4178 | 277 | connectionParams.minConnectionInterval = 6; |
kenjiArai | 1:9011c83e4178 | 278 | connectionParams.maxConnectionInterval = 12; |
kenjiArai | 1:9011c83e4178 | 279 | connectionParams.slaveLatency = 40; |
kenjiArai | 1:9011c83e4178 | 280 | connectionParams.connectionSupervisionTimeout = 500; |
kenjiArai | 1:9011c83e4178 | 281 | |
kenjiArai | 1:9011c83e4178 | 282 | int ret = ble.updateConnectionParams(params->handle, &connectionParams); |
kenjiArai | 1:9011c83e4178 | 283 | if (ret != BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 284 | { |
kenjiArai | 1:9011c83e4178 | 285 | pc.printf("failed to update connection parameter\r\n"); |
kenjiArai | 1:9011c83e4178 | 286 | } |
kenjiArai | 1:9011c83e4178 | 287 | */ |
kenjiArai | 1:9011c83e4178 | 288 | } |
kenjiArai | 1:9011c83e4178 | 289 | pc.printf("own %02x:%02x:%02x:%02x:%02x:%02x (%s), peer %02x:%02x:%02x:%02x:%02x:%02x (%s)\r\n", params->ownAddr[5], params->ownAddr[4], params->ownAddr[3], params->ownAddr[2], params->ownAddr[1], params->ownAddr[0], (params->ownAddrType == Gap::ADDR_TYPE_PUBLIC) ? "public" : "random", params->peerAddr[5], params->peerAddr[4], params->peerAddr[3], params->peerAddr[2], params->peerAddr[1], params->peerAddr[0], (params->peerAddrType == Gap::ADDR_TYPE_PUBLIC) ? "public" : "random"); |
kenjiArai | 1:9011c83e4178 | 290 | } |
kenjiArai | 1:9011c83e4178 | 291 | |
kenjiArai | 1:9011c83e4178 | 292 | void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason) |
kenjiArai | 1:9011c83e4178 | 293 | { |
kenjiArai | 1:9011c83e4178 | 294 | char * ascii_reason = "?"; |
kenjiArai | 1:9011c83e4178 | 295 | switch (reason) |
kenjiArai | 1:9011c83e4178 | 296 | { |
kenjiArai | 1:9011c83e4178 | 297 | case Gap::CONNECTION_TIMEOUT: |
kenjiArai | 1:9011c83e4178 | 298 | ascii_reason = "connection timeout"; |
kenjiArai | 1:9011c83e4178 | 299 | break; |
kenjiArai | 1:9011c83e4178 | 300 | case Gap::REMOTE_USER_TERMINATED_CONNECTION: |
kenjiArai | 1:9011c83e4178 | 301 | ascii_reason = "user terminated connection"; |
kenjiArai | 1:9011c83e4178 | 302 | break; |
kenjiArai | 1:9011c83e4178 | 303 | case Gap::REMOTE_DEV_TERMINATION_DUE_TO_LOW_RESOURCES: |
kenjiArai | 1:9011c83e4178 | 304 | ascii_reason = "low resources"; |
kenjiArai | 1:9011c83e4178 | 305 | break; |
kenjiArai | 1:9011c83e4178 | 306 | case Gap::REMOTE_DEV_TERMINATION_DUE_TO_POWER_OFF: |
kenjiArai | 1:9011c83e4178 | 307 | ascii_reason = "power off"; |
kenjiArai | 1:9011c83e4178 | 308 | break; |
kenjiArai | 1:9011c83e4178 | 309 | case Gap::LOCAL_HOST_TERMINATED_CONNECTION: |
kenjiArai | 1:9011c83e4178 | 310 | ascii_reason = "host terminated connection"; |
kenjiArai | 1:9011c83e4178 | 311 | break; |
kenjiArai | 1:9011c83e4178 | 312 | case Gap::CONN_INTERVAL_UNACCEPTABLE: |
kenjiArai | 1:9011c83e4178 | 313 | ascii_reason = "interval unacceptable"; |
kenjiArai | 1:9011c83e4178 | 314 | break; |
kenjiArai | 1:9011c83e4178 | 315 | default: |
kenjiArai | 1:9011c83e4178 | 316 | ascii_reason = "unknown"; |
kenjiArai | 1:9011c83e4178 | 317 | break; |
kenjiArai | 1:9011c83e4178 | 318 | } |
kenjiArai | 1:9011c83e4178 | 319 | |
kenjiArai | 1:9011c83e4178 | 320 | pc.printf("disconnected (reason = %s, handle = %d)\r\n", ascii_reason, handle); |
kenjiArai | 1:9011c83e4178 | 321 | |
kenjiArai | 1:9011c83e4178 | 322 | |
kenjiArai | 1:9011c83e4178 | 323 | if (handle == SOFT_DEVICE_FATHER_HANDLE) |
kenjiArai | 1:9011c83e4178 | 324 | { |
kenjiArai | 1:9011c83e4178 | 325 | central_handle = -1; |
kenjiArai | 1:9011c83e4178 | 326 | // restart advertising |
kenjiArai | 1:9011c83e4178 | 327 | ble.startAdvertising(); |
kenjiArai | 1:9011c83e4178 | 328 | } |
kenjiArai | 1:9011c83e4178 | 329 | else |
kenjiArai | 1:9011c83e4178 | 330 | { |
kenjiArai | 1:9011c83e4178 | 331 | device_handle = -1; |
kenjiArai | 1:9011c83e4178 | 332 | // restart scan |
kenjiArai | 1:9011c83e4178 | 333 | ble.gap().startScan(advertisementCallback); |
kenjiArai | 1:9011c83e4178 | 334 | } |
kenjiArai | 1:9011c83e4178 | 335 | } |
kenjiArai | 1:9011c83e4178 | 336 | |
kenjiArai | 1:9011c83e4178 | 337 | |
kenjiArai | 1:9011c83e4178 | 338 | |
kenjiArai | 1:9011c83e4178 | 339 | void serialTxCallback() |
kenjiArai | 1:9011c83e4178 | 340 | { |
kenjiArai | 1:9011c83e4178 | 341 | |
kenjiArai | 1:9011c83e4178 | 342 | } |
kenjiArai | 1:9011c83e4178 | 343 | |
kenjiArai | 1:9011c83e4178 | 344 | int rx_char = -1; |
kenjiArai | 1:9011c83e4178 | 345 | void serialRxCallback() |
kenjiArai | 1:9011c83e4178 | 346 | { |
kenjiArai | 1:9011c83e4178 | 347 | if (rx_char != -1) |
kenjiArai | 1:9011c83e4178 | 348 | { |
kenjiArai | 1:9011c83e4178 | 349 | pc.printf("overflow\r\n"); |
kenjiArai | 1:9011c83e4178 | 350 | } |
kenjiArai | 1:9011c83e4178 | 351 | |
kenjiArai | 1:9011c83e4178 | 352 | //computer.putc(computer.getc()); |
kenjiArai | 1:9011c83e4178 | 353 | rx_char = pc.getc(); |
kenjiArai | 1:9011c83e4178 | 354 | } |
kenjiArai | 1:9011c83e4178 | 355 | |
kenjiArai | 1:9011c83e4178 | 356 | /* |
kenjiArai | 1:9011c83e4178 | 357 | void gattServerOnDataSent(unsigned count) |
kenjiArai | 1:9011c83e4178 | 358 | { |
kenjiArai | 1:9011c83e4178 | 359 | |
kenjiArai | 1:9011c83e4178 | 360 | } |
kenjiArai | 1:9011c83e4178 | 361 | */ |
kenjiArai | 1:9011c83e4178 | 362 | |
kenjiArai | 1:9011c83e4178 | 363 | |
kenjiArai | 1:9011c83e4178 | 364 | int main(void) |
kenjiArai | 1:9011c83e4178 | 365 | { |
kenjiArai | 1:9011c83e4178 | 366 | alivenessLED = 0; |
kenjiArai | 1:9011c83e4178 | 367 | |
kenjiArai | 1:9011c83e4178 | 368 | pc.baud(115200); |
kenjiArai | 1:9011c83e4178 | 369 | //pc.attach(&serialTxCallback, Serial::TxIrq); |
kenjiArai | 1:9011c83e4178 | 370 | pc.attach(&serialRxCallback, Serial::RxIrq); |
kenjiArai | 1:9011c83e4178 | 371 | |
kenjiArai | 1:9011c83e4178 | 372 | // clear terminal output |
kenjiArai | 1:9011c83e4178 | 373 | for (int k = 0; k < 32; k++) |
kenjiArai | 1:9011c83e4178 | 374 | { |
kenjiArai | 1:9011c83e4178 | 375 | pc.printf("\r\n"); |
kenjiArai | 1:9011c83e4178 | 376 | } |
kenjiArai | 1:9011c83e4178 | 377 | |
kenjiArai | 1:9011c83e4178 | 378 | pc.printf("Central and device\r\n"); |
kenjiArai | 1:9011c83e4178 | 379 | |
kenjiArai | 1:9011c83e4178 | 380 | Ticker ticker; |
kenjiArai | 1:9011c83e4178 | 381 | ticker.attach(periodicCallback, 1); |
kenjiArai | 1:9011c83e4178 | 382 | |
kenjiArai | 1:9011c83e4178 | 383 | |
kenjiArai | 1:9011c83e4178 | 384 | // Mixed role **************************************************** |
kenjiArai | 1:9011c83e4178 | 385 | ble.init(); |
kenjiArai | 1:9011c83e4178 | 386 | |
kenjiArai | 1:9011c83e4178 | 387 | Gap::AddressType_t my_mac_type; |
kenjiArai | 1:9011c83e4178 | 388 | ble.gap().getAddress(&my_mac_type, my_mac); |
kenjiArai | 1:9011c83e4178 | 389 | my_board_index = get_board_index(my_mac); |
kenjiArai | 1:9011c83e4178 | 390 | pc.printf("me %02x:%02x:%02x:%02x:%02x:%02x (%s)\r\n", my_mac[5], my_mac[4], my_mac[3], my_mac[2], my_mac[1], my_mac[0], (my_mac_type == Gap::ADDR_TYPE_PUBLIC) ? "public" : "random"); |
kenjiArai | 1:9011c83e4178 | 391 | |
kenjiArai | 1:9011c83e4178 | 392 | |
kenjiArai | 1:9011c83e4178 | 393 | // try to speed up but looks like if it was ignored |
kenjiArai | 1:9011c83e4178 | 394 | Gap::ConnectionParams_t fast; |
kenjiArai | 1:9011c83e4178 | 395 | if (ble.getPreferredConnectionParams(&fast) != BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 396 | { |
kenjiArai | 1:9011c83e4178 | 397 | pc.printf("getPreferredConnectionParams failed\r\n"); |
kenjiArai | 1:9011c83e4178 | 398 | } |
kenjiArai | 1:9011c83e4178 | 399 | else |
kenjiArai | 1:9011c83e4178 | 400 | { |
kenjiArai | 1:9011c83e4178 | 401 | fast.minConnectionInterval = 16; // 20 ms |
kenjiArai | 1:9011c83e4178 | 402 | fast.maxConnectionInterval = 32; // 40 ms |
kenjiArai | 1:9011c83e4178 | 403 | fast.slaveLatency = 0; |
kenjiArai | 1:9011c83e4178 | 404 | if (ble.gap().setPreferredConnectionParams(&fast) != BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 405 | { |
kenjiArai | 1:9011c83e4178 | 406 | pc.printf("setPreferredConnectionParams failed\r\n"); |
kenjiArai | 1:9011c83e4178 | 407 | } |
kenjiArai | 1:9011c83e4178 | 408 | } |
kenjiArai | 1:9011c83e4178 | 409 | ble.gap().onConnection(connectionCallback); |
kenjiArai | 1:9011c83e4178 | 410 | ble.gap().onDisconnection(disconnectionCallback); |
kenjiArai | 1:9011c83e4178 | 411 | |
kenjiArai | 1:9011c83e4178 | 412 | // Device role **************************************************** |
kenjiArai | 1:9011c83e4178 | 413 | ble.gattServer().onDataWritten(onReceivedDataFromCentralCallback); |
kenjiArai | 1:9011c83e4178 | 414 | //ble.gattServer().onDataSent(gattServerOnDataSent); |
kenjiArai | 1:9011c83e4178 | 415 | |
kenjiArai | 1:9011c83e4178 | 416 | UARTService uartService(ble); |
kenjiArai | 1:9011c83e4178 | 417 | uartServicePtr = &uartService; |
kenjiArai | 1:9011c83e4178 | 418 | |
kenjiArai | 1:9011c83e4178 | 419 | // setup advertising |
kenjiArai | 1:9011c83e4178 | 420 | ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); // BLE only, no classic BT |
kenjiArai | 1:9011c83e4178 | 421 | ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME)); // add name |
kenjiArai | 1:9011c83e4178 | 422 | ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list)); // UUID's broadcast in advertising packet |
kenjiArai | 1:9011c83e4178 | 423 | ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); // advertising type |
kenjiArai | 1:9011c83e4178 | 424 | ble.setAdvertisingInterval(100); |
kenjiArai | 1:9011c83e4178 | 425 | |
kenjiArai | 1:9011c83e4178 | 426 | // Central role **************************************************** |
kenjiArai | 1:9011c83e4178 | 427 | ble.gattClient().onHVX(onReceivedDataFromDeviceCallback); |
kenjiArai | 1:9011c83e4178 | 428 | ble.gap().setScanParams(500, 450); |
kenjiArai | 1:9011c83e4178 | 429 | |
kenjiArai | 1:9011c83e4178 | 430 | |
kenjiArai | 1:9011c83e4178 | 431 | // start advertising and scan |
kenjiArai | 1:9011c83e4178 | 432 | ble.startAdvertising(); |
kenjiArai | 1:9011c83e4178 | 433 | ble.gap().startScan(advertisementCallback); |
kenjiArai | 1:9011c83e4178 | 434 | |
kenjiArai | 1:9011c83e4178 | 435 | while (true) |
kenjiArai | 1:9011c83e4178 | 436 | { |
kenjiArai | 1:9011c83e4178 | 437 | // allow notifications from device |
kenjiArai | 1:9011c83e4178 | 438 | if (foundUartRXCharacteristic && !ble.gattClient().isServiceDiscoveryActive()) |
kenjiArai | 1:9011c83e4178 | 439 | { |
kenjiArai | 1:9011c83e4178 | 440 | foundUartRXCharacteristic = false; /* need to do the following only once */ |
kenjiArai | 1:9011c83e4178 | 441 | |
kenjiArai | 1:9011c83e4178 | 442 | uint16_t value = BLE_HVX_NOTIFICATION; |
kenjiArai | 1:9011c83e4178 | 443 | int ret = ble.gattClient().write(GattClient::GATT_OP_WRITE_REQ, |
kenjiArai | 1:9011c83e4178 | 444 | connectionHandle, |
kenjiArai | 1:9011c83e4178 | 445 | uartRXCharacteristic.getValueHandle() + 1, /* HACK Alert. We're assuming that CCCD descriptor immediately follows the value attribute. */ |
kenjiArai | 1:9011c83e4178 | 446 | sizeof(uint16_t), /* HACK Alert! size should be made into a BLE_API constant. */ |
kenjiArai | 1:9011c83e4178 | 447 | reinterpret_cast<const uint8_t *>(&value)); |
kenjiArai | 1:9011c83e4178 | 448 | |
kenjiArai | 1:9011c83e4178 | 449 | if (ret == BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 450 | { |
kenjiArai | 1:9011c83e4178 | 451 | pc.printf("\r\ndevice notifications enabled\r\n"); |
kenjiArai | 1:9011c83e4178 | 452 | } |
kenjiArai | 1:9011c83e4178 | 453 | else |
kenjiArai | 1:9011c83e4178 | 454 | { |
kenjiArai | 1:9011c83e4178 | 455 | switch (ret) |
kenjiArai | 1:9011c83e4178 | 456 | { |
kenjiArai | 1:9011c83e4178 | 457 | case BLE_STACK_BUSY: |
kenjiArai | 1:9011c83e4178 | 458 | foundUartRXCharacteristic = true; // retry later |
kenjiArai | 1:9011c83e4178 | 459 | break; |
kenjiArai | 1:9011c83e4178 | 460 | case BLE_ERROR_NO_MEM: |
kenjiArai | 1:9011c83e4178 | 461 | foundUartRXCharacteristic = true; // retry later |
kenjiArai | 1:9011c83e4178 | 462 | break; |
kenjiArai | 1:9011c83e4178 | 463 | case BLE_ERROR_INVALID_STATE: |
kenjiArai | 1:9011c83e4178 | 464 | pc.printf("\r\ndevice notifications enable failed\r\n"); |
kenjiArai | 1:9011c83e4178 | 465 | break; |
kenjiArai | 1:9011c83e4178 | 466 | default: |
kenjiArai | 1:9011c83e4178 | 467 | break; |
kenjiArai | 1:9011c83e4178 | 468 | } |
kenjiArai | 1:9011c83e4178 | 469 | } |
kenjiArai | 1:9011c83e4178 | 470 | |
kenjiArai | 1:9011c83e4178 | 471 | if (!foundUartRXCharacteristic) |
kenjiArai | 1:9011c83e4178 | 472 | { |
kenjiArai | 1:9011c83e4178 | 473 | if (central_handle == -1) |
kenjiArai | 1:9011c83e4178 | 474 | { |
kenjiArai | 1:9011c83e4178 | 475 | ble.startAdvertising(); |
kenjiArai | 1:9011c83e4178 | 476 | } |
kenjiArai | 1:9011c83e4178 | 477 | } |
kenjiArai | 1:9011c83e4178 | 478 | } |
kenjiArai | 1:9011c83e4178 | 479 | |
kenjiArai | 1:9011c83e4178 | 480 | // while a new char from computer is available |
kenjiArai | 1:9011c83e4178 | 481 | while (rx_char != -1) |
kenjiArai | 1:9011c83e4178 | 482 | { |
kenjiArai | 1:9011c83e4178 | 483 | uint8_t temp[20]; |
kenjiArai | 1:9011c83e4178 | 484 | int length = 1; |
kenjiArai | 1:9011c83e4178 | 485 | |
kenjiArai | 1:9011c83e4178 | 486 | uint8_t command = rx_char; |
kenjiArai | 1:9011c83e4178 | 487 | rx_char = -1; |
kenjiArai | 1:9011c83e4178 | 488 | |
kenjiArai | 1:9011c83e4178 | 489 | // if special char to test a 20 bytes frame |
kenjiArai | 1:9011c83e4178 | 490 | /* |
kenjiArai | 1:9011c83e4178 | 491 | if (command == '*') |
kenjiArai | 1:9011c83e4178 | 492 | { |
kenjiArai | 1:9011c83e4178 | 493 | pc.printf("20 chars\r\n"); |
kenjiArai | 1:9011c83e4178 | 494 | |
kenjiArai | 1:9011c83e4178 | 495 | int c = 0; |
kenjiArai | 1:9011c83e4178 | 496 | for (c = 0; c < 20; c++) |
kenjiArai | 1:9011c83e4178 | 497 | { |
kenjiArai | 1:9011c83e4178 | 498 | temp[c] = 'a' + c; |
kenjiArai | 1:9011c83e4178 | 499 | } |
kenjiArai | 1:9011c83e4178 | 500 | length = 20; |
kenjiArai | 1:9011c83e4178 | 501 | } |
kenjiArai | 1:9011c83e4178 | 502 | else |
kenjiArai | 1:9011c83e4178 | 503 | { |
kenjiArai | 1:9011c83e4178 | 504 | temp[0] = command; |
kenjiArai | 1:9011c83e4178 | 505 | } |
kenjiArai | 1:9011c83e4178 | 506 | */ |
kenjiArai | 1:9011c83e4178 | 507 | temp[0] = command; |
kenjiArai | 1:9011c83e4178 | 508 | |
kenjiArai | 1:9011c83e4178 | 509 | // to central |
kenjiArai | 1:9011c83e4178 | 510 | //if (command == '1') |
kenjiArai | 1:9011c83e4178 | 511 | { |
kenjiArai | 1:9011c83e4178 | 512 | if (central_handle != -1) |
kenjiArai | 1:9011c83e4178 | 513 | { |
kenjiArai | 1:9011c83e4178 | 514 | // device to central |
kenjiArai | 1:9011c83e4178 | 515 | while (1) |
kenjiArai | 1:9011c83e4178 | 516 | { |
kenjiArai | 1:9011c83e4178 | 517 | if (central_handle == -1) |
kenjiArai | 1:9011c83e4178 | 518 | { |
kenjiArai | 1:9011c83e4178 | 519 | pc.printf("\r\ndisconnected 1 (to central)\r\n"); |
kenjiArai | 1:9011c83e4178 | 520 | break; |
kenjiArai | 1:9011c83e4178 | 521 | } |
kenjiArai | 1:9011c83e4178 | 522 | if (!ble.gap().getState().connected) |
kenjiArai | 1:9011c83e4178 | 523 | { |
kenjiArai | 1:9011c83e4178 | 524 | pc.printf("\r\ndisconnected 2 (to central)\r\n"); |
kenjiArai | 1:9011c83e4178 | 525 | break; |
kenjiArai | 1:9011c83e4178 | 526 | } |
kenjiArai | 1:9011c83e4178 | 527 | int ret = ble.gattServer().write(uartServicePtr->getRXCharacteristicHandle(), temp, length); |
kenjiArai | 1:9011c83e4178 | 528 | |
kenjiArai | 1:9011c83e4178 | 529 | if (ret == BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 530 | { |
kenjiArai | 1:9011c83e4178 | 531 | //pc.printf("\r\nok (to central)\r\n"); |
kenjiArai | 1:9011c83e4178 | 532 | break; |
kenjiArai | 1:9011c83e4178 | 533 | } |
kenjiArai | 1:9011c83e4178 | 534 | else if (ret == BLE_STACK_BUSY) |
kenjiArai | 1:9011c83e4178 | 535 | { |
kenjiArai | 1:9011c83e4178 | 536 | //pc.printf("\r\nbusy (to central)\r\n"); |
kenjiArai | 1:9011c83e4178 | 537 | //break; |
kenjiArai | 1:9011c83e4178 | 538 | } |
kenjiArai | 1:9011c83e4178 | 539 | else if (ret == BLE_ERROR_OPERATION_NOT_PERMITTED) |
kenjiArai | 1:9011c83e4178 | 540 | { |
kenjiArai | 1:9011c83e4178 | 541 | pc.printf("\r\nnot permitted (to central)\r\n"); |
kenjiArai | 1:9011c83e4178 | 542 | break; |
kenjiArai | 1:9011c83e4178 | 543 | } |
kenjiArai | 1:9011c83e4178 | 544 | else if (ret == BLE_ERROR_INVALID_STATE) |
kenjiArai | 1:9011c83e4178 | 545 | { |
kenjiArai | 1:9011c83e4178 | 546 | pc.printf("\r\ninvalid state (to central)\r\n"); |
kenjiArai | 1:9011c83e4178 | 547 | break; |
kenjiArai | 1:9011c83e4178 | 548 | } |
kenjiArai | 1:9011c83e4178 | 549 | else |
kenjiArai | 1:9011c83e4178 | 550 | { |
kenjiArai | 1:9011c83e4178 | 551 | pc.printf("\r\ncode %d (to central)\r\n", ret); |
kenjiArai | 1:9011c83e4178 | 552 | break; |
kenjiArai | 1:9011c83e4178 | 553 | } |
kenjiArai | 1:9011c83e4178 | 554 | } |
kenjiArai | 1:9011c83e4178 | 555 | } |
kenjiArai | 1:9011c83e4178 | 556 | else |
kenjiArai | 1:9011c83e4178 | 557 | { |
kenjiArai | 1:9011c83e4178 | 558 | pc.printf("\r\nnot connected with central\r\n"); |
kenjiArai | 1:9011c83e4178 | 559 | } |
kenjiArai | 1:9011c83e4178 | 560 | } |
kenjiArai | 1:9011c83e4178 | 561 | |
kenjiArai | 1:9011c83e4178 | 562 | // to device |
kenjiArai | 1:9011c83e4178 | 563 | //if (command == '2') |
kenjiArai | 1:9011c83e4178 | 564 | { |
kenjiArai | 1:9011c83e4178 | 565 | if (device_handle != -1) |
kenjiArai | 1:9011c83e4178 | 566 | { |
kenjiArai | 1:9011c83e4178 | 567 | // central to device |
kenjiArai | 1:9011c83e4178 | 568 | while (1) |
kenjiArai | 1:9011c83e4178 | 569 | { |
kenjiArai | 1:9011c83e4178 | 570 | if (device_handle == -1) |
kenjiArai | 1:9011c83e4178 | 571 | { |
kenjiArai | 1:9011c83e4178 | 572 | pc.printf("\r\ndisconnected (to device)\r\n"); |
kenjiArai | 1:9011c83e4178 | 573 | break; |
kenjiArai | 1:9011c83e4178 | 574 | } |
kenjiArai | 1:9011c83e4178 | 575 | int ret = uartTXCharacteristic.write(length, temp); |
kenjiArai | 1:9011c83e4178 | 576 | if (ret == BLE_ERROR_NONE) |
kenjiArai | 1:9011c83e4178 | 577 | { |
kenjiArai | 1:9011c83e4178 | 578 | //pc.printf("\r\nok (to device)\r\n"); |
kenjiArai | 1:9011c83e4178 | 579 | break; |
kenjiArai | 1:9011c83e4178 | 580 | } |
kenjiArai | 1:9011c83e4178 | 581 | else if (ret == BLE_STACK_BUSY) |
kenjiArai | 1:9011c83e4178 | 582 | { |
kenjiArai | 1:9011c83e4178 | 583 | //pc.printf("\r\nbusy (to device)\r\n"); |
kenjiArai | 1:9011c83e4178 | 584 | //break; |
kenjiArai | 1:9011c83e4178 | 585 | } |
kenjiArai | 1:9011c83e4178 | 586 | else if (ret == BLE_ERROR_OPERATION_NOT_PERMITTED) |
kenjiArai | 1:9011c83e4178 | 587 | { |
kenjiArai | 1:9011c83e4178 | 588 | pc.printf("\r\nnot permitted (to device)\r\n"); |
kenjiArai | 1:9011c83e4178 | 589 | break; |
kenjiArai | 1:9011c83e4178 | 590 | } |
kenjiArai | 1:9011c83e4178 | 591 | else if (ret == BLE_ERROR_INVALID_STATE) |
kenjiArai | 1:9011c83e4178 | 592 | { |
kenjiArai | 1:9011c83e4178 | 593 | pc.printf("\r\ninvalid state (to device)\r\n"); |
kenjiArai | 1:9011c83e4178 | 594 | break; |
kenjiArai | 1:9011c83e4178 | 595 | } |
kenjiArai | 1:9011c83e4178 | 596 | else |
kenjiArai | 1:9011c83e4178 | 597 | { |
kenjiArai | 1:9011c83e4178 | 598 | pc.printf("\r\ncode %d (to device)\r\n", ret); |
kenjiArai | 1:9011c83e4178 | 599 | break; |
kenjiArai | 1:9011c83e4178 | 600 | } |
kenjiArai | 1:9011c83e4178 | 601 | } |
kenjiArai | 1:9011c83e4178 | 602 | } |
kenjiArai | 1:9011c83e4178 | 603 | else |
kenjiArai | 1:9011c83e4178 | 604 | { |
kenjiArai | 1:9011c83e4178 | 605 | pc.printf("\r\nnot connected with device\r\n"); |
kenjiArai | 1:9011c83e4178 | 606 | } |
kenjiArai | 1:9011c83e4178 | 607 | } |
kenjiArai | 1:9011c83e4178 | 608 | } |
kenjiArai | 1:9011c83e4178 | 609 | |
kenjiArai | 1:9011c83e4178 | 610 | ble.waitForEvent(); // save power |
kenjiArai | 1:9011c83e4178 | 611 | } |
kenjiArai | 1:9011c83e4178 | 612 | } |
kenjiArai | 1:9011c83e4178 | 613 | |
kenjiArai | 1:9011c83e4178 | 614 | #endif |