From da405029113f9c188313b9477f4dc13aa3ab52f9 Mon Sep 17 00:00:00 2001
From: Brian Cully <bjc@kublai.com>
Date: Thu, 15 Aug 2019 20:44:51 -0400
Subject: More WIP for btle comms.

---
 ble/src/ble.rs | 28 ++++++++++++++++++++++++++++
 1 file changed, 28 insertions(+)
 create mode 100644 ble/src/ble.rs

(limited to 'ble/src/ble.rs')

diff --git a/ble/src/ble.rs b/ble/src/ble.rs
new file mode 100644
index 0000000..e5f16cb
--- /dev/null
+++ b/ble/src/ble.rs
@@ -0,0 +1,28 @@
+use nrf52840_hal::target::{FICR, RADIO, TIMER0};
+use rubble::link::{AddressKind, DeviceAddress, HardwareInterface, LinkLayer, MIN_PDU_BUF};
+use rubble_nrf52::{radio::BleRadio, timer::BleTimer};
+
+struct NRF52840 {}
+impl HardwareInterface for NRF52840 {
+    type Timer = BleTimer<TIMER0>;
+    type Tx = BleRadio;
+}
+
+pub fn setup(radio: RADIO, timer: TIMER0, ficr: FICR) {
+    // make sure hfclock is started for timer0 to work at the right
+    // resolution.
+    let ble_timer = BleTimer::init(timer);
+    let mut devaddr = [0u8; 6];
+    let devaddr_lo = ficr.deviceaddr[0].read().bits();
+    let devaddr_hi = ficr.deviceaddr[1].read().bits();
+    devaddr[..4].clone_from_slice(&devaddr_lo.to_le_bytes());
+    devaddr[4..].clone_from_slice(&devaddr_hi.to_le_bytes());
+
+    let addrkind = if ficr.deviceaddrtype.read().deviceaddrtype().is_public() {
+        AddressKind::Public
+    } else {
+        AddressKind::Random
+    };
+    let addr = DeviceAddress::new(devaddr, addrkind);
+    let mut _ll = LinkLayer::<NRF52840>::new(addr, ble_timer);
+}
-- 
cgit v1.2.3