1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
|
#include <stdint.h>
#include <string.h>
#include <stdio.h>
#include "ch.h"
#include "hal.h"
#include "chprintf.h"
#include "nrf52_radio.h"
static SerialConfig serial_config = {
.speed = 38400,
.tx_pad = UART_TX,
.rx_pad = UART_RX,
#if NRF5_SERIAL_USE_HWFLOWCTRL == TRUE
.rts_pad = UART_RTS,
.cts_pad = UART_CTS,
#endif
};
static THD_WORKING_AREA(waLEDThread, 64);
static THD_FUNCTION(LEDThread, arg) {
(void)arg;
chRegSetThreadName("blinker");
palSetPadMode(IOPORT1, LED1, PAL_MODE_OUTPUT_PUSHPULL);
while (1) {
palTogglePad(IOPORT1, LED1);
chThdSleepMilliseconds(500);
}
}
static nrf52_config_t radiocfg = {
.protocol = NRF52_PROTOCOL_ESB_DPL,
.mode = NRF52_MODE_PRX,
.bitrate = NRF52_BITRATE_1MBPS,
.crc = NRF52_CRC_8BIT,
.tx_power = NRF52_TX_POWER_0DBM,
.tx_mode = NRF52_TXMODE_MANUAL_START,
.selective_auto_ack = false,
.retransmit = { 1000, 3 },
.payload_length = 0,
.address = {
.base_addr_p0 = { 0xF3, 0xF3, 0xF3, 0x01 },
.base_addr_p1 = { 0x3F, 0x3F, 0x3F, 0x01 },
.pipe_prefixes = { 0xF3, 0x3F, },
.num_pipes = 2,
.addr_length = 5,
.rx_pipes = 1 << 0,
.rf_channel = 1,
},
};
static uint16_t cnt, fail_pkt, good_pkt;
static nrf52_payload_t tx_payload = {
.pipe = 1,
};
static nrf52_payload_t rx_payload;
static THD_WORKING_AREA(waRadioThread, 256);
static THD_FUNCTION(RadioThread, arg) {
(void)arg;
event_listener_t el;
chEvtRegisterMask(&RFD1.eventsrc, &el, EVENT_MASK(0));
chRegSetThreadName("radio");
while (1) {
chEvtWaitAny(EVENT_MASK(0));
eventflags_t flags = chEvtGetAndClearFlags(&el);
if (flags & NRF52_EVENT_TX_SUCCESS) {
radio_start_rx();
good_pkt++;
}
if (flags & NRF52_EVENT_TX_FAILED) {
radio_start_rx();
fail_pkt++;
}
if (flags & NRF52_EVENT_RX_RECEIVED) {
memset(rx_payload.data, 0, 32);
radio_read_rx_payload(&rx_payload);
}
}
}
/**@brief Function for application main entry.
*/
int main(void) {
halInit();
chSysInit();
sdStart(&SD1, &serial_config);
chThdCreateStatic(waLEDThread, sizeof(waLEDThread), NORMALPRIO, LEDThread, NULL);
chThdCreateStatic(waRadioThread, sizeof(waRadioThread), NORMALPRIO, RadioThread, NULL);
radio_init(&radiocfg);
radio_flush_tx();
radio_flush_rx();
radio_start_rx();
cnt = good_pkt = fail_pkt = 0;
while (true) {
memset(tx_payload.data, 0, 32);
sprintf((char*)tx_payload.data, "counter value=%d" , cnt++);
tx_payload.length = strlen((char *)tx_payload.data);
radio_stop_rx();
radio_write_payload(&tx_payload);
radio_start_tx();
chprintf((BaseSequentialStream *)&SD1, "packets: good=%d, fail=%d, sent=%s\r\n", good_pkt, fail_pkt, tx_payload.data);
chThdSleepMilliseconds(500);
if (strlen((char*) rx_payload.data)) {
chprintf((BaseSequentialStream *)&SD1, "rssi=%d, received=%s\r\n", rx_payload.rssi, rx_payload.data);
rx_payload.data[0] = 0;
}
}
}
|
