Serqet2 / Mbed 2 deprecated serqet2

serqet2

Dependencies:   BLE_API circular_buffer mbed nRF51822

Fork of serqet by Serqet

main.cpp@2:ddf1f6325a37, 2015-03-19 (annotated)

Committer:
aadavids
Date:
Thu Mar 19 03:19:23 2015 +0000
Revision:
2:ddf1f6325a37
Parent:
1:81a97eb70d3d
Child:
3:6c83be282aac
initial wip;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
RedBearLab 1:81a97eb70d3d 1 /*
RedBearLab 1:81a97eb70d3d 2
RedBearLab 1:81a97eb70d3d 3 Copyright (c) 2012-2014 RedBearLab
RedBearLab 1:81a97eb70d3d 4
RedBearLab 1:81a97eb70d3d 5 Permission is hereby granted, free of charge, to any person obtaining a copy of this software
RedBearLab 1:81a97eb70d3d 6 and associated documentation files (the "Software"), to deal in the Software without restriction,
RedBearLab 1:81a97eb70d3d 7 including without limitation the rights to use, copy, modify, merge, publish, distribute, sublicense,
RedBearLab 1:81a97eb70d3d 8 and/or sell copies of the Software, and to permit persons to whom the Software is furnished to do so,
RedBearLab 1:81a97eb70d3d 9 subject to the following conditions:
RedBearLab 1:81a97eb70d3d 10 The above copyright notice and this permission notice shall be included in all copies or substantial portions of the Software.
RedBearLab 1:81a97eb70d3d 11
RedBearLab 1:81a97eb70d3d 12 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED,
RedBearLab 1:81a97eb70d3d 13 INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR
RedBearLab 1:81a97eb70d3d 14 PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE
RedBearLab 1:81a97eb70d3d 15 FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
RedBearLab 1:81a97eb70d3d 16 ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
RedBearLab 1:81a97eb70d3d 17
RedBearLab 1:81a97eb70d3d 18 */
RedBearLab 0:be2e4095513a 19
RedBearLab 0:be2e4095513a 20 #include "mbed.h"
RedBearLab 0:be2e4095513a 21 #include "BLEDevice.h"
RedBearLab 0:be2e4095513a 22
RedBearLab 0:be2e4095513a 23 #define BLE_UUID_TXRX_SERVICE 0x0000 /**< The UUID of the Nordic UART Service. */
RedBearLab 0:be2e4095513a 24 #define BLE_UUID_TX_CHARACTERISTIC 0x0002 /**< The UUID of the TX Characteristic. */
RedBearLab 0:be2e4095513a 25 #define BLE_UUIDS_RX_CHARACTERISTIC 0x0003 /**< The UUID of the RX Characteristic. */
RedBearLab 0:be2e4095513a 26
RedBearLab 0:be2e4095513a 27 #define TXRX_BUF_LEN 20
RedBearLab 0:be2e4095513a 28
RedBearLab 0:be2e4095513a 29 #define DIGITAL_OUT_PIN P0_9 //TXD
RedBearLab 0:be2e4095513a 30 #define DIGITAL_IN_PIN P0_10 //CTS
RedBearLab 0:be2e4095513a 31 #define PWM_PIN P0_11 //RXD
RedBearLab 0:be2e4095513a 32 #define ANALOG_IN_PIN P0_4 //P04
RedBearLab 0:be2e4095513a 33
aadavids 2:ddf1f6325a37 34
aadavids 2:ddf1f6325a37 35
RedBearLab 0:be2e4095513a 36 BLEDevice ble;
RedBearLab 0:be2e4095513a 37
RedBearLab 0:be2e4095513a 38 DigitalOut LED_SET(DIGITAL_OUT_PIN);
RedBearLab 0:be2e4095513a 39 DigitalIn BUTTON(DIGITAL_IN_PIN);
RedBearLab 0:be2e4095513a 40 PwmOut PWM(PWM_PIN);
RedBearLab 0:be2e4095513a 41 AnalogIn ANALOG(ANALOG_IN_PIN);
RedBearLab 0:be2e4095513a 42 Servo MYSERVO(SERVO_PIN);
RedBearLab 0:be2e4095513a 43
RedBearLab 0:be2e4095513a 44 //Serial pc(USBTX, USBRX);
RedBearLab 0:be2e4095513a 45
RedBearLab 0:be2e4095513a 46 static uint8_t analog_enabled = 0;
RedBearLab 0:be2e4095513a 47 static uint8_t old_state = 0;
RedBearLab 0:be2e4095513a 48
RedBearLab 0:be2e4095513a 49 // The Nordic UART Service
RedBearLab 0:be2e4095513a 50 static const uint8_t uart_base_uuid[] = {0x71, 0x3D, 0, 0, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
RedBearLab 0:be2e4095513a 51 static const uint8_t uart_tx_uuid[] = {0x71, 0x3D, 0, 3, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
RedBearLab 0:be2e4095513a 52 static const uint8_t uart_rx_uuid[] = {0x71, 0x3D, 0, 2, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E};
RedBearLab 0:be2e4095513a 53 static const uint8_t uart_base_uuid_rev[] = {0x1E, 0x94, 0x8D, 0xF1, 0x48, 0x31, 0x94, 0xBA, 0x75, 0x4C, 0x3E, 0x50, 0, 0, 0x3D, 0x71};
RedBearLab 0:be2e4095513a 54
RedBearLab 0:be2e4095513a 55
RedBearLab 0:be2e4095513a 56 uint8_t txPayload[TXRX_BUF_LEN] = {0,};
RedBearLab 0:be2e4095513a 57 uint8_t rxPayload[TXRX_BUF_LEN] = {0,};
RedBearLab 0:be2e4095513a 58
RedBearLab 0:be2e4095513a 59 //static uint8_t rx_buf[TXRX_BUF_LEN];
RedBearLab 0:be2e4095513a 60 //static uint8_t rx_len=0;
RedBearLab 0:be2e4095513a 61
RedBearLab 0:be2e4095513a 62
RedBearLab 0:be2e4095513a 63 GattCharacteristic txCharacteristic (uart_tx_uuid, txPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE);
RedBearLab 0:be2e4095513a 64
RedBearLab 0:be2e4095513a 65 GattCharacteristic rxCharacteristic (uart_rx_uuid, rxPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
RedBearLab 0:be2e4095513a 66
RedBearLab 0:be2e4095513a 67 GattCharacteristic *uartChars[] = {&txCharacteristic, &rxCharacteristic};
RedBearLab 0:be2e4095513a 68
RedBearLab 0:be2e4095513a 69 GattService uartService(uart_base_uuid, uartChars, sizeof(uartChars) / sizeof(GattCharacteristic *));
RedBearLab 0:be2e4095513a 70
RedBearLab 0:be2e4095513a 71
RedBearLab 0:be2e4095513a 72
RedBearLab 0:be2e4095513a 73 void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason)
RedBearLab 0:be2e4095513a 74 {
RedBearLab 0:be2e4095513a 75 //pc.printf("Disconnected \r\n");
RedBearLab 0:be2e4095513a 76 //pc.printf("Restart advertising \r\n");
RedBearLab 0:be2e4095513a 77 ble.startAdvertising();
RedBearLab 0:be2e4095513a 78 }
RedBearLab 0:be2e4095513a 79
RedBearLab 0:be2e4095513a 80 void WrittenHandler(const GattCharacteristicWriteCBParams *Handler)
RedBearLab 0:be2e4095513a 81 {
RedBearLab 0:be2e4095513a 82 uint8_t buf[TXRX_BUF_LEN];
RedBearLab 0:be2e4095513a 83 uint16_t bytesRead;
RedBearLab 0:be2e4095513a 84
RedBearLab 0:be2e4095513a 85 if (Handler->charHandle == txCharacteristic.getValueAttribute().getHandle())
RedBearLab 0:be2e4095513a 86 {
RedBearLab 0:be2e4095513a 87 ble.readCharacteristicValue(txCharacteristic.getValueAttribute().getHandle(), buf, &bytesRead);
RedBearLab 0:be2e4095513a 88 memset(txPayload, 0, TXRX_BUF_LEN);
RedBearLab 0:be2e4095513a 89 memcpy(txPayload, buf, TXRX_BUF_LEN);
RedBearLab 0:be2e4095513a 90
RedBearLab 0:be2e4095513a 91 //for(index=0; index<bytesRead; index++)
RedBearLab 0:be2e4095513a 92 //pc.putc(buf[index]);
RedBearLab 0:be2e4095513a 93
RedBearLab 0:be2e4095513a 94 if(buf[0] == 0x01)
RedBearLab 0:be2e4095513a 95 {
RedBearLab 0:be2e4095513a 96 if(buf[1] == 0x01)
RedBearLab 0:be2e4095513a 97 LED_SET = 1;
RedBearLab 0:be2e4095513a 98 else
RedBearLab 0:be2e4095513a 99 LED_SET = 0;
RedBearLab 0:be2e4095513a 100 }
RedBearLab 0:be2e4095513a 101 else if(buf[0] == 0xA0)
RedBearLab 0:be2e4095513a 102 {
RedBearLab 0:be2e4095513a 103 if(buf[1] == 0x01)
RedBearLab 0:be2e4095513a 104 analog_enabled = 1;
RedBearLab 0:be2e4095513a 105 else
RedBearLab 0:be2e4095513a 106 analog_enabled = 0;
RedBearLab 0:be2e4095513a 107 }
RedBearLab 0:be2e4095513a 108 else if(buf[0] == 0x02)
RedBearLab 0:be2e4095513a 109 {
RedBearLab 0:be2e4095513a 110 float value = (float)buf[1]/255;
RedBearLab 0:be2e4095513a 111 PWM = value;
RedBearLab 0:be2e4095513a 112 }
RedBearLab 0:be2e4095513a 113 else if(buf[0] == 0x03)
RedBearLab 0:be2e4095513a 114 {
RedBearLab 0:be2e4095513a 115 MYSERVO.write(buf[1]);
RedBearLab 0:be2e4095513a 116 }
RedBearLab 0:be2e4095513a 117 else if(buf[0] == 0x04)
RedBearLab 0:be2e4095513a 118 {
RedBearLab 0:be2e4095513a 119 analog_enabled = 0;
RedBearLab 0:be2e4095513a 120 PWM = 0;
RedBearLab 0:be2e4095513a 121 MYSERVO.write(0);
RedBearLab 0:be2e4095513a 122 LED_SET = 0;
RedBearLab 0:be2e4095513a 123 old_state = 0;
RedBearLab 0:be2e4095513a 124 }
RedBearLab 0:be2e4095513a 125
RedBearLab 0:be2e4095513a 126 }
RedBearLab 0:be2e4095513a 127 }
RedBearLab 0:be2e4095513a 128 /*
RedBearLab 0:be2e4095513a 129 void uartCB(void)
RedBearLab 0:be2e4095513a 130 {
RedBearLab 0:be2e4095513a 131 while(pc.readable())
RedBearLab 0:be2e4095513a 132 {
RedBearLab 0:be2e4095513a 133 rx_buf[rx_len++] = pc.getc();
RedBearLab 0:be2e4095513a 134 if(rx_len>=20 || rx_buf[rx_len-1]=='\0' || rx_buf[rx_len-1]=='\n')
RedBearLab 0:be2e4095513a 135 {
RedBearLab 0:be2e4095513a 136 ble.updateCharacteristicValue(rxCharacteristic.getValueAttribute().getHandle(), rx_buf, rx_len);
RedBearLab 0:be2e4095513a 137 pc.printf("RecHandler \r\n");
RedBearLab 0:be2e4095513a 138 pc.printf("Length: ");
RedBearLab 0:be2e4095513a 139 pc.putc(rx_len);
RedBearLab 0:be2e4095513a 140 pc.printf("\r\n");
RedBearLab 0:be2e4095513a 141 rx_len = 0;
RedBearLab 0:be2e4095513a 142 break;
RedBearLab 0:be2e4095513a 143 }
RedBearLab 0:be2e4095513a 144 }
RedBearLab 0:be2e4095513a 145 }
RedBearLab 0:be2e4095513a 146 */
RedBearLab 0:be2e4095513a 147 void m_status_check_handle(void)
RedBearLab 0:be2e4095513a 148 {
RedBearLab 0:be2e4095513a 149 uint8_t buf[3];
RedBearLab 0:be2e4095513a 150 if (analog_enabled) // if analog reading enabled
RedBearLab 0:be2e4095513a 151 {
RedBearLab 0:be2e4095513a 152 // Read and send out
RedBearLab 0:be2e4095513a 153 float s = ANALOG;
RedBearLab 0:be2e4095513a 154 uint16_t value = s*1024;
RedBearLab 0:be2e4095513a 155 buf[0] = (0x0B);
RedBearLab 0:be2e4095513a 156 buf[1] = (value >> 8);
RedBearLab 0:be2e4095513a 157 buf[2] = (value);
RedBearLab 0:be2e4095513a 158 ble.updateCharacteristicValue(rxCharacteristic.getValueAttribute().getHandle(), buf, 3);
RedBearLab 0:be2e4095513a 159 }
RedBearLab 0:be2e4095513a 160
RedBearLab 0:be2e4095513a 161 // If digital in changes, report the state
RedBearLab 0:be2e4095513a 162 if (BUTTON != old_state)
RedBearLab 0:be2e4095513a 163 {
RedBearLab 0:be2e4095513a 164 old_state = BUTTON;
RedBearLab 0:be2e4095513a 165
RedBearLab 0:be2e4095513a 166 if (BUTTON == 1)
RedBearLab 0:be2e4095513a 167 {
RedBearLab 0:be2e4095513a 168 buf[0] = (0x0A);
RedBearLab 0:be2e4095513a 169 buf[1] = (0x01);
RedBearLab 0:be2e4095513a 170 buf[2] = (0x00);
RedBearLab 0:be2e4095513a 171 ble.updateCharacteristicValue(rxCharacteristic.getValueAttribute().getHandle(), buf, 3);
RedBearLab 0:be2e4095513a 172 }
RedBearLab 0:be2e4095513a 173 else
RedBearLab 0:be2e4095513a 174 {
RedBearLab 0:be2e4095513a 175 buf[0] = (0x0A);
RedBearLab 0:be2e4095513a 176 buf[1] = (0x00);
RedBearLab 0:be2e4095513a 177 buf[2] = (0x00);
RedBearLab 0:be2e4095513a 178 ble.updateCharacteristicValue(rxCharacteristic.getValueAttribute().getHandle(), buf, 3);
RedBearLab 0:be2e4095513a 179 }
RedBearLab 0:be2e4095513a 180 }
RedBearLab 0:be2e4095513a 181 }
RedBearLab 0:be2e4095513a 182
RedBearLab 0:be2e4095513a 183
RedBearLab 0:be2e4095513a 184 int main(void)
RedBearLab 0:be2e4095513a 185 {
RedBearLab 0:be2e4095513a 186 Ticker ticker;
RedBearLab 0:be2e4095513a 187 ticker.attach_us(m_status_check_handle, 200000);
RedBearLab 0:be2e4095513a 188
RedBearLab 0:be2e4095513a 189 ble.init();
RedBearLab 0:be2e4095513a 190 ble.onDisconnection(disconnectionCallback);
RedBearLab 0:be2e4095513a 191 ble.onDataWritten(WrittenHandler);
RedBearLab 0:be2e4095513a 192
RedBearLab 0:be2e4095513a 193 //pc.baud(9600);
RedBearLab 0:be2e4095513a 194 //pc.printf("SimpleChat Init \r\n");
RedBearLab 0:be2e4095513a 195
RedBearLab 0:be2e4095513a 196 //pc.attach( uartCB , pc.RxIrq);
RedBearLab 0:be2e4095513a 197
RedBearLab 0:be2e4095513a 198 // setup advertising
RedBearLab 0:be2e4095513a 199 ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED);
RedBearLab 0:be2e4095513a 200 ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
RedBearLab 0:be2e4095513a 201 ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,
aadavids 2:ddf1f6325a37 202 (const uint8_t *)"Serqet", sizeof("Serqet") - 1);
RedBearLab 0:be2e4095513a 203 ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS,
RedBearLab 0:be2e4095513a 204 (const uint8_t *)uart_base_uuid_rev, sizeof(uart_base_uuid));
RedBearLab 0:be2e4095513a 205 // 100ms; in multiples of 0.625ms.
RedBearLab 0:be2e4095513a 206 ble.setAdvertisingInterval(160);
RedBearLab 0:be2e4095513a 207
RedBearLab 0:be2e4095513a 208 ble.addService(uartService);
RedBearLab 0:be2e4095513a 209
RedBearLab 0:be2e4095513a 210 ble.startAdvertising();
RedBearLab 0:be2e4095513a 211
RedBearLab 0:be2e4095513a 212 //pc.printf("Advertising Start \r\n");
RedBearLab 0:be2e4095513a 213
RedBearLab 0:be2e4095513a 214 while(1)
RedBearLab 0:be2e4095513a 215 {
RedBearLab 0:be2e4095513a 216 ble.waitForEvent();
RedBearLab 0:be2e4095513a 217 }
RedBearLab 0:be2e4095513a 218 }
RedBearLab 0:be2e4095513a 219
RedBearLab 0:be2e4095513a 220
RedBearLab 0:be2e4095513a 221
RedBearLab 0:be2e4095513a 222
RedBearLab 0:be2e4095513a 223
RedBearLab 0:be2e4095513a 224
RedBearLab 0:be2e4095513a 225
RedBearLab 0:be2e4095513a 226
RedBearLab 0:be2e4095513a 227
RedBearLab 0:be2e4095513a 228
RedBearLab 0:be2e4095513a 229
RedBearLab 0:be2e4095513a 230
RedBearLab 0:be2e4095513a 231
RedBearLab 0:be2e4095513a 232
RedBearLab 0:be2e4095513a 233
RedBearLab 0:be2e4095513a 234
RedBearLab 0:be2e4095513a 235
RedBearLab 0:be2e4095513a 236
RedBearLab 0:be2e4095513a 237
RedBearLab 0:be2e4095513a 238
RedBearLab 0:be2e4095513a 239
RedBearLab 0:be2e4095513a 240
RedBearLab 0:be2e4095513a 241
RedBearLab 0:be2e4095513a 242
RedBearLab 0:be2e4095513a 243
RedBearLab 0:be2e4095513a 244
RedBearLab 0:be2e4095513a 245
RedBearLab 0:be2e4095513a 246
RedBearLab 0:be2e4095513a 247
RedBearLab 0:be2e4095513a 248
RedBearLab 0:be2e4095513a 249