diff options
| -rw-r--r-- | examples/radio-observer/Makefile | 7 | ||||
| -rw-r--r-- | examples/radio-observer/main.c | 148 |
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; +} |