mirror of
https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git
synced 2025-02-04 22:48:12 +00:00
114 lines
3.7 KiB
C++
114 lines
3.7 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 FEI XIONG P38 plane.
|
|
|
|
#if defined(FX816_NRF24L01_INO)
|
|
|
|
#include "iface_nrf24l01.h"
|
|
|
|
#define FX816_INITIAL_WAIT 500
|
|
#define FX816_PACKET_PERIOD 10000
|
|
#define FX816_RF_BIND_CHANNEL 0x28 //40
|
|
#define FX816_RF_NUM_CHANNELS 4
|
|
#define FX816_PAYLOAD_SIZE 6
|
|
#define FX816_BIND_COUNT 300 //3sec
|
|
|
|
static void __attribute__((unused)) FX816_send_packet()
|
|
{
|
|
packet[0] = IS_BIND_IN_PROGRESS?0x55:0xAA;
|
|
packet[1] = rx_tx_addr[0];
|
|
packet[2] = rx_tx_addr[1];
|
|
uint8_t val=convert_channel_8b(AILERON);
|
|
#define FX816_SWITCH 20
|
|
if(val>127+FX816_SWITCH)
|
|
packet[3] = 1;
|
|
else if(val<127-FX816_SWITCH)
|
|
packet[3] = 2;
|
|
else
|
|
packet[3] = 0;
|
|
packet[4] = convert_channel_16b_limit(THROTTLE,0,100);
|
|
val=0;
|
|
for(uint8_t i=0;i<FX816_PAYLOAD_SIZE-1;i++)
|
|
val+=packet[i];
|
|
packet[5]=val;
|
|
|
|
NRF24L01_WriteReg(NRF24L01_05_RF_CH, IS_BIND_IN_PROGRESS ? FX816_RF_BIND_CHANNEL:hopping_frequency[hopping_frequency_no++]);
|
|
hopping_frequency_no%=FX816_RF_NUM_CHANNELS;
|
|
|
|
// clear packet status bits and TX FIFO
|
|
NRF24L01_WriteReg(NRF24L01_07_STATUS, 0x70);
|
|
NRF24L01_FlushTx();
|
|
XN297_WritePayload(packet, FX816_PAYLOAD_SIZE);
|
|
|
|
// Power on, TX mode, 2byte CRC
|
|
XN297_Configure(_BV(NRF24L01_00_EN_CRC) | _BV(NRF24L01_00_CRCO) | _BV(NRF24L01_00_PWR_UP));
|
|
|
|
NRF24L01_SetPower(); // Set tx_power
|
|
}
|
|
|
|
static void __attribute__((unused)) FX816_init()
|
|
{
|
|
NRF24L01_Initialize();
|
|
NRF24L01_SetTxRxMode(TX_EN);
|
|
XN297_SetTXAddr((uint8_t *)"\xcc\xcc\xcc\xcc\xcc", 5);
|
|
NRF24L01_FlushTx();
|
|
NRF24L01_FlushRx();
|
|
NRF24L01_WriteReg(NRF24L01_07_STATUS, 0x70); // Clear data ready, data sent, and retransmit
|
|
NRF24L01_WriteReg(NRF24L01_01_EN_AA, 0x00); // No Auto Acknowldgement on all data pipes
|
|
NRF24L01_WriteReg(NRF24L01_02_EN_RXADDR, 0x01); // Enable data pipe 0 only
|
|
NRF24L01_SetBitrate(NRF24L01_BR_1M); // 1Mbps
|
|
NRF24L01_WriteReg(NRF24L01_04_SETUP_RETR, 0x00); // No retransmits
|
|
NRF24L01_SetPower();
|
|
NRF24L01_Activate(0x73); // Activate feature register
|
|
NRF24L01_WriteReg(NRF24L01_1C_DYNPD, 0x00); // Disable dynamic payload length on all pipes
|
|
NRF24L01_WriteReg(NRF24L01_1D_FEATURE, 0x01);
|
|
NRF24L01_Activate(0x73);
|
|
}
|
|
|
|
static void __attribute__((unused)) FX816_initialize_txid()
|
|
{
|
|
//Only 8 IDs: the RX led does not indicate frame loss.
|
|
//I didn't open the plane to find out if I could connect there so this is the best I came up with with few trial and errors...
|
|
rx_tx_addr[0]=0x35+(rx_tx_addr[3]&0x07); //Original dump=0x35
|
|
rx_tx_addr[1]=0x09; //Original dump=0x09
|
|
memcpy(hopping_frequency,"\x09\x1B\x30\x42",FX816_RF_NUM_CHANNELS); //Original dump=9=0x09,27=0x1B,48=0x30,66=0x42
|
|
for(uint8_t i=0;i<FX816_RF_NUM_CHANNELS;i++)
|
|
hopping_frequency[i]+=rx_tx_addr[3]&0x07;
|
|
}
|
|
|
|
uint16_t FX816_callback()
|
|
{
|
|
#ifdef MULTI_SYNC
|
|
telemetry_set_input_sync(FX816_PACKET_PERIOD);
|
|
#endif
|
|
if(IS_BIND_IN_PROGRESS)
|
|
if(--bind_counter==0)
|
|
BIND_DONE;
|
|
FX816_send_packet();
|
|
return FX816_PACKET_PERIOD;
|
|
}
|
|
|
|
uint16_t initFX816()
|
|
{
|
|
BIND_IN_PROGRESS; // autobind protocol
|
|
FX816_initialize_txid();
|
|
FX816_init();
|
|
hopping_frequency_no = 0;
|
|
bind_counter=FX816_BIND_COUNT;
|
|
return FX816_INITIAL_WAIT;
|
|
}
|
|
|
|
#endif
|