gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-07-12 17:57:53 +00:00
Code Issues Projects Releases Wiki Activity

Send spectrum data by packets of 5 channels

Browse Source
This commit is contained in:
Goebish 2019-09-08 15:33:15 +02:00
parent 57a90c2f56
commit f864e61c67
3 changed files with 27 additions and 24 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
Multiprotocol/Multiprotocol.h
View File

@ -888,4 +888,8 @@ Serial: 100000 Baud 8e2 _ xxxx xxxx p --
data[3-7] telemetry data
Full description at the bottom of Hitec_cc2500.ino
Type 0x0B Spectrum Scanner telemetry data
length: 6
data[0] = start channel (2400 + x*0.333 Mhz)
data[1-5] power levels
*/

40
Multiprotocol/Scanner_cc2500.ino
View File

@ -17,17 +17,13 @@
#include "iface_cc2500.h"
struct Scanner {
uint8_t chan_min;
uint8_t chan_max;
} Scanner;
#define MIN_RADIOCHANNEL 0x00
#define MAX_RADIOCHANNEL 255
#define CHANNEL_LOCK_TIME 300 // with precalibration, channel requires only 90 usec for synthesizer to settle
#define INTERNAL_AVERAGE 6
#define SCAN_MAX_RADIOCHANNEL 249 // 2483 MHz
#define SCAN_CHANNEL_LOCK_TIME 300 // with precalibration, channel requires only 90 usec for synthesizer to settle
#define SCAN_CHANS_PER_PACKET 5
#define AVERAGE_INTVL 30
static uint8_t scan_tlm_index;
enum ScanStates {
SCAN_CHANNEL_CHANGE = 0,
SCAN_GET_RSSI = 1,
@ -65,7 +61,7 @@ static void __attribute__((unused)) Scanner_cc2500_init()
static void __attribute__((unused)) Scanner_calibrate()
{
for (int c = 0; c < MAX_RADIOCHANNEL; c++) {
for (int c = 0; c < SCAN_MAX_RADIOCHANNEL; c++) {
CC2500_Strobe(CC2500_SIDLE);
CC2500_WriteReg(CC2500_0A_CHANNR, c);
CC2500_Strobe(CC2500_SCAL);
@ -77,7 +73,7 @@ static void __attribute__((unused)) Scanner_calibrate()
static void __attribute__((unused)) Scanner_scan_next()
{
CC2500_WriteReg(CC2500_0A_CHANNR, Scanner.chan_min + rf_ch_num);
CC2500_WriteReg(CC2500_0A_CHANNR, rf_ch_num);
CC2500_WriteReg(CC2500_25_FSCAL1, calData[rf_ch_num]);
CC2500_Strobe(CC2500_SFRX);
CC2500_Strobe(CC2500_SRX);
@ -103,27 +99,29 @@ uint16 Scanner_callback()
switch (phase) {
case SCAN_CHANNEL_CHANGE:
rf_ch_num++;
if (rf_ch_num >= (Scanner.chan_max - Scanner.chan_min + 1))
if (rf_ch_num >= (SCAN_MAX_RADIOCHANNEL + 1))
rf_ch_num = 0;
if (scan_tlm_index++ == 0)
pkt[0] = rf_ch_num; // start channel for telemetry packet
Scanner_scan_next();
phase = SCAN_GET_RSSI;
return CHANNEL_LOCK_TIME;
return SCAN_CHANNEL_LOCK_TIME;
case SCAN_GET_RSSI:
rssi_value = Scanner_scan_rssi();
phase = SCAN_CHANNEL_CHANGE;
// send data to TX
pkt[0] = rf_ch_num;
pkt[1] = rssi_value;
telemetry_link = 1;
pkt[scan_tlm_index] = Scanner_scan_rssi();
if (scan_tlm_index == SCAN_CHANS_PER_PACKET) {
// send data to TX
telemetry_link = 1;
scan_tlm_index = 0;
}
}
return AVERAGE_INTVL;
}
uint16_t initScanner(void)
{
Scanner.chan_min = 0; // 2400 MHz
Scanner.chan_max = 249; // 2483 Mhz
rf_ch_num = 0;
rf_ch_num = SCAN_MAX_RADIOCHANNEL;
scan_tlm_index = 0;
phase = SCAN_CHANNEL_CHANGE;
CC2500_Reset();
Scanner_cc2500_init();

7
Multiprotocol/Telemetry.ino
View File

@ -174,12 +174,13 @@ static void multi_send_status()
void spectrum_scanner_frame()
{
#if defined MULTI_TELEMETRY
multi_send_header(MULTI_TELEMETRY_SCANNER, 2);
multi_send_header(MULTI_TELEMETRY_SCANNER, SCAN_CHANS_PER_PACKET + 1);
#else
Serial_write(0xAA); // Telemetry packet
#endif
Serial_write(pkt[0]); // frequency (channel)
Serial_write(pkt[1]); // RSSI power level
Serial_write(pkt[0]); // start channel
for(uint8_t ch = 0; ch < SCAN_CHANS_PER_PACKET; ch++)
Serial_write(pkt[ch+1]); // RSSI power levels
}
#endif