Files
MySensors/hal/transport/NRF5_ESB/MyTransportNRF5_ESB.cpp
T

159 lines
3.7 KiB
C++

/*
* The MySensors Arduino library handles the wireless radio link and protocol
* between your home built sensors/actuators and HA controller of choice.
* The sensors forms a self healing radio network with optional repeaters. Each
* repeater and gateway builds a routing tables in EEPROM which keeps track of the
* network topology allowing messages to be routed to nodes.
*
* Created by Henrik Ekblad <henrik.ekblad@mysensors.org>
* Copyright (C) 2013-2018 Sensnology AB
* Copyright (C) 2017 Frank Holtz
* Full contributor list:
* https://github.com/mysensors/Arduino/graphs/contributors
*
* Documentation: http://www.mysensors.org
* Support Forum: http://forum.mysensors.org
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* version 2 as published by the Free Software Foundation.
*/
#include "drivers/NRF5/Radio.h"
#include "drivers/NRF5/Radio_ESB.h"
#include "drivers/CircularBuffer/CircularBuffer.h"
#if defined(MY_NRF5_ESB_ENABLE_ENCRYPTION)
#include "drivers/AES/AES.cpp"
AES NRF5_ESB_aes;
uint8_t NRF5_ESB_dataenc[32] = {0};
#endif
bool transportInit(void)
{
#if defined(MY_NRF5_ESB_ENABLE_ENCRYPTION)
uint8_t NRF5_ESB_psk[16];
#ifdef MY_ENCRYPTION_SIMPLE_PASSWD
(void)memset(NRF5_ESB_psk, 0, 16);
(void)memcpy(NRF5_ESB_psk, MY_ENCRYPTION_SIMPLE_PASSWD, strnlen(MY_ENCRYPTION_SIMPLE_PASSWD, 16));
#else
hwReadConfigBlock((void*)NRF5_ESB_psk, (void*)EEPROM_RF_ENCRYPTION_KEY_ADDRESS,
16);
#endif
// set up AES-key
NRF5_ESB_aes.set_key(NRF5_ESB_psk, 16);
// Make sure it is purged from memory when set
(void)memset(NRF5_ESB_psk, 0, 16);
#endif
return NRF5_ESB_initialize();
}
void transportSetAddress(const uint8_t address)
{
NRF5_ESB_setNodeAddress(address);
NRF5_ESB_startListening();
}
uint8_t transportGetAddress(void)
{
return NRF5_ESB_getNodeID();
}
bool transportSend(const uint8_t to, const void *data, const uint8_t len, const bool noACK)
{
#if defined(MY_NRF5_ESB_ENABLE_ENCRYPTION)
// copy input data because it is read-only
(void)memcpy(NRF5_ESB_dataenc, data, len);
// has to be adjusted, WIP!
NRF5_ESB_aes.set_IV(0);
const uint8_t finalLength = len > 16 ? 32 : 16;
// encrypt data
NRF5_ESB_aes.cbc_encrypt(NRF5_ESB_dataenc, NRF5_ESB_dataenc, finalLength / 16);
return NRF5_ESB_sendMessage(to, NRF5_ESB_dataenc, finalLength, noACK);
#else
return NRF5_ESB_sendMessage(to, data, len, noACK);
#endif
}
bool transportAvailable(void)
{
return NRF5_ESB_isDataAvailable();
}
bool transportSanityCheck(void)
{
return NRF5_ESB_sanityCheck();
}
uint8_t transportReceive(void *data)
{
uint8_t len = 0;
len = NRF5_ESB_readMessage(data);
#if defined(MY_NRF5_ESB_ENABLE_ENCRYPTION)
// has to be adjusted, WIP!
NRF5_ESB_aes.set_IV(0);
// decrypt data
if (NRF5_ESB_aes.cbc_decrypt((uint8_t *)(data), (uint8_t *)(data),
len > 16 ? 2 : 1) != AES_SUCCESS) {
len = 0;
}
#endif
return len;
}
void transportPowerDown(void)
{
NRF5_ESB_powerDown();
}
void transportPowerUp(void)
{
NRF5_ESB_powerUp();
}
void transportSleep(void)
{
NRF5_ESB_sleep();
}
void transportStandBy(void)
{
NRF5_ESB_standBy();
}
int16_t transportGetSendingRSSI(void)
{
return NRF5_ESB_getSendingRSSI();
}
int16_t transportGetReceivingRSSI(void)
{
return NRF5_ESB_getReceivingRSSI();
}
int16_t transportGetSendingSNR(void)
{
return INVALID_SNR;
}
int16_t transportGetReceivingSNR(void)
{
return INVALID_SNR;
}
int16_t transportGetTxPowerPercent(void)
{
return NRF5_getTxPowerPercent();
}
int16_t transportGetTxPowerLevel(void)
{
return static_cast<int16_t>(NRF5_getTxPowerLevel());
}
bool transportSetTxPowerPercent(const uint8_t powerPercent)
{
return NRF5_setTxPowerPercent(powerPercent);
}