Bluetooth: controller: Add Direct Test Mode support

Added controller implementation to support Direct Test Mode.

Signed-off-by: Vinayak Kariappa Chettimada <[email protected]>

Author: cvinayak

subsys/bluetooth/controller/hal/nrf5/radio.c

@@ -68,16 +68,31 @@ void radio_phy_set(u8_t phy, u8_t flags)
 	case BIT(0):
 	default:
 		mode = RADIO_MODE_MODE_Ble_1Mbit;
+
+#if defined(CONFIG_SOC_NRF52840)
+		/* Workaround: nRF52840 Engineering A Errata ID 164 */
+		*(volatile u32_t *)0x4000173c &= ~0x80000000;
+#endif /* CONFIG_SOC_NRF52840 */
 		break;
 
 #if defined(CONFIG_SOC_SERIES_NRF51X)
 	case BIT(1):
 		mode = RADIO_MODE_MODE_Nrf_2Mbit;
+
+#if defined(CONFIG_SOC_NRF52840)
+		/* Workaround: nRF52840 Engineering A Errata ID 164 */
+		*(volatile u32_t *)0x4000173c &= ~0x80000000;
+#endif /* CONFIG_SOC_NRF52840 */
 		break;
 
 #elif defined(CONFIG_SOC_SERIES_NRF52X)
 	case BIT(1):
 		mode = RADIO_MODE_MODE_Ble_2Mbit;
+
+#if defined(CONFIG_SOC_NRF52840)
+		/* Workaround: nRF52840 Engineering A Errata ID 164 */
+		*(volatile u32_t *)0x4000173c &= ~0x80000000;
+#endif /* CONFIG_SOC_NRF52840 */
 		break;
 
 #if defined(CONFIG_SOC_NRF52840)
@@ -87,6 +102,12 @@ void radio_phy_set(u8_t phy, u8_t flags)
 		} else {
 			mode = RADIO_MODE_MODE_Ble_LR500Kbit;
 		}
+
+		/* Workaround: nRF52840 Engineering A Errata ID 164 */
+		*(volatile u32_t *)0x4000173c |= 0x80000000;
+		*(volatile u32_t *)0x4000173c =
+			((*(volatile u32_t *)0x4000173c) & 0xFFFFFF00) |
+			0x5C;
 		break;
 #endif /* CONFIG_SOC_NRF52840 */
 #endif /* CONFIG_SOC_SERIES_NRF52X */
@@ -115,6 +136,10 @@ void radio_freq_chan_set(u32_t chan)
 void radio_whiten_iv_set(u32_t iv)
 {
 	NRF_RADIO->DATAWHITEIV = iv;
+
+	NRF_RADIO->PCNF1 &= ~RADIO_PCNF1_WHITEEN_Msk;
+	NRF_RADIO->PCNF1 |= ((1UL) << RADIO_PCNF1_WHITEEN_Pos) &
+			    RADIO_PCNF1_WHITEEN_Msk;
 }
 
 void radio_aa_set(u8_t *aa)
@@ -187,17 +212,17 @@ void radio_pkt_configure(u8_t bits_len, u8_t max_len, u8_t flags)
 			    RADIO_PCNF0_S1LEN_Msk) |
 			   extra;
 
-	NRF_RADIO->PCNF1 = (((((u32_t)max_len) << RADIO_PCNF1_MAXLEN_Pos) &
+	NRF_RADIO->PCNF1 &= ~(RADIO_PCNF1_MAXLEN_Msk | RADIO_PCNF1_STATLEN_Msk |
+			      RADIO_PCNF1_BALEN_Msk | RADIO_PCNF1_ENDIAN_Msk);
+	NRF_RADIO->PCNF1 |= ((((u32_t)max_len) << RADIO_PCNF1_MAXLEN_Pos) &
 			     RADIO_PCNF1_MAXLEN_Msk) |
-			     (((0UL) << RADIO_PCNF1_STATLEN_Pos) &
-			       RADIO_PCNF1_STATLEN_Msk) |
-			     (((3UL) << RADIO_PCNF1_BALEN_Pos) &
-			       RADIO_PCNF1_BALEN_Msk) |
-			     (((RADIO_PCNF1_ENDIAN_Little) <<
-			       RADIO_PCNF1_ENDIAN_Pos) &
-			      RADIO_PCNF1_ENDIAN_Msk) |
-			     (((1UL) << RADIO_PCNF1_WHITEEN_Pos) &
-			       RADIO_PCNF1_WHITEEN_Msk));
+			    (((0UL) << RADIO_PCNF1_STATLEN_Pos) &
+			     RADIO_PCNF1_STATLEN_Msk) |
+			    (((3UL) << RADIO_PCNF1_BALEN_Pos) &
+			     RADIO_PCNF1_BALEN_Msk) |
+			    (((RADIO_PCNF1_ENDIAN_Little) <<
+			      RADIO_PCNF1_ENDIAN_Pos) &
+			     RADIO_PCNF1_ENDIAN_Msk);
 }
 
 void radio_pkt_rx_set(void *rx_packet)
