mirror of
https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git
synced 2025-02-04 17:58:13 +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.
146 lines
4.2 KiB
C++
146 lines
4.2 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 Realacc R11
|
|
|
|
#if defined(REALACC_NRF24L01_INO)
|
|
|
|
#include "iface_nrf24l01.h"
|
|
|
|
#define FORCE_REALACC_ORIGINAL_ID
|
|
|
|
#define REALACC_INITIAL_WAIT 500
|
|
#define REALACC_PACKET_PERIOD 2268
|
|
#define REALACC_BIND_RF_CHANNEL 80
|
|
#define REALACC_BIND_PAYLOAD_SIZE 10
|
|
#define REALACC_PAYLOAD_SIZE 13
|
|
#define REALACC_BIND_COUNT 50
|
|
#define REALACC_RF_NUM_CHANNELS 5
|
|
|
|
static void __attribute__((unused)) REALACC_send_packet()
|
|
{
|
|
packet[ 0]= 0xDC;
|
|
packet[ 1]= convert_channel_8b(AILERON); // 00..80..FF
|
|
packet[ 2]= convert_channel_8b(ELEVATOR); // 00..80..FF
|
|
packet[ 3]= convert_channel_8b(THROTTLE); // 00..FF
|
|
packet[ 4]= convert_channel_8b(RUDDER); // 00..80..FF
|
|
packet[ 5]= 0x20; // Trim
|
|
packet[ 6]= 0x20; // Trim
|
|
packet[ 7]= 0x20; // Trim
|
|
packet[ 8]= 0x20; // Trim
|
|
packet[ 9]= num_ch; // Change at each power up
|
|
packet[10]= 0x04 // Flag1
|
|
| 0x02 // Rate1=0, Rate2=1, Rate3=2
|
|
| GET_FLAG(CH8_SW, 0x20); // Headless
|
|
packet[11]= 0x00 // Flag2
|
|
| GET_FLAG(CH7_SW, 0x01) // Calib
|
|
| GET_FLAG(CH9_SW, 0x20) // Return
|
|
| GET_FLAG(CH10_SW,0x80); // Unknown
|
|
packet[12]= 0x00 // Flag3
|
|
| GET_FLAG(CH5_SW, 0x01) // Flip
|
|
| GET_FLAG(CH6_SW, 0x80); // Light
|
|
|
|
XN297_Hopping(hopping_frequency_no);
|
|
hopping_frequency_no++;
|
|
hopping_frequency_no %= REALACC_RF_NUM_CHANNELS;
|
|
XN297_WriteEnhancedPayload(packet, REALACC_PAYLOAD_SIZE,0);
|
|
}
|
|
|
|
static void __attribute__((unused)) REALACC_send_bind_packet()
|
|
{
|
|
packet[0] = 0xB1;
|
|
memcpy(&packet[1],rx_tx_addr,4);
|
|
memcpy(&packet[5],hopping_frequency,5);
|
|
|
|
XN297_WriteEnhancedPayload(packet, REALACC_BIND_PAYLOAD_SIZE,1);
|
|
}
|
|
|
|
static void __attribute__((unused)) REALACC_initialize_txid()
|
|
{
|
|
calc_fh_channels(REALACC_RF_NUM_CHANNELS);
|
|
num_ch=random(0xfefefefe); // 00..FF
|
|
|
|
#ifdef FORCE_REALACC_ORIGINAL_ID
|
|
//Dump
|
|
rx_tx_addr[0]=0x99;
|
|
rx_tx_addr[1]=0x06;
|
|
rx_tx_addr[2]=0x00;
|
|
rx_tx_addr[3]=0x00;
|
|
hopping_frequency[0]=0x55;
|
|
hopping_frequency[1]=0x59;
|
|
hopping_frequency[2]=0x5A;
|
|
hopping_frequency[3]=0x5A;
|
|
hopping_frequency[4]=0x62;
|
|
num_ch=0xC5; // Value in dumps: C5 A2 77 F0 84 58
|
|
#endif
|
|
}
|
|
|
|
static void __attribute__((unused)) REALACC_RF_init()
|
|
{
|
|
XN297_Configure(XN297_CRCEN, XN297_SCRAMBLED, XN297_1M);
|
|
XN297_SetTXAddr((uint8_t*)"MAIN", 4);
|
|
XN297_RFChannel(REALACC_BIND_RF_CHANNEL); // Set bind channel
|
|
}
|
|
|
|
uint16_t REALACC_callback()
|
|
{
|
|
#ifdef MULTI_SYNC
|
|
telemetry_set_input_sync(REALACC_PACKET_PERIOD);
|
|
#endif
|
|
XN297_SetPower();
|
|
XN297_SetTxRxMode(TX_EN);
|
|
if(IS_BIND_IN_PROGRESS)
|
|
{
|
|
REALACC_send_bind_packet();
|
|
if(--bind_counter==0)
|
|
{
|
|
BIND_DONE;
|
|
XN297_SetTXAddr(rx_tx_addr, 4);
|
|
}
|
|
}
|
|
else
|
|
REALACC_send_packet();
|
|
return REALACC_PACKET_PERIOD;
|
|
}
|
|
|
|
void REALACC_init()
|
|
{
|
|
BIND_IN_PROGRESS; // autobind protocol
|
|
REALACC_initialize_txid();
|
|
REALACC_RF_init();
|
|
bind_counter=REALACC_BIND_COUNT;
|
|
hopping_frequency_no=0;
|
|
}
|
|
|
|
#endif
|
|
|
|
// XN297 speed 1Mb, scrambled, enhanced
|
|
// Bind
|
|
// Address = 4D 41 49 4E = 'MAIN'
|
|
// Channel = 80 (most likely from dump)
|
|
// P(10) = B1 99 06 00 00 55 59 5A 5A 62
|
|
// B1 indicates bind packet
|
|
// 99 06 00 00 = ID = address of normal packets
|
|
// 55 59 5A 5A 62 = 85, 89, 90, 90, 98 = RF channels to be used (kind of match previous dumps)// Normal
|
|
// Normal
|
|
// Address = 99 06 00 00
|
|
// Channels = 84, 89, 90, 90, 98 (guess from bind)
|
|
// P(13)= DC 80 80 32 80 20 20 20 20 58 04 00 00
|
|
// DC = normal packet
|
|
// 80 80 32 80 : AETR 00..80..FF
|
|
// 20 20 20 20 : Trims
|
|
// 58 : changing every time the TX restart
|
|
// 04 : |0x20=headless, |0x01=rate2, |0x02=rate3
|
|
// 00 : |0x01=calib, |0x20=return, |0x80=unknown
|
|
// 00 : |0x80=light, |0x01=flip
|