105 lines
3.9 KiB
C++
105 lines
3.9 KiB
C++
#include "MicroBitConfig.h"
|
|
#include "BLEHF2Service.h"
|
|
#include "MicroBitEvent.h"
|
|
|
|
//================================================================
|
|
#if MICROBIT_CODAL
|
|
//================================================================
|
|
|
|
const uint8_t BLEHF2Service::service_base_uuid[ 16] =
|
|
{ 0xb1,0x12,0x00,0x00,0x26,0x79,0x30,0xda,0xa2,0x6e,0x02,0x73,0xb6,0x04,0x38,0x49 };
|
|
|
|
const uint8_t BLEHF2Service::char_base_uuid[ 16] =
|
|
{ 0xb1,0x12,0x00,0x00,0x26,0x79,0x30,0xda,0xa2,0x6e,0x02,0x73,0xb6,0x04,0x38,0x4a };
|
|
|
|
const uint16_t BLEHF2Service::serviceUUID = 0xf5e6;
|
|
const uint16_t BLEHF2Service::charUUID[ mbbs_cIdxCOUNT] = { 0xf5e6 };
|
|
|
|
|
|
BLEHF2Service::BLEHF2Service(BLEDevice &_ble) :
|
|
ble(_ble)
|
|
{
|
|
// Initialise our characteristic values.
|
|
memset(&txCharacteristicMessage, 0, sizeof(txCharacteristicMessage));
|
|
|
|
// Register the base UUID and create the service.
|
|
RegisterBaseUUID( service_base_uuid);
|
|
CreateService( serviceUUID);
|
|
|
|
RegisterBaseUUID( char_base_uuid);
|
|
CreateCharacteristic( mbbs_cIdxMESSAGE, charUUID[ mbbs_cIdxMESSAGE],
|
|
(uint8_t *)&txCharacteristicMessage,
|
|
sizeof(txCharacteristicMessage), sizeof(txCharacteristicMessage),
|
|
microbit_propNOTIFY);
|
|
}
|
|
|
|
void BLEHF2Service::sendSerial(const char *data, int len, bool isError) {
|
|
if (getConnected())
|
|
{
|
|
int32_t sent = 0;
|
|
while(sent < len) {
|
|
int32_t n = min(BLEHF2_DATA_LENGTH, len - sent);
|
|
txCharacteristicMessage.command = (isError ? BLEHF2_FLAG_SERIAL_OUT : BLEHF2_FLAG_SERIAL_ERR) | n;
|
|
memcpy(&txCharacteristicMessage.data, data + sent, n);
|
|
notifyChrValue(mbbs_cIdxMESSAGE,(uint8_t *)&txCharacteristicMessage, sizeof(txCharacteristicMessage));
|
|
sent += n;
|
|
}
|
|
}
|
|
}
|
|
|
|
//================================================================
|
|
#else // MICROBIT_CODAL
|
|
//================================================================
|
|
|
|
#include "ble/UUID.h"
|
|
|
|
BLEHF2Service::BLEHF2Service(BLEDevice &_ble) :
|
|
ble(_ble)
|
|
{
|
|
GattCharacteristic txCharacteristic(BLEHF2TxCharacteristicUUID, (uint8_t *)&txCharacteristicMessage, 0,
|
|
sizeof(txCharacteristicMessage), GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY);
|
|
|
|
// Initialise our characteristic values.
|
|
memset(&txCharacteristicMessage, 0, sizeof(txCharacteristicMessage));
|
|
|
|
// Set default security requirements
|
|
txCharacteristic.requireSecurity(SecurityManager::MICROBIT_BLE_SECURITY_LEVEL);
|
|
|
|
// setup GATT table
|
|
GattCharacteristic *characteristics[] = {&txCharacteristic};
|
|
GattService service(BLEHF2ServiceUUID, characteristics, sizeof(characteristics) / sizeof(GattCharacteristic *));
|
|
ble.addService(service);
|
|
|
|
// retreive handles
|
|
txCharacteristicHandle = txCharacteristic.getValueHandle();
|
|
|
|
// initialize data
|
|
ble.gattServer().write(txCharacteristicHandle,(uint8_t *)&txCharacteristicMessage, sizeof(txCharacteristicMessage));
|
|
}
|
|
|
|
void BLEHF2Service::sendSerial(const char *data, int len, bool isError) {
|
|
if (ble.getGapState().connected)
|
|
{
|
|
int32_t sent = 0;
|
|
while(sent < len) {
|
|
int32_t n = min(BLEHF2_DATA_LENGTH, len - sent);
|
|
txCharacteristicMessage.command = (isError ? BLEHF2_FLAG_SERIAL_OUT : BLEHF2_FLAG_SERIAL_ERR) | n;
|
|
memcpy(&txCharacteristicMessage.data, data + sent, n);
|
|
ble.gattServer().notify(txCharacteristicHandle,(uint8_t *)&txCharacteristicMessage, sizeof(txCharacteristicMessage));
|
|
sent += n;
|
|
}
|
|
}
|
|
}
|
|
|
|
const uint8_t BLEHF2ServiceUUID[] = {
|
|
0xb1,0x12,0xf5,0xe6,0x26,0x79,0x30,0xda,0xa2,0x6e,0x02,0x73,0xb6,0x04,0x38,0x49
|
|
};
|
|
|
|
const uint8_t BLEHF2TxCharacteristicUUID[] = {
|
|
0xb1,0x12,0xf5,0xe6,0x26,0x79,0x30,0xda,0xa2,0x6e,0x02,0x73,0xb6,0x04,0x38,0x4a
|
|
};
|
|
|
|
//================================================================
|
|
#endif // MICROBIT_CODAL
|
|
//================================================================
|