@@ -657,6 +682,25 @@ u32_t radio_tmr_start(u8_t trx, u32_t ticks_start, u32_t remainder)
 	return remainder;
 }
 
+void radio_tmr_start_us(u8_t trx, u32_t us)
+{
+	if (trx) {
+		NRF_PPI->CH[0].EEP =
+			(u32_t)&(NRF_TIMER0->EVENTS_COMPARE[0]);
+		NRF_PPI->CH[0].TEP =
+			(u32_t)&(NRF_RADIO->TASKS_TXEN);
+	} else {
+		NRF_PPI->CH[0].EEP =
+			(u32_t)&(NRF_TIMER0->EVENTS_COMPARE[0]);
+		NRF_PPI->CH[0].TEP =
+			(u32_t)&(NRF_RADIO->TASKS_RXEN);
+	}
+	NRF_PPI->CHENSET = PPI_CHEN_CH0_Msk;
+
+	NRF_TIMER0->CC[0] = us;
+	NRF_TIMER0->EVENTS_COMPARE[0] = 0;
+}
+
 void radio_tmr_stop(void)
 {
 	NRF_TIMER0->TASKS_STOP = 1;
@@ -689,6 +733,11 @@ void radio_tmr_aa_capture(void)
 	NRF_PPI->CHENSET = (PPI_CHEN_CH2_Msk | PPI_CHEN_CH3_Msk);
 }
 
+u32_t radio_tmr_ready_get(void)
+{
+	return NRF_TIMER0->CC[0];
+}
+
 u32_t radio_tmr_aa_get(void)
 {
 	return (NRF_TIMER0->CC[1] - NRF_TIMER0->CC[0]);

subsys/bluetooth/controller/hal/radio.h

@@ -66,9 +66,11 @@ u32_t radio_bc_has_match(void);
 void radio_tmr_status_reset(void);
 void radio_tmr_tifs_set(u32_t tifs);
 u32_t radio_tmr_start(u8_t trx, u32_t ticks_start, u32_t remainder);
+void radio_tmr_start_us(u8_t trx, u32_t us);
 void radio_tmr_stop(void);
 void radio_tmr_hcto_configure(u32_t hcto);
 void radio_tmr_aa_capture(void);
+u32_t radio_tmr_ready_get(void);
 u32_t radio_tmr_aa_get(void);
 void radio_tmr_end_capture(void);
 u32_t radio_tmr_end_get(void);

subsys/bluetooth/controller/ll_sw/Makefile

@@ -3,6 +3,7 @@ ccflags-y += -I$(srctree)/subsys/bluetooth/controller
 ccflags-y += -I$(srctree)/subsys/bluetooth
 
 obj-y += crypto.o ctrl.o ll.o ll_filter.o
-obj-$(CONFIG_BT_BROADCASTER)            += ll_adv.o
-obj-$(CONFIG_BT_OBSERVER)               += ll_scan.o
-obj-$(CONFIG_BT_CENTRAL)                += ll_master.o
+obj-$(CONFIG_BT_BROADCASTER) += ll_adv.o
+obj-$(CONFIG_BT_OBSERVER)    += ll_scan.o
+obj-$(CONFIG_BT_CENTRAL)     += ll_master.o
+obj-$(CONFIG_BT_CTLR_DTM)    += ll_test.o

subsys/bluetooth/controller/ll_sw/ctrl.c

@@ -449,6 +449,11 @@ u32_t radio_init(void *hf_clock, u8_t sca, u8_t connection_count_max,
 	return retcode;
 }
 
+struct device *radio_hf_clock_get(void)
+{
+	return _radio.hf_clock;
+}
+
 void ll_reset(void)
 {
 	u16_t conn_handle;

subsys/bluetooth/controller/ll_sw/ctrl.h

@@ -342,6 +342,7 @@ u32_t radio_init(void *hf_clock, u8_t sca, u8_t connection_count_max,
 		 u16_t packet_data_octets_max,
 		 u16_t packet_tx_data_size, u8_t *mem_radio,
 		 u16_t mem_size);
+struct device *radio_hf_clock_get(void);
 void radio_ticks_active_to_start_set(u32_t ticks_active_to_start);
 /* Downstream - Advertiser */
 struct radio_adv_data *radio_adv_data_get(void);