mirror of
https://github.com/meshtastic/firmware.git
synced 2025-02-04 19:59:55 +00:00
81 lines
2.0 KiB
C++
81 lines
2.0 KiB
C++
#include "NRF52Bluetooth.h"
|
|
#include "configuration.h"
|
|
#include <assert.h>
|
|
#include <ble_gap.h>
|
|
#include <memory.h>
|
|
#include <nrf52840.h>
|
|
|
|
// #define USE_SOFTDEVICE
|
|
|
|
static inline void debugger_break(void)
|
|
{
|
|
__asm volatile("bkpt #0x01\n\t"
|
|
"mov pc, lr\n\t");
|
|
}
|
|
|
|
// handle standard gcc assert failures
|
|
void __attribute__((noreturn)) __assert_func(const char *file, int line, const char *func, const char *failedexpr)
|
|
{
|
|
DEBUG_MSG("assert failed %s: %d, %s, test=%s\n", file, line, func, failedexpr);
|
|
// debugger_break(); FIXME doesn't work, possibly not for segger
|
|
while (1)
|
|
; // FIXME, reboot!
|
|
}
|
|
|
|
void getMacAddr(uint8_t *dmac)
|
|
{
|
|
ble_gap_addr_t addr;
|
|
|
|
#ifdef USE_SOFTDEVICE
|
|
uint32_t res = sd_ble_gap_addr_get(&addr);
|
|
assert(res == NRF_SUCCESS);
|
|
memcpy(dmac, addr.addr, 6);
|
|
#else
|
|
const uint8_t *src = (const uint8_t *)NRF_FICR->DEVICEADDR;
|
|
dmac[5] = src[0];
|
|
dmac[4] = src[1];
|
|
dmac[3] = src[2];
|
|
dmac[2] = src[3];
|
|
dmac[1] = src[4];
|
|
dmac[0] = src[5] | 0xc0; // MSB high two bits get set elsewhere in the bluetooth stack
|
|
#endif
|
|
}
|
|
|
|
NRF52Bluetooth *nrf52Bluetooth;
|
|
|
|
// FIXME, turn off soft device access for debugging
|
|
static bool isSoftDeviceAllowed = false;
|
|
|
|
static bool bleOn = false;
|
|
void setBluetoothEnable(bool on)
|
|
{
|
|
if (on != bleOn) {
|
|
if (on) {
|
|
if (!nrf52Bluetooth && isSoftDeviceAllowed) {
|
|
nrf52Bluetooth = new NRF52Bluetooth();
|
|
nrf52Bluetooth->setup();
|
|
}
|
|
} else {
|
|
DEBUG_MSG("FIXME: implement BLE disable\n");
|
|
}
|
|
bleOn = on;
|
|
}
|
|
}
|
|
|
|
#ifdef ARDUINO_NRF52840_PPR
|
|
#include "PmuBQ25703A.h"
|
|
|
|
PmuBQ25703A pmu;
|
|
#endif
|
|
|
|
void nrf52Setup()
|
|
{
|
|
|
|
auto why = NRF_POWER->RESETREAS;
|
|
// per https://infocenter.nordicsemi.com/index.jsp?topic=%2Fcom.nordic.infocenter.nrf52832.ps.v1.1%2Fpower.html
|
|
DEBUG_MSG("Reset reason: 0x%x\n", why);
|
|
|
|
// Not yet on board
|
|
// pmu.init();
|
|
DEBUG_MSG("FIXME, need to call randomSeed on nrf52!\n");
|
|
} |