-
Notifications
You must be signed in to change notification settings - Fork 1k
/
Copy pathstreamingData.cpp
300 lines (267 loc) · 10.9 KB
/
streamingData.cpp
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
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
/*
* See documentation at https://nRF24.github.io/RF24
* See License information at root directory of this library
* Author: Brendan Doherty (2bndy5)
*/
/**
* A simple example of streaming data from 1 nRF24L01 transceiver to another.
*
* This example was written to be used on 2 devices acting as "nodes".
* Use `ctrl+c` to quit at any time.
*/
#include <cmath> // abs()
#include <ctime> // time()
#include <cstring> // strcmp()
#include <iostream> // cin, cout, endl
#include <string> // string, getline()
#include <time.h> // CLOCK_MONOTONIC_RAW, timespec, clock_gettime()
#include <RF24/RF24.h> // RF24, RF24_PA_LOW, delay()
using namespace std;
/****************** Linux ***********************/
// Radio CE Pin, CSN Pin, SPI Speed
// CE Pin uses GPIO number with BCM and SPIDEV drivers, other platforms use their own pin numbering
// CS Pin addresses the SPI bus number at /dev/spidev<a>.<b>
// ie: RF24 radio(<ce_pin>, <a>*10+<b>); spidev1.0 is 10, spidev1.1 is 11 etc..
#define CSN_PIN 0
#ifdef MRAA
#define CE_PIN 15 // GPIO22
#elif defined(RF24_WIRINGPI)
#define CE_PIN 3 // GPIO22
#else
#define CE_PIN 22
#endif
// Generic:
RF24 radio(CE_PIN, CSN_PIN);
/****************** Linux (BBB,x86,etc) ***********************/
// See http://nRF24.github.io/RF24/pages.html for more information on usage
// See https://github.com/eclipse/mraa/ for more information on MRAA
// See https://www.kernel.org/doc/Documentation/spi/spidev for more information on SPIDEV
// For this example, we'll be sending 32 payloads each containing
// 32 bytes of data that looks like ASCII art when printed to the serial
// monitor. The TX node and RX node needs only a single 32 byte buffer.
#define SIZE 32 // this is the maximum for this example. (minimum is 1)
char buffer[SIZE + 1]; // for the RX node
unsigned int counter = 0; // for counting the number of received payloads
void makePayload(uint8_t); // prototype to construct a payload dynamically
void setRole(); // prototype to set the node's role
void master(); // prototype of the TX node's behavior
void slave(); // prototype of the RX node's behavior
void printHelp(string); // prototype to function that explain CLI arg usage
// custom defined timer for evaluating transmission time in microseconds
struct timespec startTimer, endTimer;
uint32_t getMicros(); // prototype to get elapsed time in microseconds
int main(int argc, char** argv)
{
// perform hardware check
if (!radio.begin()) {
cout << "radio hardware is not responding!!" << endl;
return 0; // quit now
}
// add a NULL terminating 0 for printing as a c-string
buffer[SIZE] = 0;
// Let these addresses be used for the pair of nodes used in this example
uint8_t address[2][6] = {"1Node", "2Node"};
// the TX address^ , ^the RX address
// It is very helpful to think of an address as a path instead of as
// an identifying device destination
// to use different addresses on a pair of radios, we need a variable to
// uniquely identify which address this radio will use to transmit
bool radioNumber = 1; // 0 uses address[0] to transmit, 1 uses address[1] to transmit
bool foundArgNode = false;
bool foundArgRole = false;
bool role = false;
if (argc > 1) {
// CLI args are specified
if ((argc - 1) % 2 != 0) {
// some CLI arg doesn't have an option specified for it
printHelp(string(argv[0])); // all args need an option in this example
return 0;
}
else {
// iterate through args starting after program name
int a = 1;
while (a < argc) {
bool invalidOption = false;
if (strcmp(argv[a], "-n") == 0 || strcmp(argv[a], "--node") == 0) {
// "-n" or "--node" has been specified
foundArgNode = true;
if (argv[a + 1][0] - 48 <= 1) {
radioNumber = (argv[a + 1][0] - 48) == 1;
}
else {
// option is invalid
invalidOption = true;
}
}
else if (strcmp(argv[a], "-r") == 0 || strcmp(argv[a], "--role") == 0) {
// "-r" or "--role" has been specified
foundArgRole = true;
if (argv[a + 1][0] - 48 <= 1) {
role = (argv[a + 1][0] - 48) == 1;
}
else {
// option is invalid
invalidOption = true;
}
}
if (invalidOption) {
printHelp(string(argv[0]));
return 0;
}
a += 2;
} // while
if (!foundArgNode && !foundArgRole) {
// no valid args were specified
printHelp(string(argv[0]));
return 0;
}
} // else
} // if
// print example's name
cout << argv[0] << endl;
if (!foundArgNode) {
// Set the radioNumber via the terminal on startup
cout << "Which radio is this? Enter '0' or '1'. Defaults to '0' ";
string input;
getline(cin, input);
radioNumber = input.length() > 0 && (uint8_t)input[0] == 49;
}
// save on transmission time by setting the radio to only transmit the
// number of bytes we need to transmit a float
radio.setPayloadSize(SIZE); // default value is the maximum 32 bytes
// Set the PA Level low to try preventing power supply related problems
// because these examples are likely run with nodes in close proximity to
// each other.
radio.setPALevel(RF24_PA_LOW); // RF24_PA_MAX is default.
// set the TX address of the RX node into the TX pipe
radio.openWritingPipe(address[radioNumber]); // always uses pipe 0
// set the RX address of the TX node into a RX pipe
radio.openReadingPipe(1, address[!radioNumber]); // using pipe 1
// For debugging info
// radio.printDetails(); // (smaller) function that prints raw register values
// radio.printPrettyDetails(); // (larger) function that prints human readable data
// ready to execute program now
if (!foundArgRole) { // if CLI arg "-r"/"--role" was not specified
setRole(); // calls master() or slave() based on user input
}
else { // if CLI arg "-r"/"--role" was specified
role ? master() : slave(); // based on CLI arg option
}
return 0;
}
/**
* set this node's role from stdin stream.
* this only considers the first char as input.
*/
void setRole()
{
string input = "";
while (!input.length()) {
cout << "*** PRESS 'T' to begin transmitting to the other node\n";
cout << "*** PRESS 'R' to begin receiving from the other node\n";
cout << "*** PRESS 'Q' to exit" << endl;
getline(cin, input);
if (input.length() >= 1) {
if (input[0] == 'T' || input[0] == 't')
master();
else if (input[0] == 'R' || input[0] == 'r')
slave();
else if (input[0] == 'Q' || input[0] == 'q')
break;
else
cout << input[0] << " is an invalid input. Please try again." << endl;
}
input = ""; // stay in the while loop
} // while
} // setRole()
/**
* make this node act as the transmitter
*/
void master()
{
radio.stopListening(); // put radio in TX mode
unsigned int failures = 0; // keep track of failures
uint8_t i = 0;
clock_gettime(CLOCK_MONOTONIC_RAW, &startTimer); // start the timer
while (i < SIZE) {
makePayload(i);
if (!radio.writeFast(&buffer, SIZE)) {
failures++;
radio.reUseTX();
}
else {
i++;
}
if (failures >= 100) {
// most likely no device is listening for the data stream
cout << "Too many failures detected. ";
cout << "Aborting at payload " << buffer[0];
break;
}
} // while
uint32_t elapsedTime = getMicros(); // end the timer
cout << "Time to transmit data = ";
cout << elapsedTime; // print the timer result
cout << " us. " << failures; // print number of retries
cout << " failures detected. Leaving TX role." << endl;
} // master
/**
* make this node act as the receiver
*/
void slave()
{
counter = 0;
radio.startListening(); // put radio in RX mode
time_t startTimer = time(nullptr); // start a timer
while (time(nullptr) - startTimer < 6) { // use 6 second timeout
if (radio.available()) { // is there a payload
radio.read(&buffer, SIZE); // fetch payload from FIFO
cout << "Received: " << buffer; // print the payload's value
cout << " - " << counter << endl; // print the counter
counter++; // increment counter
startTimer = time(nullptr); // reset timer
}
}
radio.stopListening(); // use TX mode for idle behavior
cout << "Nothing received in 6 seconds. Leaving RX role." << endl;
}
/**
* Make a single payload based on position in stream.
* This example employs this function to save on memory allocated.
*/
void makePayload(uint8_t i)
{
// let the first character be an identifying alphanumeric prefix
// this lets us see which payload didn't get received
buffer[0] = i + (i < 26 ? 65 : 71);
for (uint8_t j = 0; j < SIZE - 1; ++j) {
char chr = j >= (SIZE - 1) / 2 + abs((SIZE - 1) / 2 - i);
chr |= j < (SIZE - 1) / 2 - abs((SIZE - 1) / 2 - i);
buffer[j + 1] = chr + 48;
}
}
/**
* Calculate the elapsed time in microseconds
*/
uint32_t getMicros()
{
// this function assumes that the timer was started using
// `clock_gettime(CLOCK_MONOTONIC_RAW, &startTimer);`
clock_gettime(CLOCK_MONOTONIC_RAW, &endTimer);
uint32_t seconds = endTimer.tv_sec - startTimer.tv_sec;
uint32_t useconds = (endTimer.tv_nsec - startTimer.tv_nsec) / 1000;
return ((seconds)*1000 + useconds) + 0.5;
}
/**
* print a manual page of instructions on how to use this example's CLI args
*/
void printHelp(string progName)
{
cout << "usage: " << progName << " [-h] [-n {0,1}] [-r {0,1}]\n\n"
<< "A simple example of streaming data from 1 nRF24L01 transceiver to another.\n"
<< "\nThis example was written to be used on 2 devices acting as 'nodes'.\n"
<< "\noptional arguments:\n -h, --help\t\tshow this help message and exit\n"
<< " -n {0,1}, --node {0,1}\n\t\t\tthe identifying radio number\n"
<< " -r {0,1}, --role {0,1}\n\t\t\t'1' specifies the TX role."
<< " '0' specifies the RX role." << endl;
}