| User | Revision | Line number | New contents of line |
|---|
| madcowswe |
0:525cb1ac9f1f
|
1
|
#include "RF12B.h"
|
| madcowswe |
0:525cb1ac9f1f
|
2
|
|
| madcowswe |
0:525cb1ac9f1f
|
3
|
#include "RF_defs.h"
|
| madcowswe |
0:525cb1ac9f1f
|
4
|
#include <algorithm>
|
| madcowswe |
0:525cb1ac9f1f
|
5
|
|
| madcowswe |
0:525cb1ac9f1f
|
6
|
|
| madcowswe |
0:525cb1ac9f1f
|
7
|
RF12B::RF12B(PinName _SDI,
|
| madcowswe |
0:525cb1ac9f1f
|
8
|
PinName _SDO,
|
| madcowswe |
0:525cb1ac9f1f
|
9
|
PinName _SCK,
|
| madcowswe |
0:525cb1ac9f1f
|
10
|
PinName _NCS,
|
| madcowswe |
0:525cb1ac9f1f
|
11
|
PinName _NIRQ):spi(_SDI, _SDO, _SCK),
|
| madcowswe |
0:525cb1ac9f1f
|
12
|
NCS(_NCS), NIRQ(_NIRQ), NIRQ_in(_NIRQ), rfled(LED3) {
|
| madcowswe |
0:525cb1ac9f1f
|
13
|
|
| madcowswe |
0:525cb1ac9f1f
|
14
|
/* SPI frequency, word lenght, polarity and phase */
|
| madcowswe |
0:525cb1ac9f1f
|
15
|
spi.format(16,0);
|
| madcowswe |
0:525cb1ac9f1f
|
16
|
spi.frequency(2000000);
|
| madcowswe |
0:525cb1ac9f1f
|
17
|
|
| madcowswe |
0:525cb1ac9f1f
|
18
|
/* Set ~CS high */
|
| madcowswe |
0:525cb1ac9f1f
|
19
|
NCS = 1;
|
| madcowswe |
0:525cb1ac9f1f
|
20
|
|
| madcowswe |
0:525cb1ac9f1f
|
21
|
/* Initialise RF Module */
|
| madcowswe |
0:525cb1ac9f1f
|
22
|
init();
|
| madcowswe |
0:525cb1ac9f1f
|
23
|
|
| madcowswe |
0:525cb1ac9f1f
|
24
|
/* Setup interrupt to happen on falling edge of NIRQ */
|
| madcowswe |
0:525cb1ac9f1f
|
25
|
NIRQ.fall(this, &RF12B::rxISR);
|
| madcowswe |
0:525cb1ac9f1f
|
26
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
27
|
|
| madcowswe |
0:525cb1ac9f1f
|
28
|
/* Returns the packet length if data is available in the receive buffer, 0 otherwise*/
|
| madcowswe |
0:525cb1ac9f1f
|
29
|
unsigned int RF12B::available() {
|
| madcowswe |
0:525cb1ac9f1f
|
30
|
return fifo.size();
|
| madcowswe |
0:525cb1ac9f1f
|
31
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
32
|
|
| madcowswe |
0:525cb1ac9f1f
|
33
|
/* Reads a packet of data, with length "size" Returns false if read failed. TODO: make a metafifo to isolate packets*/
|
| madcowswe |
0:525cb1ac9f1f
|
34
|
bool RF12B::read(unsigned char* data, unsigned int size) {
|
| madcowswe |
0:525cb1ac9f1f
|
35
|
if (fifo.size() == 0) {
|
| madcowswe |
0:525cb1ac9f1f
|
36
|
return false;
|
| madcowswe |
0:525cb1ac9f1f
|
37
|
} else {
|
| madcowswe |
0:525cb1ac9f1f
|
38
|
unsigned int i = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
39
|
while (fifo.size() > 0 && i < size) {
|
| madcowswe |
0:525cb1ac9f1f
|
40
|
data[i++] = fifo.front();
|
| madcowswe |
0:525cb1ac9f1f
|
41
|
fifo.pop();
|
| madcowswe |
0:525cb1ac9f1f
|
42
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
43
|
return true;
|
| madcowswe |
0:525cb1ac9f1f
|
44
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
45
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
46
|
|
| madcowswe |
0:525cb1ac9f1f
|
47
|
/* Reads a byte of data from the receive buffer */
|
| madcowswe |
0:525cb1ac9f1f
|
48
|
unsigned char RF12B::read() {
|
| madcowswe |
0:525cb1ac9f1f
|
49
|
if (available()) {
|
| madcowswe |
0:525cb1ac9f1f
|
50
|
unsigned char data = fifo.front();
|
| madcowswe |
0:525cb1ac9f1f
|
51
|
fifo.pop();
|
| madcowswe |
0:525cb1ac9f1f
|
52
|
return data;
|
| madcowswe |
0:525cb1ac9f1f
|
53
|
} else {
|
| madcowswe |
0:525cb1ac9f1f
|
54
|
return 0xFF; // Error val although could also be data...
|
| madcowswe |
0:525cb1ac9f1f
|
55
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
56
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
57
|
|
| madcowswe |
0:525cb1ac9f1f
|
58
|
/* Sends a packet of data to the RF module for transmission TODO: Make asych*/
|
| madcowswe |
0:525cb1ac9f1f
|
59
|
void RF12B::write(unsigned char *data, unsigned char length) {
|
| madcowswe |
0:525cb1ac9f1f
|
60
|
unsigned char crc = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
61
|
|
| madcowswe |
0:525cb1ac9f1f
|
62
|
/* Transmitter mode */
|
| madcowswe |
0:525cb1ac9f1f
|
63
|
changeMode(TX);
|
| madcowswe |
0:525cb1ac9f1f
|
64
|
|
| madcowswe |
0:525cb1ac9f1f
|
65
|
writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
66
|
send(0xAA); // PREAMBLE
|
| madcowswe |
0:525cb1ac9f1f
|
67
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
68
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
69
|
send(0x2D); // SYNC
|
| madcowswe |
0:525cb1ac9f1f
|
70
|
send(0xD4);
|
| madcowswe |
0:525cb1ac9f1f
|
71
|
/* Packet Length */
|
| madcowswe |
0:525cb1ac9f1f
|
72
|
send(length);
|
| madcowswe |
0:525cb1ac9f1f
|
73
|
crc = crc8(crc, length);
|
| madcowswe |
0:525cb1ac9f1f
|
74
|
send(crc);
|
| madcowswe |
0:525cb1ac9f1f
|
75
|
crc = crc8(crc, crc);
|
| madcowswe |
0:525cb1ac9f1f
|
76
|
/* Packet Data */
|
| madcowswe |
0:525cb1ac9f1f
|
77
|
for (unsigned char i=0; i<length; i++) {
|
| madcowswe |
0:525cb1ac9f1f
|
78
|
send(data[i]);
|
| madcowswe |
0:525cb1ac9f1f
|
79
|
crc = crc8(crc, data[i]);
|
| madcowswe |
0:525cb1ac9f1f
|
80
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
81
|
send(crc);
|
| madcowswe |
0:525cb1ac9f1f
|
82
|
send(0xAA); // DUMMY BYTES
|
| madcowswe |
0:525cb1ac9f1f
|
83
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
84
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
85
|
|
| madcowswe |
0:525cb1ac9f1f
|
86
|
/* Back to receiver mode */
|
| madcowswe |
0:525cb1ac9f1f
|
87
|
changeMode(RX);
|
| madcowswe |
0:525cb1ac9f1f
|
88
|
status();
|
| madcowswe |
0:525cb1ac9f1f
|
89
|
|
| madcowswe |
0:525cb1ac9f1f
|
90
|
|
| madcowswe |
0:525cb1ac9f1f
|
91
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
92
|
|
| madcowswe |
0:525cb1ac9f1f
|
93
|
/* Transmit a 1-byte data packet */
|
| madcowswe |
0:525cb1ac9f1f
|
94
|
void RF12B::write(unsigned char data) {
|
| madcowswe |
0:525cb1ac9f1f
|
95
|
write(&data, 1);
|
| madcowswe |
0:525cb1ac9f1f
|
96
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
97
|
|
| madcowswe |
0:525cb1ac9f1f
|
98
|
void RF12B::write(queue<char> &data, int length) {
|
| madcowswe |
0:525cb1ac9f1f
|
99
|
char crc = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
100
|
char length_byte = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
101
|
|
| madcowswe |
0:525cb1ac9f1f
|
102
|
/* -1 means try to transmit everything in the queue */
|
| madcowswe |
0:525cb1ac9f1f
|
103
|
if(length == -1) {
|
| madcowswe |
0:525cb1ac9f1f
|
104
|
length = data.size();
|
| madcowswe |
0:525cb1ac9f1f
|
105
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
106
|
|
| madcowswe |
0:525cb1ac9f1f
|
107
|
/* max length of packet is 255 */
|
| madcowswe |
0:525cb1ac9f1f
|
108
|
length_byte = min(length, 255);
|
| madcowswe |
0:525cb1ac9f1f
|
109
|
|
| madcowswe |
0:525cb1ac9f1f
|
110
|
/* Transmitter mode */
|
| madcowswe |
0:525cb1ac9f1f
|
111
|
changeMode(TX);
|
| madcowswe |
0:525cb1ac9f1f
|
112
|
|
| madcowswe |
0:525cb1ac9f1f
|
113
|
writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
114
|
send(0xAA); // PREAMBLE
|
| madcowswe |
0:525cb1ac9f1f
|
115
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
116
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
117
|
send(0x2D); // SYNC
|
| madcowswe |
0:525cb1ac9f1f
|
118
|
send(0xD4);
|
| madcowswe |
0:525cb1ac9f1f
|
119
|
/* Packet Length */
|
| madcowswe |
0:525cb1ac9f1f
|
120
|
send(length_byte);
|
| madcowswe |
0:525cb1ac9f1f
|
121
|
crc = crc8(crc, length_byte);
|
| madcowswe |
0:525cb1ac9f1f
|
122
|
send(crc);
|
| madcowswe |
0:525cb1ac9f1f
|
123
|
crc = crc8(crc, crc);
|
| madcowswe |
0:525cb1ac9f1f
|
124
|
/* Packet Data */
|
| madcowswe |
0:525cb1ac9f1f
|
125
|
for (char i=0; i<length_byte; i++) {
|
| madcowswe |
0:525cb1ac9f1f
|
126
|
send(data.front());
|
| madcowswe |
0:525cb1ac9f1f
|
127
|
crc = crc8(crc, data.front());
|
| madcowswe |
0:525cb1ac9f1f
|
128
|
data.pop();
|
| madcowswe |
0:525cb1ac9f1f
|
129
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
130
|
send(crc);
|
| madcowswe |
0:525cb1ac9f1f
|
131
|
send(0xAA); // DUMMY BYTES
|
| madcowswe |
0:525cb1ac9f1f
|
132
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
133
|
send(0xAA);
|
| madcowswe |
0:525cb1ac9f1f
|
134
|
|
| madcowswe |
0:525cb1ac9f1f
|
135
|
/* Back to receiver mode */
|
| madcowswe |
0:525cb1ac9f1f
|
136
|
changeMode(RX);
|
| madcowswe |
0:525cb1ac9f1f
|
137
|
status();
|
| madcowswe |
0:525cb1ac9f1f
|
138
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
139
|
|
| madcowswe |
0:525cb1ac9f1f
|
140
|
/**********************************************************************
|
| madcowswe |
0:525cb1ac9f1f
|
141
|
* PRIVATE FUNCTIONS
|
| madcowswe |
0:525cb1ac9f1f
|
142
|
*********************************************************************/
|
| madcowswe |
0:525cb1ac9f1f
|
143
|
|
| madcowswe |
0:525cb1ac9f1f
|
144
|
/* Initialises the RF12B module */
|
| madcowswe |
0:525cb1ac9f1f
|
145
|
void RF12B::init() {
|
| madcowswe |
0:525cb1ac9f1f
|
146
|
/* writeCmd(0x80E7); //EL,EF,868band,12.0pF
|
| madcowswe |
0:525cb1ac9f1f
|
147
|
changeMode(RX);
|
| madcowswe |
0:525cb1ac9f1f
|
148
|
writeCmd(0xA640); //frequency select
|
| madcowswe |
0:525cb1ac9f1f
|
149
|
writeCmd(0xC647); //4.8kbps
|
| madcowswe |
0:525cb1ac9f1f
|
150
|
writeCmd(0x94A0); //VDI,FAST,134kHz,0dBm,-103dBm
|
| madcowswe |
0:525cb1ac9f1f
|
151
|
writeCmd(0xC2AC); //AL,!ml,DIG,DQD4
|
| madcowswe |
0:525cb1ac9f1f
|
152
|
writeCmd(0xCA81); //FIFO8,SYNC,!ff,DR
|
| madcowswe |
0:525cb1ac9f1f
|
153
|
writeCmd(0xCED4); //SYNC=2DD4
|
| madcowswe |
0:525cb1ac9f1f
|
154
|
writeCmd(0xC483); //@PWR,NO RSTRIC,!st,!fi,OE,EN
|
| madcowswe |
0:525cb1ac9f1f
|
155
|
writeCmd(0x9850); //!mp,90kHz,MAX OUT
|
| madcowswe |
0:525cb1ac9f1f
|
156
|
writeCmd(0xCC17); //OB1, COB0, LPX, Iddy, CDDIT�CBW0
|
| madcowswe |
0:525cb1ac9f1f
|
157
|
writeCmd(0xE000); //NOT USED
|
| madcowswe |
0:525cb1ac9f1f
|
158
|
writeCmd(0xC800); //NOT USED
|
| madcowswe |
0:525cb1ac9f1f
|
159
|
writeCmd(0xC040); //1.66MHz,2.2V */
|
| madcowswe |
0:525cb1ac9f1f
|
160
|
|
| madcowswe |
0:525cb1ac9f1f
|
161
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
162
|
RFM_CONFIG_EL |
|
| madcowswe |
0:525cb1ac9f1f
|
163
|
RFM_CONFIG_EF |
|
| madcowswe |
0:525cb1ac9f1f
|
164
|
RFM_CONFIG_BAND_433 //|
|
| madcowswe |
0:525cb1ac9f1f
|
165
|
//RFM_CONFIG_X_11_0pf // meh, using default
|
| madcowswe |
0:525cb1ac9f1f
|
166
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
167
|
|
| madcowswe |
0:525cb1ac9f1f
|
168
|
// 2. Power Management Command
|
| madcowswe |
0:525cb1ac9f1f
|
169
|
// leave everything switched off for now
|
| madcowswe |
0:525cb1ac9f1f
|
170
|
/*
|
| madcowswe |
0:525cb1ac9f1f
|
171
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
172
|
RFM_POWER_MANAGEMENT // switch all off
|
| madcowswe |
0:525cb1ac9f1f
|
173
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
174
|
*/
|
| madcowswe |
0:525cb1ac9f1f
|
175
|
|
| madcowswe |
0:525cb1ac9f1f
|
176
|
// 3. Frequency Setting Command
|
| madcowswe |
0:525cb1ac9f1f
|
177
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
178
|
RFM_FREQUENCY |
|
| madcowswe |
0:525cb1ac9f1f
|
179
|
RFM_FREQ_433Band(435.7) //I totally made this value up... if someone knows where the sweetspots are in this band, tell me!
|
| madcowswe |
0:525cb1ac9f1f
|
180
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
181
|
|
| madcowswe |
0:525cb1ac9f1f
|
182
|
|
| madcowswe |
0:525cb1ac9f1f
|
183
|
// 4. Data Rate Command
|
| madcowswe |
0:525cb1ac9f1f
|
184
|
writeCmd(RFM_DATA_RATE_9600);
|
| madcowswe |
0:525cb1ac9f1f
|
185
|
|
| madcowswe |
0:525cb1ac9f1f
|
186
|
|
| madcowswe |
0:525cb1ac9f1f
|
187
|
// 5. Receiver Control Command
|
| madcowswe |
0:525cb1ac9f1f
|
188
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
189
|
RFM_RX_CONTROL_P20_VDI |
|
| madcowswe |
0:525cb1ac9f1f
|
190
|
RFM_RX_CONTROL_VDI_FAST |
|
| madcowswe |
0:525cb1ac9f1f
|
191
|
//RFM_RX_CONTROL_BW(RFM_BAUD_RATE) |
|
| madcowswe |
0:525cb1ac9f1f
|
192
|
RFM_RX_CONTROL_BW_134 | // CHANGE THIS TO 67 TO IMPROVE RANGE! (though the bitrate must then be below 8kbaud, and fsk modulation changed)
|
| madcowswe |
0:525cb1ac9f1f
|
193
|
RFM_RX_CONTROL_GAIN_0 |
|
| madcowswe |
0:525cb1ac9f1f
|
194
|
RFM_RX_CONTROL_RSSI_103 // Might need adjustment. Datasheet says around 10^-5 bit error rate at this level and baudrate.
|
| madcowswe |
0:525cb1ac9f1f
|
195
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
196
|
|
| madcowswe |
0:525cb1ac9f1f
|
197
|
// 6. Data Filter Command
|
| madcowswe |
0:525cb1ac9f1f
|
198
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
199
|
RFM_DATA_FILTER_AL |
|
| madcowswe |
0:525cb1ac9f1f
|
200
|
RFM_DATA_FILTER_ML |
|
| madcowswe |
0:525cb1ac9f1f
|
201
|
RFM_DATA_FILTER_DIG //|
|
| madcowswe |
0:525cb1ac9f1f
|
202
|
//RFM_DATA_FILTER_DQD(4)
|
| madcowswe |
0:525cb1ac9f1f
|
203
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
204
|
|
| madcowswe |
0:525cb1ac9f1f
|
205
|
// 7. FIFO and Reset Mode Command
|
| madcowswe |
0:525cb1ac9f1f
|
206
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
207
|
RFM_FIFO_IT(8) |
|
| madcowswe |
0:525cb1ac9f1f
|
208
|
RFM_FIFO_DR |
|
| madcowswe |
0:525cb1ac9f1f
|
209
|
0x8 //turn on 16bit sync word
|
| madcowswe |
0:525cb1ac9f1f
|
210
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
211
|
|
| madcowswe |
0:525cb1ac9f1f
|
212
|
// 8. FIFO Syncword
|
| madcowswe |
0:525cb1ac9f1f
|
213
|
// Leave as default: 0xD4
|
| madcowswe |
0:525cb1ac9f1f
|
214
|
|
| madcowswe |
0:525cb1ac9f1f
|
215
|
// 9. Receiver FIFO Read
|
| madcowswe |
0:525cb1ac9f1f
|
216
|
// when the interupt goes high, (and if we can assume that it was a fifo fill interrupt) we can read a byte using:
|
| madcowswe |
0:525cb1ac9f1f
|
217
|
// result = RFM_READ_FIFO();
|
| madcowswe |
0:525cb1ac9f1f
|
218
|
|
| madcowswe |
0:525cb1ac9f1f
|
219
|
// 10. AFC Command
|
| madcowswe |
0:525cb1ac9f1f
|
220
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
221
|
//RFM_AFC_AUTO_VDI | //Note this might be changed to improve range. Refer to datasheet.
|
| madcowswe |
0:525cb1ac9f1f
|
222
|
RFM_AFC_AUTO_INDEPENDENT |
|
| madcowswe |
0:525cb1ac9f1f
|
223
|
RFM_AFC_RANGE_LIMIT_7_8 |
|
| madcowswe |
0:525cb1ac9f1f
|
224
|
RFM_AFC_EN |
|
| madcowswe |
0:525cb1ac9f1f
|
225
|
RFM_AFC_OE |
|
| madcowswe |
0:525cb1ac9f1f
|
226
|
RFM_AFC_FI
|
| madcowswe |
0:525cb1ac9f1f
|
227
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
228
|
|
| madcowswe |
0:525cb1ac9f1f
|
229
|
// 11. TX Configuration Control Command
|
| madcowswe |
0:525cb1ac9f1f
|
230
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
231
|
RFM_TX_CONTROL_MOD_60 |
|
| madcowswe |
0:525cb1ac9f1f
|
232
|
RFM_TX_CONTROL_POW_0
|
| madcowswe |
0:525cb1ac9f1f
|
233
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
234
|
|
| madcowswe |
0:525cb1ac9f1f
|
235
|
|
| madcowswe |
0:525cb1ac9f1f
|
236
|
// 12. PLL Setting Command
|
| madcowswe |
0:525cb1ac9f1f
|
237
|
writeCmd(
|
| madcowswe |
0:525cb1ac9f1f
|
238
|
0xCC77 & ~0x01 // Setting the PLL bandwith, less noise, but max bitrate capped at 86.2
|
| madcowswe |
0:525cb1ac9f1f
|
239
|
// I think this will slow down the pll's reaction time. Not sure, check with someone!
|
| madcowswe |
0:525cb1ac9f1f
|
240
|
);
|
| madcowswe |
0:525cb1ac9f1f
|
241
|
|
| madcowswe |
0:525cb1ac9f1f
|
242
|
changeMode(RX);
|
| madcowswe |
0:525cb1ac9f1f
|
243
|
resetRX();
|
| madcowswe |
0:525cb1ac9f1f
|
244
|
status();
|
| madcowswe |
0:525cb1ac9f1f
|
245
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
246
|
|
| madcowswe |
0:525cb1ac9f1f
|
247
|
/* Write a command to the RF Module */
|
| madcowswe |
0:525cb1ac9f1f
|
248
|
unsigned int RF12B::writeCmd(unsigned int cmd) {
|
| madcowswe |
0:525cb1ac9f1f
|
249
|
NCS = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
250
|
unsigned int recv = spi.write(cmd);
|
| madcowswe |
0:525cb1ac9f1f
|
251
|
NCS = 1;
|
| madcowswe |
0:525cb1ac9f1f
|
252
|
return recv;
|
| madcowswe |
0:525cb1ac9f1f
|
253
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
254
|
|
| madcowswe |
0:525cb1ac9f1f
|
255
|
/* Sends a byte of data across RF */
|
| madcowswe |
0:525cb1ac9f1f
|
256
|
void RF12B::send(unsigned char data) {
|
| madcowswe |
0:525cb1ac9f1f
|
257
|
while (NIRQ);
|
| madcowswe |
0:525cb1ac9f1f
|
258
|
writeCmd(0xB800 + data);
|
| madcowswe |
0:525cb1ac9f1f
|
259
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
260
|
|
| madcowswe |
0:525cb1ac9f1f
|
261
|
/* Change the mode of the RF module to Transmitting or Receiving */
|
| madcowswe |
0:525cb1ac9f1f
|
262
|
void RF12B::changeMode(rfmode_t _mode) {
|
| madcowswe |
0:525cb1ac9f1f
|
263
|
mode = _mode;
|
| madcowswe |
0:525cb1ac9f1f
|
264
|
if (_mode == TX) {
|
| madcowswe |
0:525cb1ac9f1f
|
265
|
writeCmd(0x8239); //!er,!ebb,ET,ES,EX,!eb,!ew,DC
|
| madcowswe |
0:525cb1ac9f1f
|
266
|
} else { /* mode == RX */
|
| madcowswe |
0:525cb1ac9f1f
|
267
|
writeCmd(0x8299); //er,!ebb,ET,ES,EX,!eb,!ew,DC
|
| madcowswe |
0:525cb1ac9f1f
|
268
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
269
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
270
|
|
| madcowswe |
0:525cb1ac9f1f
|
271
|
/* Interrupt routine for data reception */
|
| madcowswe |
0:525cb1ac9f1f
|
272
|
void RF12B::rxISR() {
|
| madcowswe |
0:525cb1ac9f1f
|
273
|
unsigned int data = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
274
|
static int i = -2;
|
| madcowswe |
0:525cb1ac9f1f
|
275
|
static unsigned char packet_length = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
276
|
static unsigned char crc = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
277
|
static queue<unsigned char> temp;
|
| madcowswe |
0:525cb1ac9f1f
|
278
|
|
| madcowswe |
0:525cb1ac9f1f
|
279
|
//Loop while interrupt is asserted
|
| madcowswe |
0:525cb1ac9f1f
|
280
|
while (!NIRQ_in && mode == RX) {
|
| madcowswe |
0:525cb1ac9f1f
|
281
|
|
| madcowswe |
0:525cb1ac9f1f
|
282
|
/* Grab the packet's length byte */
|
| madcowswe |
0:525cb1ac9f1f
|
283
|
if (i == -2) {
|
| madcowswe |
0:525cb1ac9f1f
|
284
|
data = writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
285
|
if ( (data&0x8000) ) {
|
| madcowswe |
0:525cb1ac9f1f
|
286
|
data = writeCmd(0xB000);
|
| madcowswe |
0:525cb1ac9f1f
|
287
|
packet_length = (data&0x00FF);
|
| madcowswe |
0:525cb1ac9f1f
|
288
|
crc = crc8(crc, packet_length);
|
| madcowswe |
0:525cb1ac9f1f
|
289
|
i++;
|
| madcowswe |
0:525cb1ac9f1f
|
290
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
291
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
292
|
|
| madcowswe |
0:525cb1ac9f1f
|
293
|
//If we exhaust the interrupt, exit
|
| madcowswe |
0:525cb1ac9f1f
|
294
|
if (NIRQ_in)
|
| madcowswe |
0:525cb1ac9f1f
|
295
|
break;
|
| madcowswe |
0:525cb1ac9f1f
|
296
|
|
| madcowswe |
0:525cb1ac9f1f
|
297
|
// Check that packet length was correct
|
| madcowswe |
0:525cb1ac9f1f
|
298
|
if (i == -1) {
|
| madcowswe |
0:525cb1ac9f1f
|
299
|
data = writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
300
|
if ( (data&0x8000) ) {
|
| madcowswe |
0:525cb1ac9f1f
|
301
|
data = writeCmd(0xB000);
|
| madcowswe |
0:525cb1ac9f1f
|
302
|
unsigned char crcofsize = (data&0x00FF);
|
| madcowswe |
0:525cb1ac9f1f
|
303
|
if (crcofsize != crc) {
|
| madcowswe |
0:525cb1ac9f1f
|
304
|
//It was wrong, start over
|
| madcowswe |
0:525cb1ac9f1f
|
305
|
i = -2;
|
| madcowswe |
0:525cb1ac9f1f
|
306
|
packet_length = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
307
|
crc = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
308
|
temp = queue<unsigned char>();
|
| madcowswe |
0:525cb1ac9f1f
|
309
|
resetRX();
|
| madcowswe |
0:525cb1ac9f1f
|
310
|
} else {
|
| madcowswe |
0:525cb1ac9f1f
|
311
|
crc = crc8(crc, crcofsize);
|
| madcowswe |
0:525cb1ac9f1f
|
312
|
i++;
|
| madcowswe |
0:525cb1ac9f1f
|
313
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
314
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
315
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
316
|
|
| madcowswe |
0:525cb1ac9f1f
|
317
|
//If we exhaust the interrupt, exit
|
| madcowswe |
0:525cb1ac9f1f
|
318
|
if (NIRQ_in)
|
| madcowswe |
0:525cb1ac9f1f
|
319
|
break;
|
| madcowswe |
0:525cb1ac9f1f
|
320
|
|
| madcowswe |
0:525cb1ac9f1f
|
321
|
/* Grab the packet's data */
|
| madcowswe |
0:525cb1ac9f1f
|
322
|
if (i >= 0 && i < packet_length) {
|
| madcowswe |
0:525cb1ac9f1f
|
323
|
data = writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
324
|
if ( (data&0x8000) ) {
|
| madcowswe |
0:525cb1ac9f1f
|
325
|
data = writeCmd(0xB000);
|
| madcowswe |
0:525cb1ac9f1f
|
326
|
temp.push(data&0x00FF);
|
| madcowswe |
0:525cb1ac9f1f
|
327
|
crc = crc8(crc, (unsigned char)(data&0x00FF));
|
| madcowswe |
0:525cb1ac9f1f
|
328
|
i++;
|
| madcowswe |
0:525cb1ac9f1f
|
329
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
330
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
331
|
|
| madcowswe |
0:525cb1ac9f1f
|
332
|
//If we exhaust the interrupt, exit
|
| madcowswe |
0:525cb1ac9f1f
|
333
|
if (NIRQ_in)
|
| madcowswe |
0:525cb1ac9f1f
|
334
|
break;
|
| madcowswe |
0:525cb1ac9f1f
|
335
|
|
| madcowswe |
0:525cb1ac9f1f
|
336
|
if (i >= packet_length) {
|
| madcowswe |
0:525cb1ac9f1f
|
337
|
data = writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
338
|
if ( (data&0x8000) ) {
|
| madcowswe |
0:525cb1ac9f1f
|
339
|
data = writeCmd(0xB000);
|
| madcowswe |
0:525cb1ac9f1f
|
340
|
if ((unsigned char)(data & 0x00FF) == crc) {
|
| madcowswe |
0:525cb1ac9f1f
|
341
|
//If the checksum is correct, add our data to the end of the output buffer
|
| madcowswe |
0:525cb1ac9f1f
|
342
|
while (!temp.empty()) {
|
| madcowswe |
0:525cb1ac9f1f
|
343
|
fifo.push(temp.front());
|
| madcowswe |
0:525cb1ac9f1f
|
344
|
temp.pop();
|
| madcowswe |
0:525cb1ac9f1f
|
345
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
346
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
347
|
|
| madcowswe |
0:525cb1ac9f1f
|
348
|
/* Tell RF Module we are finished, and clean up */
|
| madcowswe |
0:525cb1ac9f1f
|
349
|
i = -2;
|
| madcowswe |
0:525cb1ac9f1f
|
350
|
packet_length = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
351
|
crc = 0;
|
| madcowswe |
0:525cb1ac9f1f
|
352
|
temp = queue<unsigned char>();
|
| madcowswe |
0:525cb1ac9f1f
|
353
|
resetRX();
|
| madcowswe |
0:525cb1ac9f1f
|
354
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
355
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
356
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
357
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
358
|
|
| madcowswe |
0:525cb1ac9f1f
|
359
|
unsigned int RF12B::status() {
|
| madcowswe |
0:525cb1ac9f1f
|
360
|
return writeCmd(0x0000);
|
| madcowswe |
0:525cb1ac9f1f
|
361
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
362
|
|
| madcowswe |
0:525cb1ac9f1f
|
363
|
/* Tell the RF Module this packet is received and wait for the next */
|
| madcowswe |
0:525cb1ac9f1f
|
364
|
void RF12B::resetRX() {
|
| madcowswe |
0:525cb1ac9f1f
|
365
|
writeCmd(0xCA81);
|
| madcowswe |
0:525cb1ac9f1f
|
366
|
writeCmd(0xCA83);
|
| madcowswe |
0:525cb1ac9f1f
|
367
|
};
|
| madcowswe |
0:525cb1ac9f1f
|
368
|
|
| madcowswe |
0:525cb1ac9f1f
|
369
|
/* Calculate CRC8 */
|
| madcowswe |
0:525cb1ac9f1f
|
370
|
unsigned char RF12B::crc8(unsigned char crc, unsigned char data) {
|
| madcowswe |
0:525cb1ac9f1f
|
371
|
crc = crc ^ data;
|
| madcowswe |
0:525cb1ac9f1f
|
372
|
for (int i = 0; i < 8; i++) {
|
| madcowswe |
0:525cb1ac9f1f
|
373
|
if (crc & 0x01) {
|
| madcowswe |
0:525cb1ac9f1f
|
374
|
crc = (crc >> 1) ^ 0x8C;
|
| madcowswe |
0:525cb1ac9f1f
|
375
|
} else {
|
| madcowswe |
0:525cb1ac9f1f
|
376
|
crc >>= 1;
|
| madcowswe |
0:525cb1ac9f1f
|
377
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
378
|
}
|
| madcowswe |
0:525cb1ac9f1f
|
379
|
return crc;
|
| madcowswe |
0:525cb1ac9f1f
|
380
|
} |
Oskar Weigl