mirror of
https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git
synced 2025-02-04 18:48:11 +00:00
4a626eaf14
Loads of protocols have been touched by this change. Some testing has been done but please test on all your models. The XN297 emulation selects in this order: - the CC2500 if it is available and bitrate=250K. Configure the option field automatically for RF tune. - the NRF for all bitrates if it is available - if NRF is not available and bitrate=1M then an invalid protocol is sent automatically to the radio. CC2500 @250K can now receive normal and enhanced payloads. OMP protocol supports telemetry on CC2500 and is also for NRF only modules including telemetry. Separation of E016H (new protocol) from E01X due to different structure. MJXQ, MT99XX, Q303 and XK: some sub protocols available on CC2500 only.
232 lines
6.1 KiB
C++
232 lines
6.1 KiB
C++
/*
|
|
This project is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
Multiprotocol is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with Multiprotocol. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
// Compatible with GD005 C-17 and GD006 DA62 planes.
|
|
|
|
#if defined(GD00X_CCNRF_INO)
|
|
|
|
#include "iface_nrf250k.h"
|
|
|
|
//#define FORCE_GD00X_ORIGINAL_ID
|
|
|
|
#define GD00X_INITIAL_WAIT 500
|
|
#define GD00X_PACKET_PERIOD 3500
|
|
#define GD00X_RF_BIND_CHANNEL 2
|
|
#define GD00X_RF_NUM_CHANNELS 4
|
|
#define GD00X_PAYLOAD_SIZE 15
|
|
#define GD00X_BIND_COUNT 857 //3sec
|
|
|
|
#define GD00X_V2_BIND_PACKET_PERIOD 5110
|
|
#define GD00X_V2_RF_BIND_CHANNEL 0x43
|
|
#define GD00X_V2_RF_NUM_CHANNELS 2
|
|
#define GD00X_V2_PAYLOAD_SIZE 6
|
|
|
|
// flags going to packet[11]
|
|
#define GD00X_FLAG_DR 0x08
|
|
#define GD00X_FLAG_LIGHT 0x04
|
|
|
|
// flags going to packet[4]
|
|
#define GD00X_V2_FLAG_DR 0x40
|
|
#define GD00X_V2_FLAG_LIGHT 0x80
|
|
|
|
static void __attribute__((unused)) GD00X_send_packet()
|
|
{
|
|
static uint8_t prev_CH6=false;
|
|
|
|
if(sub_protocol==GD_V1)
|
|
{
|
|
packet[0] = IS_BIND_IN_PROGRESS?0xAA:0x55;
|
|
memcpy(packet+1,rx_tx_addr,4);
|
|
uint16_t channel=convert_channel_ppm(AILERON);
|
|
packet[5 ] = channel;
|
|
packet[6 ] = channel>>8;
|
|
channel=convert_channel_ppm(THROTTLE);
|
|
packet[7 ] = channel;
|
|
packet[8 ] = channel>>8;
|
|
channel=convert_channel_ppm(CH5); // TRIM
|
|
packet[9 ] = channel;
|
|
packet[10] = channel>>8;
|
|
packet[11] = GET_FLAG(!CH7_SW, GD00X_FLAG_DR)
|
|
| GET_FLAG(CH6_SW, GD00X_FLAG_LIGHT);
|
|
packet[12] = 0x00;
|
|
packet[13] = 0x00;
|
|
packet[14] = 0x00;
|
|
}
|
|
else
|
|
{//GD_V2
|
|
if(IS_BIND_IN_PROGRESS)
|
|
for(uint8_t i=0; i<5;i++)
|
|
packet[i]=rx_tx_addr[i];
|
|
else
|
|
{
|
|
packet[0]=convert_channel_16b_limit(THROTTLE,0,100); // 0..100
|
|
|
|
// Deadband is needed on aileron, 40 gives +-6%
|
|
packet[1]=convert_channel_8b_limit_deadband(AILERON,0x3F,0x20,0x00,40); // Aileron: 3F..20..00
|
|
// Trims must be in a seperate channel for this model
|
|
packet[2]=0x3F-(convert_channel_8b(CH5)>>2); // Trim: 0x3F..0x20..0x00
|
|
|
|
uint8_t seq=((packet_count*3)/7)%5;
|
|
packet[4]=seq
|
|
| GET_FLAG(!CH7_SW, GD00X_V2_FLAG_DR);
|
|
|
|
if(CH6_SW!=prev_CH6)
|
|
{ // LED switch is temporary
|
|
len=43;
|
|
prev_CH6=CH6_SW;
|
|
}
|
|
if(len)
|
|
{ // Send the light flag for a couple of packets
|
|
packet[4] |= GD00X_V2_FLAG_LIGHT;
|
|
len--;
|
|
}
|
|
|
|
packet[3]=(packet[0]+packet[1]+packet[2]+packet[4])^(crc8);
|
|
|
|
if( (packet_count%12) == 0 )
|
|
hopping_frequency_no ^= 1; // Toggle between the 2 frequencies
|
|
packet_count++;
|
|
if(packet_count>34) packet_count=0; // Full period
|
|
if( seq == (((packet_count*3)/7)%5) )
|
|
{
|
|
if(packet_period==2700)
|
|
packet_period=3000;
|
|
else
|
|
packet_period=2700;
|
|
}
|
|
else
|
|
packet_period=4300;
|
|
}
|
|
packet[5]='D';
|
|
}
|
|
|
|
if(IS_BIND_DONE)
|
|
{
|
|
XN297_Hopping(hopping_frequency_no);
|
|
if(sub_protocol==GD_V1)
|
|
{
|
|
hopping_frequency_no++;
|
|
hopping_frequency_no &= GD00X_RF_NUM_CHANNELS-1; // 4 RF channels
|
|
}
|
|
}
|
|
|
|
// Send
|
|
XN297_SetFreqOffset();
|
|
XN297_SetPower();
|
|
XN297_SetTxRxMode(TX_EN);
|
|
XN297_WritePayload(packet, packet_length);
|
|
}
|
|
|
|
static void __attribute__((unused)) GD00X_RF_init()
|
|
{
|
|
XN297_Configure(XN297_CRCEN, XN297_SCRAMBLED, XN297_250K);
|
|
if(sub_protocol==GD_V1)
|
|
XN297_SetTXAddr((uint8_t*)"\xcc\xcc\xcc\xcc\xcc", 5);
|
|
else
|
|
XN297_SetTXAddr((uint8_t*)"GDKNx", 5);
|
|
XN297_HoppingCalib(sub_protocol==GD_V1?GD00X_RF_NUM_CHANNELS:GD00X_V2_RF_NUM_CHANNELS); // Calibrate all channels
|
|
XN297_RFChannel(sub_protocol==GD_V1?GD00X_RF_BIND_CHANNEL:GD00X_V2_RF_BIND_CHANNEL); // Set bind channel
|
|
}
|
|
|
|
static void __attribute__((unused)) GD00X_initialize_txid()
|
|
{
|
|
if(sub_protocol==GD_V1)
|
|
{
|
|
uint8_t start=76+(rx_tx_addr[0]&0x03);
|
|
for(uint8_t i=0; i<GD00X_RF_NUM_CHANNELS;i++)
|
|
hopping_frequency[i]=start-(i<<1);
|
|
#ifdef FORCE_GD00X_ORIGINAL_ID
|
|
rx_tx_addr[0]=0x1F; // or 0xA5 or 0x26
|
|
rx_tx_addr[1]=0x39; // or 0x37 or 0x35
|
|
rx_tx_addr[2]=0x12; // Constant on 3 TXs
|
|
rx_tx_addr[3]=0x13; // Constant on 3 TXs
|
|
for(uint8_t i=0; i<GD00X_RF_NUM_CHANNELS;i++)
|
|
hopping_frequency[i]=79-(i<<1); // or 77 or 78
|
|
#endif
|
|
}
|
|
else
|
|
{
|
|
//Generate 64 different IDs
|
|
rx_tx_addr[1]=0x00;
|
|
rx_tx_addr[2]=0x00;
|
|
rx_tx_addr[1+((rx_tx_addr[3]&0x10)>>4)]=rx_tx_addr[3]&0x8F;
|
|
rx_tx_addr[0]=0x65;
|
|
rx_tx_addr[3]=0x95;
|
|
rx_tx_addr[4]=0x47; //'G'
|
|
|
|
crc8=rx_tx_addr[0]^rx_tx_addr[1]^rx_tx_addr[2];
|
|
//hopping calculation
|
|
hopping_frequency[0]=(0x15+(crc8^rx_tx_addr[3]))&0x1F;
|
|
if( hopping_frequency[0] == 0x0F )
|
|
hopping_frequency[0]=0x0E;
|
|
else if( (hopping_frequency[0]&0xFE) == 0x10 )
|
|
hopping_frequency[0]+=2;
|
|
hopping_frequency[1]=0x20+hopping_frequency[0];
|
|
|
|
#ifdef FORCE_GD00X_ORIGINAL_ID
|
|
//ID 1
|
|
rx_tx_addr[0]=0x65;
|
|
rx_tx_addr[1]=0x00;
|
|
rx_tx_addr[2]=0x00;
|
|
rx_tx_addr[3]=0x95;
|
|
rx_tx_addr[4]=0x47; //'G'
|
|
hopping_frequency[0]=0x05;
|
|
hopping_frequency[1]=0x25;
|
|
//ID 2
|
|
rx_tx_addr[0]=0xFD;
|
|
rx_tx_addr[1]=0x09;
|
|
rx_tx_addr[2]=0x00;
|
|
rx_tx_addr[3]=0x65;
|
|
rx_tx_addr[4]=0x47; //'G'
|
|
hopping_frequency[0]=0x06;
|
|
hopping_frequency[1]=0x26;
|
|
//ID 3
|
|
rx_tx_addr[0]=0x67;
|
|
rx_tx_addr[1]=0x0F;
|
|
rx_tx_addr[2]=0x00;
|
|
rx_tx_addr[3]=0x69;
|
|
rx_tx_addr[4]=0x47; //'G'
|
|
hopping_frequency[0]=0x16;
|
|
hopping_frequency[1]=0x36;
|
|
#endif
|
|
}
|
|
}
|
|
|
|
uint16_t GD00X_callback()
|
|
{
|
|
#ifdef MULTI_SYNC
|
|
telemetry_set_input_sync(packet_period);
|
|
#endif
|
|
if(bind_counter)
|
|
if(--bind_counter==0)
|
|
BIND_DONE;
|
|
GD00X_send_packet();
|
|
return packet_period;
|
|
}
|
|
|
|
void GD00X_init()
|
|
{
|
|
BIND_IN_PROGRESS; // autobind protocol
|
|
GD00X_initialize_txid();
|
|
GD00X_RF_init();
|
|
hopping_frequency_no = 0;
|
|
bind_counter=GD00X_BIND_COUNT;
|
|
packet_period=sub_protocol==GD_V1?GD00X_PACKET_PERIOD:GD00X_V2_BIND_PACKET_PERIOD;
|
|
packet_length=sub_protocol==GD_V1?GD00X_PAYLOAD_SIZE:GD00X_V2_PAYLOAD_SIZE;
|
|
packet_count=0;
|
|
len=0;
|
|
}
|
|
|
|
#endif
|