AKM Development Platform. This is the D7.014 version.
Dependencies: AK09970 AK099XX AK7401 AK7451 AK8963X AK9750 AK9752 AkmSensor BLE_API I2CNano MCP342x SerialNano SpiNano TCA9554A mbed nRF51822
Fork of AKDP by
main.cpp@9:90a7650db802, 2016-05-26 (annotated)
- Committer:
- masahikofukasawa
- Date:
- Thu May 26 21:57:18 2016 +0000
- Revision:
- 9:90a7650db802
- Parent:
- 7:f1f544deaaa3
- Child:
- 10:a710e8c3311c
5/26/2016 Japan Demo Version; Modified For: SPI
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
masahikofukasawa | 0:c240899240e7 | 1 | #include <stdio.h> |
masahikofukasawa | 0:c240899240e7 | 2 | #include <stdlib.h> |
masahikofukasawa | 0:c240899240e7 | 3 | #include "mbed.h" |
masahikofukasawa | 0:c240899240e7 | 4 | #include "ble/BLE.h" |
masahikofukasawa | 0:c240899240e7 | 5 | #include "ble/services/UARTService.h" |
masahikofukasawa | 0:c240899240e7 | 6 | #include "SerialNano.h" |
masahikofukasawa | 0:c240899240e7 | 7 | #include "akmsensormanager.h" |
masahikofukasawa | 0:c240899240e7 | 8 | #include "debug.h" |
coisme | 2:11a5873f8ec0 | 9 | #include "tca9554a.h" |
masahikofukasawa | 0:c240899240e7 | 10 | |
masahikofukasawa | 0:c240899240e7 | 11 | #define BLE_UUID_TXRX_SERVICE 0x0000 /**< The UUID of the Nordic UART Service. */ |
masahikofukasawa | 0:c240899240e7 | 12 | #define BLE_UUID_TX_CHARACTERISTIC 0x0002 /**< The UUID of the TX Characteristic. */ |
masahikofukasawa | 0:c240899240e7 | 13 | #define BLE_UUIDS_RX_CHARACTERISTIC 0x0003 /**< The UUID of the RX Characteristic. */ |
masahikofukasawa | 0:c240899240e7 | 14 | |
masahikofukasawa | 0:c240899240e7 | 15 | //#define TXRX_LEN UARTService::BLE_UART_SERVICE_MAX_DATA_LEN+1 |
masahikofukasawa | 0:c240899240e7 | 16 | #define TXRX_LEN 50 // Temp |
masahikofukasawa | 0:c240899240e7 | 17 | |
masahikofukasawa | 0:c240899240e7 | 18 | #define CR '\r' |
masahikofukasawa | 0:c240899240e7 | 19 | #define LF '\n' |
masahikofukasawa | 0:c240899240e7 | 20 | |
masahikofukasawa | 0:c240899240e7 | 21 | BLE ble; |
masahikofukasawa | 0:c240899240e7 | 22 | UARTService* uartService; |
coisme | 2:11a5873f8ec0 | 23 | #ifndef REV_D |
coisme | 2:11a5873f8ec0 | 24 | SerialNano serial(P0_28, P0_29); // Rev.C pin configuration |
coisme | 2:11a5873f8ec0 | 25 | #else |
masahikofukasawa | 7:f1f544deaaa3 | 26 | SerialNano serial(P0_4, P0_5); // Rev.D pin configuration |
masahikofukasawa | 7:f1f544deaaa3 | 27 | #endif |
masahikofukasawa | 4:749a21fd9c2d | 28 | |
masahikofukasawa | 0:c240899240e7 | 29 | AkmSensorManager* manager; |
masahikofukasawa | 0:c240899240e7 | 30 | |
masahikofukasawa | 0:c240899240e7 | 31 | static char commandStr[TXRX_LEN]; |
masahikofukasawa | 0:c240899240e7 | 32 | static uint16_t rx_len=0; |
masahikofukasawa | 0:c240899240e7 | 33 | |
masahikofukasawa | 0:c240899240e7 | 34 | /* |
masahikofukasawa | 0:c240899240e7 | 35 | void WrittenHandler(const GattWriteCallbackParams *Handler) |
masahikofukasawa | 0:c240899240e7 | 36 | { |
masahikofukasawa | 0:c240899240e7 | 37 | uint8_t buf[TXRX_LEN]; |
masahikofukasawa | 0:c240899240e7 | 38 | uint16_t bytesRead; |
masahikofukasawa | 0:c240899240e7 | 39 | if (Handler->handle == uartService->getTXCharacteristicHandle()) |
masahikofukasawa | 0:c240899240e7 | 40 | { |
masahikofukasawa | 0:c240899240e7 | 41 | ble.gattServer().read(uartService->getTXCharacteristicHandle(), buf, &bytesRead); |
masahikofukasawa | 0:c240899240e7 | 42 | int len = 0; |
masahikofukasawa | 0:c240899240e7 | 43 | for(int i=0; i<bytesRead; i++){ |
masahikofukasawa | 0:c240899240e7 | 44 | commandStr[len++] = buf[i]; |
masahikofukasawa | 0:c240899240e7 | 45 | if(i>=TXRX_LEN || buf[i]==LF ) |
masahikofukasawa | 0:c240899240e7 | 46 | { |
masahikofukasawa | 0:c240899240e7 | 47 | manager->commandReceived(commandStr); |
masahikofukasawa | 0:c240899240e7 | 48 | return; |
masahikofukasawa | 0:c240899240e7 | 49 | } |
masahikofukasawa | 0:c240899240e7 | 50 | } |
masahikofukasawa | 0:c240899240e7 | 51 | } |
masahikofukasawa | 0:c240899240e7 | 52 | } |
masahikofukasawa | 0:c240899240e7 | 53 | */ |
masahikofukasawa | 0:c240899240e7 | 54 | |
masahikofukasawa | 0:c240899240e7 | 55 | void WrittenHandler(const GattWriteCallbackParams *Handler) |
masahikofukasawa | 0:c240899240e7 | 56 | { |
masahikofukasawa | 0:c240899240e7 | 57 | uint8_t buf[TXRX_LEN]; |
masahikofukasawa | 0:c240899240e7 | 58 | uint16_t bytesRead; |
masahikofukasawa | 0:c240899240e7 | 59 | |
masahikofukasawa | 0:c240899240e7 | 60 | if (Handler->handle == uartService->getTXCharacteristicHandle()) |
masahikofukasawa | 0:c240899240e7 | 61 | { |
masahikofukasawa | 0:c240899240e7 | 62 | ble.gattServer().read(uartService->getTXCharacteristicHandle(), buf, &bytesRead); |
masahikofukasawa | 0:c240899240e7 | 63 | char command[TXRX_LEN]; |
masahikofukasawa | 0:c240899240e7 | 64 | int len = 0; |
masahikofukasawa | 0:c240899240e7 | 65 | for(int i=0; i<bytesRead; i++){ |
masahikofukasawa | 0:c240899240e7 | 66 | if(i>=TXRX_LEN || buf[i]==CR ) |
masahikofukasawa | 0:c240899240e7 | 67 | { |
masahikofukasawa | 0:c240899240e7 | 68 | break; |
masahikofukasawa | 0:c240899240e7 | 69 | } |
masahikofukasawa | 0:c240899240e7 | 70 | else |
masahikofukasawa | 0:c240899240e7 | 71 | { |
masahikofukasawa | 0:c240899240e7 | 72 | if(buf[i] != LF) |
masahikofukasawa | 0:c240899240e7 | 73 | { |
masahikofukasawa | 0:c240899240e7 | 74 | command[len++] = (char)buf[i]; |
masahikofukasawa | 0:c240899240e7 | 75 | } |
masahikofukasawa | 0:c240899240e7 | 76 | } |
masahikofukasawa | 0:c240899240e7 | 77 | } |
masahikofukasawa | 0:c240899240e7 | 78 | manager->commandReceived(command); |
masahikofukasawa | 0:c240899240e7 | 79 | } |
masahikofukasawa | 0:c240899240e7 | 80 | } |
masahikofukasawa | 0:c240899240e7 | 81 | |
masahikofukasawa | 0:c240899240e7 | 82 | |
masahikofukasawa | 0:c240899240e7 | 83 | /* |
masahikofukasawa | 0:c240899240e7 | 84 | void usbUartCallback(void) |
masahikofukasawa | 0:c240899240e7 | 85 | { |
masahikofukasawa | 0:c240899240e7 | 86 | if(serial.readable()) |
masahikofukasawa | 0:c240899240e7 | 87 | { |
masahikofukasawa | 0:c240899240e7 | 88 | uint8_t c = serial.getc(); |
masahikofukasawa | 0:c240899240e7 | 89 | if(rx_len>=TXRX_LEN || c == CR ) |
masahikofukasawa | 0:c240899240e7 | 90 | { |
masahikofukasawa | 0:c240899240e7 | 91 | manager->commandReceived(commandStr); |
masahikofukasawa | 0:c240899240e7 | 92 | rx_len = 0; |
masahikofukasawa | 0:c240899240e7 | 93 | } |
masahikofukasawa | 0:c240899240e7 | 94 | else{ |
masahikofukasawa | 0:c240899240e7 | 95 | if(c != LF) |
masahikofukasawa | 0:c240899240e7 | 96 | { |
masahikofukasawa | 0:c240899240e7 | 97 | commandStr[rx_len++] = c; |
masahikofukasawa | 0:c240899240e7 | 98 | } |
masahikofukasawa | 0:c240899240e7 | 99 | } |
masahikofukasawa | 0:c240899240e7 | 100 | } |
masahikofukasawa | 0:c240899240e7 | 101 | } |
masahikofukasawa | 0:c240899240e7 | 102 | */ |
masahikofukasawa | 0:c240899240e7 | 103 | void usbUartCallback(void) |
masahikofukasawa | 0:c240899240e7 | 104 | { |
masahikofukasawa | 0:c240899240e7 | 105 | if(serial.readable()) |
masahikofukasawa | 0:c240899240e7 | 106 | { |
masahikofukasawa | 0:c240899240e7 | 107 | uint8_t c = serial.getc(); |
masahikofukasawa | 0:c240899240e7 | 108 | |
masahikofukasawa | 0:c240899240e7 | 109 | // ignore CR |
masahikofukasawa | 0:c240899240e7 | 110 | if(c==CR) return; |
masahikofukasawa | 0:c240899240e7 | 111 | |
masahikofukasawa | 0:c240899240e7 | 112 | commandStr[rx_len++] = c; |
masahikofukasawa | 0:c240899240e7 | 113 | if(rx_len>=TXRX_LEN || c == LF) |
masahikofukasawa | 0:c240899240e7 | 114 | { |
masahikofukasawa | 0:c240899240e7 | 115 | manager->commandReceived(commandStr); |
masahikofukasawa | 0:c240899240e7 | 116 | rx_len = 0; |
masahikofukasawa | 0:c240899240e7 | 117 | } |
masahikofukasawa | 0:c240899240e7 | 118 | } |
masahikofukasawa | 0:c240899240e7 | 119 | } |
masahikofukasawa | 0:c240899240e7 | 120 | |
masahikofukasawa | 0:c240899240e7 | 121 | void connectionCallback(const Gap::ConnectionCallbackParams_t *params) |
masahikofukasawa | 0:c240899240e7 | 122 | { |
masahikofukasawa | 0:c240899240e7 | 123 | manager->setEventConnected(); |
masahikofukasawa | 0:c240899240e7 | 124 | MSG("#Connected\r\n"); |
masahikofukasawa | 0:c240899240e7 | 125 | } |
masahikofukasawa | 0:c240899240e7 | 126 | |
masahikofukasawa | 0:c240899240e7 | 127 | void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params) |
masahikofukasawa | 0:c240899240e7 | 128 | { |
masahikofukasawa | 0:c240899240e7 | 129 | manager->setEventDisconnected(); |
masahikofukasawa | 0:c240899240e7 | 130 | MSG("#Disconnected \r\n"); |
masahikofukasawa | 0:c240899240e7 | 131 | ble.gap().startAdvertising(); |
masahikofukasawa | 0:c240899240e7 | 132 | } |
masahikofukasawa | 0:c240899240e7 | 133 | |
masahikofukasawa | 0:c240899240e7 | 134 | int main(void) |
masahikofukasawa | 0:c240899240e7 | 135 | { |
masahikofukasawa | 0:c240899240e7 | 136 | // USB serial |
masahikofukasawa | 0:c240899240e7 | 137 | serial.baud(115200); |
masahikofukasawa | 7:f1f544deaaa3 | 138 | |
masahikofukasawa | 7:f1f544deaaa3 | 139 | // serial port RX event |
masahikofukasawa | 7:f1f544deaaa3 | 140 | serial.attach(&usbUartCallback); |
masahikofukasawa | 7:f1f544deaaa3 | 141 | |
masahikofukasawa | 0:c240899240e7 | 142 | #ifdef DEBUG |
masahikofukasawa | 0:c240899240e7 | 143 | Debug::setSerial(&serial); |
masahikofukasawa | 0:c240899240e7 | 144 | MSG("#Debug Mode.\n"); |
masahikofukasawa | 0:c240899240e7 | 145 | #endif |
masahikofukasawa | 7:f1f544deaaa3 | 146 | |
masahikofukasawa | 7:f1f544deaaa3 | 147 | #ifdef REV_D |
masahikofukasawa | 7:f1f544deaaa3 | 148 | /* Rev.D */ |
masahikofukasawa | 7:f1f544deaaa3 | 149 | { |
masahikofukasawa | 7:f1f544deaaa3 | 150 | MSG("#I2C GPIO Expander.\n"); |
masahikofukasawa | 7:f1f544deaaa3 | 151 | const int TIME_FOR_OE_MS = 100; |
masahikofukasawa | 7:f1f544deaaa3 | 152 | const TCA9554A::Port PORT_OE_LVS1 = TCA9554A::PORT_7; |
masahikofukasawa | 7:f1f544deaaa3 | 153 | const TCA9554A::Port PORT_OE_LVS2 = TCA9554A::PORT_6; |
masahikofukasawa | 7:f1f544deaaa3 | 154 | I2C i2c(I2C_SDA, I2C_SCL); |
masahikofukasawa | 7:f1f544deaaa3 | 155 | TCA9554A tca9554a(&i2c, TCA9554A::SLAVE_ADDRESS_38H); |
masahikofukasawa | 7:f1f544deaaa3 | 156 | // Initializes TCA9554A (I2C GPIO Expander) |
masahikofukasawa | 7:f1f544deaaa3 | 157 | tca9554a.configurePort(PORT_OE_LVS1, TCA9554A::DIR_OUTPUT); |
masahikofukasawa | 7:f1f544deaaa3 | 158 | tca9554a.configurePort(PORT_OE_LVS2, TCA9554A::DIR_OUTPUT); |
masahikofukasawa | 7:f1f544deaaa3 | 159 | // Makes sure that the OE is low first. |
masahikofukasawa | 9:90a7650db802 | 160 | // tca9554a.setPortLevel(PORT_OE_LVS1, TCA9554A::LOW); |
masahikofukasawa | 9:90a7650db802 | 161 | // tca9554a.setPortLevel(PORT_OE_LVS2, TCA9554A::LOW); |
masahikofukasawa | 7:f1f544deaaa3 | 162 | wait_ms(TIME_FOR_OE_MS); |
masahikofukasawa | 7:f1f544deaaa3 | 163 | // Sets the OE pins high. |
masahikofukasawa | 7:f1f544deaaa3 | 164 | tca9554a.setPortLevel(PORT_OE_LVS1, TCA9554A::HIGH); |
masahikofukasawa | 7:f1f544deaaa3 | 165 | tca9554a.setPortLevel(PORT_OE_LVS2, TCA9554A::HIGH); |
masahikofukasawa | 7:f1f544deaaa3 | 166 | MSG("#Start main loop.\n"); |
masahikofukasawa | 9:90a7650db802 | 167 | // manager->releaseTWI(); |
masahikofukasawa | 7:f1f544deaaa3 | 168 | } |
masahikofukasawa | 7:f1f544deaaa3 | 169 | #endif |
masahikofukasawa | 0:c240899240e7 | 170 | |
masahikofukasawa | 0:c240899240e7 | 171 | ble.init(); |
masahikofukasawa | 0:c240899240e7 | 172 | // setup advertising |
masahikofukasawa | 0:c240899240e7 | 173 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED); |
masahikofukasawa | 0:c240899240e7 | 174 | ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); |
masahikofukasawa | 0:c240899240e7 | 175 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME, |
coisme | 2:11a5873f8ec0 | 176 | (const uint8_t *)"AKDP RevD 001", sizeof("AKDP RevD 001") - 1); |
masahikofukasawa | 0:c240899240e7 | 177 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, |
masahikofukasawa | 0:c240899240e7 | 178 | (const uint8_t *)UARTServiceUUID_reversed, sizeof(UARTServiceUUID_reversed)); |
masahikofukasawa | 0:c240899240e7 | 179 | ble.gap().onConnection(connectionCallback); |
masahikofukasawa | 0:c240899240e7 | 180 | ble.gap().onDisconnection(disconnectionCallback); |
masahikofukasawa | 0:c240899240e7 | 181 | ble.gattServer().onDataWritten(WrittenHandler); |
masahikofukasawa | 0:c240899240e7 | 182 | |
masahikofukasawa | 0:c240899240e7 | 183 | // 100ms; in multiples of 0.625ms. |
masahikofukasawa | 0:c240899240e7 | 184 | ble.gap().setAdvertisingInterval(80); |
masahikofukasawa | 0:c240899240e7 | 185 | ble.gap().startAdvertising(); |
masahikofukasawa | 0:c240899240e7 | 186 | |
masahikofukasawa | 0:c240899240e7 | 187 | // BLE UART service |
masahikofukasawa | 0:c240899240e7 | 188 | uartService = new UARTService(ble); |
masahikofukasawa | 7:f1f544deaaa3 | 189 | |
masahikofukasawa | 0:c240899240e7 | 190 | // create sensor manager |
masahikofukasawa | 0:c240899240e7 | 191 | manager = new AkmSensorManager(&serial, uartService); |
masahikofukasawa | 0:c240899240e7 | 192 | if( manager->init() == AkmSensorManager::ERROR){ |
masahikofukasawa | 0:c240899240e7 | 193 | MSG("#Error: sensor is NULL\n"); |
masahikofukasawa | 0:c240899240e7 | 194 | } |
masahikofukasawa | 7:f1f544deaaa3 | 195 | |
masahikofukasawa | 0:c240899240e7 | 196 | // main loop |
masahikofukasawa | 0:c240899240e7 | 197 | while(1) |
masahikofukasawa | 0:c240899240e7 | 198 | { |
masahikofukasawa | 0:c240899240e7 | 199 | if(manager->isEvent()){ |
masahikofukasawa | 0:c240899240e7 | 200 | manager->processEvent(); |
masahikofukasawa | 0:c240899240e7 | 201 | }else{ |
masahikofukasawa | 0:c240899240e7 | 202 | ble.waitForEvent(); |
masahikofukasawa | 0:c240899240e7 | 203 | } |
masahikofukasawa | 0:c240899240e7 | 204 | } |
masahikofukasawa | 0:c240899240e7 | 205 | } |