examples: Add radio-observer example

This patch adds an example that implements the GAP observer role using
radio and timer APIs directly.

2 files changed, 155 insertions, 0 deletions

diff --git a/examples/radio-observer/Makefile b/examples/radio-observer/Makefile
new file mode 100644
index 0000000..5528c4a
--- /dev/null
+++ b/examples/radio-observer/Makefile
@@ -0,0 +1,7 @@
+# Makefile for radio-observer example
+
+PROJECT_TARGET		= radio-observer-example
+PROJECT_SOURCE_FILES	= main.c
+
+BLESTACK_PATH		= ../..
+-include $(BLESTACK_PATH)/Makefile.common
diff --git a/examples/radio-observer/main.c b/examples/radio-observer/main.c
new file mode 100644
index 0000000..b7eb942
--- /dev/null
+++ b/examples/radio-observer/main.c
@@ -0,0 +1,148 @@
+/**
+ *  The MIT License (MIT)
+ *
+ *  Copyright (c) 2013 Paulo B. de Oliveira Filho <pauloborgesfilho@gmail.com>
+ *  Copyright (c) 2013 Claudio Takahasi <claudio.takahasi@gmail.com>
+ *  Copyright (c) 2013 João Paulo Rechi Vita <jprvita@gmail.com>
+ *
+ *  Permission is hereby granted, free of charge, to any person obtaining a copy
+ *  of this software and associated documentation files (the "Software"), to deal
+ *  in the Software without restriction, including without limitation the rights
+ *  to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ *  copies of the Software, and to permit persons to whom the Software is
+ *  furnished to do so, subject to the following conditions:
+ *
+ *  The above copyright notice and this permission notice shall be included in all
+ *  copies or substantial portions of the Software.
+ *
+ *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ *  IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ *  FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ *  AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ *  LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ *  OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
+ *  SOFTWARE.
+ */
+
+#include <stdint.h>
+#include <string.h>
+#include <stdio.h>
+
+#include "timer.h"
+#include "radio.h"
+#include "log.h"
+
+#define ADV_CHANNEL_AA			0x8E89BED6
+#define ADV_CHANNEL_CRC			0x555555
+
+#define SCAN_WINDOW			1000
+#define SCAN_INTERVAL			2000
+
+static uint8_t channels[] = { 37, 38, 39 };
+static uint8_t idx = 0;
+
+static int16_t scan_window;
+static int16_t scan_interval;
+
+static __inline const char *pdu_type(uint8_t type)
+{
+	switch (type) {
+	case 0:
+		return "ADV_IND (0000)";
+	case 1:
+		return "ADV_DIRECT_IND (0001)";
+	case 2:
+		return "ADV_NONCONN_IND (0010)";
+	case 3:
+		return "SCAN_REQ (0011)";
+	case 4:
+		return "SCAN_RSP (0100)";
+	case 5:
+		return "CONNECT_REQ (0101)";
+	case 6:
+		return "ADV_SCAN_IND (0110)";
+	default:
+		return "Reserved (0111-1111)";
+	}
+}
+
+static __inline const char *format_payload(struct radio_packet *packet)
+{
+	static char payload[110];
+	uint8_t i;
+
+	for (i = 0; i < packet->len - 2; i++)
+		sprintf(payload + 3*i, "%02x ", packet->pdu[i + 2]);
+
+	return payload;
+}
+
+void scan_window_timeout(void *user_data)
+{
+	radio_stop();
+}
+
+void scan_interval_timeout(void *user_data)
+{
+	idx = (idx + 1) % sizeof(channels);
+
+	radio_recv(channels[idx], ADV_CHANNEL_AA, ADV_CHANNEL_CRC);
+	timer_start(scan_window, SCAN_WINDOW, NULL);
+}
+
+void radio_hdlr(uint8_t evt, void *data)
+{
+	struct radio_packet *packet;
+	uint8_t length;
+
+	if (evt != RADIO_EVT_RX_COMPLETED) {
+		ERROR("Unexpected radio evt: %u", evt);
+		return;
+	}
+
+	packet = data;
+	length = packet->pdu[1] & 0x3F;
+
+	DBG("ADV PACKET ON CHANNEL %u", channels[idx]);
+
+	if (length > RADIO_MAX_PDU_LEN - 2) {
+		DBG("Invalid length: %u", length);
+		return;
+	}
+
+	DBG("CRC:     %s", packet->crc ? "OK" : "BAD");
+
+	if (packet->crc == 0)
+		return;
+
+	DBG("PDU:     %s", pdu_type(packet->pdu[0] & 0xF));
+	DBG("TxAdd:   %u", (packet->pdu[0] >> 6) & 0x1);
+	DBG("RxAdd:   %u", (packet->pdu[0] >> 7) & 0x1);
+	DBG("Length:  %u", length);
+	DBG("Payload: %s", format_payload(packet));
+
+	radio_recv(channels[idx], ADV_CHANNEL_AA, ADV_CHANNEL_CRC);
+}
+
+int main(void)
+{
+	log_init();
+	timer_init();
+	radio_init();
+	radio_register_handler(radio_hdlr);
+
+	scan_window = timer_create(TIMER_SINGLESHOT, scan_window_timeout);
+	scan_interval = timer_create(TIMER_REPEATED, scan_interval_timeout);
+
+	DBG("Scanning with:");
+	DBG("scanWindow:   %u ms", SCAN_WINDOW);
+	DBG("scanInterval: %u ms", SCAN_INTERVAL);
+
+	radio_recv(channels[idx], ADV_CHANNEL_AA, ADV_CHANNEL_CRC);
+	timer_start(scan_window, SCAN_WINDOW, NULL);
+	timer_start(scan_interval, SCAN_INTERVAL, NULL);
+
+	while (1);
+
+	return 0;
+}