mirror of
https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git
synced 2025-02-04 14:48:14 +00:00
353 lines
8.9 KiB
C++
353 lines
8.9 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/>.
|
|
*/
|
|
#if defined(JIABAILE_NRF24L01_INO)
|
|
|
|
#include "iface_xn297.h"
|
|
|
|
//#define FORCE_JIABAILE_ORIGINAL_ID
|
|
|
|
#define JIABAILE_PAYLOAD_SIZE 8
|
|
#define JIABAILE_RX_PAYLOAD_SIZE 7
|
|
#define JIABAILE_RF_NUM_CHANNELS 3
|
|
#define JIABAILE_BIND_PACKET_PERIOD 12700
|
|
#define JIABAILE_PACKET_PERIOD 2408
|
|
#define JIABAILE_BIND_COUNT 160 //2 sec
|
|
#define JIABAILE_WRITE_TIME 1000
|
|
|
|
enum {
|
|
JIABAILE_BIND=0,
|
|
JIABAILE_RX,
|
|
JIABAILE_PREP_DATA,
|
|
JIABAILE_DATA,
|
|
};
|
|
|
|
static uint8_t __attribute__((unused)) JIABAILE_channel(uint8_t num)
|
|
{
|
|
uint8_t val=convert_channel_16b_limit(num,0,100);
|
|
if(val > 50+num)
|
|
{
|
|
packet[3] |= 0x01;
|
|
return val-50;
|
|
}
|
|
if(val < 50-num)
|
|
{
|
|
packet[3] |= 0x02;
|
|
return 50-val;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void __attribute__((unused)) JIABAILE_send_packet()
|
|
{
|
|
hopping_frequency_no++;
|
|
if(hopping_frequency_no > 2)
|
|
hopping_frequency_no = 0;
|
|
XN297_Hopping(hopping_frequency_no);
|
|
|
|
memcpy(packet,rx_tx_addr,3);
|
|
memset(&packet[3], 0x00, 4);
|
|
if(IS_BIND_DONE)
|
|
{//Normal
|
|
packet[4] = convert_channel_16b_limit(RUDDER,0,50)-25; //ST Trim
|
|
packet[6] = JIABAILE_channel(AILERON); //ST
|
|
packet[3] ^= 0x03; //Reverse ST channel
|
|
packet[3] <<= 2; //Move ST channel where it should be
|
|
packet[5] = JIABAILE_channel(ELEVATOR); //TH
|
|
packet[3] |= GET_FLAG(CH5_SW, 0x20) //Low speed
|
|
|GET_FLAG(CH7_SW, 0x40) //Flash light
|
|
|GET_FLAG(!CH6_SW, 0x80); //Light
|
|
if(!CH5_SW && Channel_data[CH5] > CHANNEL_MIN_COMMAND)
|
|
packet[3] |= 0x10; //Mid speed
|
|
}
|
|
else
|
|
{
|
|
bind_counter--;
|
|
if(!bind_counter)
|
|
{
|
|
BIND_DONE;
|
|
phase = JIABAILE_PREP_DATA;
|
|
}
|
|
}
|
|
packet[7] = 0x55 + hopping_frequency[hopping_frequency_no];
|
|
for(uint8_t i=0;i<JIABAILE_PAYLOAD_SIZE-1;i++)
|
|
packet[7] += packet[i];
|
|
// Send
|
|
XN297_SetPower();
|
|
XN297_SetTxRxMode(TX_EN);
|
|
XN297_WritePayload(packet, JIABAILE_PAYLOAD_SIZE);
|
|
#ifdef DEBUG_SERIAL
|
|
debug("H%d RF%d",hopping_frequency_no,hopping_frequency[hopping_frequency_no]);
|
|
for(uint8_t i=0; i < JIABAILE_PAYLOAD_SIZE; i++)
|
|
debug(" %02X", packet[i]);
|
|
debugln();
|
|
#endif
|
|
}
|
|
|
|
static void __attribute__((unused)) JIABAILE_initialize_txid()
|
|
{
|
|
rx_tx_addr[0] = rx_tx_addr[3];
|
|
#ifdef FORCE_JIABAILE_ORIGINAL_ID
|
|
memcpy(rx_tx_addr,(uint8_t *)"\xCB\x03\xA5",3);
|
|
//memcpy(rx_tx_addr,(uint8_t *)"\x3D\x08\xA2",3);
|
|
//Normal frequencies are calculated from the car ID...
|
|
//memcpy(&hopping_frequency[3],(uint8_t *)"\x23\x2D\x4B",3); //35,45,75
|
|
memcpy(&hopping_frequency[3],(uint8_t *)"\x24\x43\x4C",3); //36,67,76
|
|
#endif
|
|
//Bind frequencies
|
|
memcpy(hopping_frequency,(uint8_t *)"\x07\x27\x45",3); //7,39,69
|
|
}
|
|
|
|
static void __attribute__((unused)) JIABAILE_RF_init()
|
|
{
|
|
XN297_Configure(XN297_CRCEN, XN297_SCRAMBLED, XN297_1M);
|
|
//Bind address
|
|
memcpy(rx_id,(uint8_t*)"\xA7\x07\x57\xA7\x26", 5);
|
|
XN297_SetTXAddr(rx_id, 5);
|
|
XN297_SetRXAddr(rx_id, JIABAILE_RX_PAYLOAD_SIZE);
|
|
}
|
|
|
|
uint16_t JIABAILE_callback()
|
|
{
|
|
uint8_t sum;
|
|
uint16_t addr;
|
|
|
|
switch(phase)
|
|
{
|
|
case JIABAILE_BIND:
|
|
phase++; // JIABAILE_RX but is overwritten if RX or bind timeout
|
|
if(XN297_IsRX())
|
|
{
|
|
if(XN297_ReadPayload(packet_in, JIABAILE_RX_PAYLOAD_SIZE))
|
|
{//CRC OK
|
|
#ifdef DEBUG_SERIAL
|
|
debug("RX");
|
|
for(uint8_t i=0; i < JIABAILE_RX_PAYLOAD_SIZE; i++)
|
|
debug(" %02X", packet_in[i]);
|
|
debugln();
|
|
#endif
|
|
//RX: CB 03 A5 9D 05 A2 68
|
|
if(memcmp(packet_in,rx_tx_addr,3)==0)
|
|
{//TX ID match
|
|
//Check packet
|
|
sum=0xAA + hopping_frequency[hopping_frequency_no];
|
|
for(uint8_t i=0; i < JIABAILE_RX_PAYLOAD_SIZE-1; i++)
|
|
sum+=packet_in[i];
|
|
if(sum==packet_in[6])
|
|
{
|
|
//Write the RXID
|
|
#ifdef DEBUG_SERIAL
|
|
debug("RXID ");
|
|
for(uint8_t i=0; i < 3; i++)
|
|
debug(" %02X", packet_in[3+i]);
|
|
debugln();
|
|
#endif
|
|
addr=JIABAILE_EEPROM_OFFSET+RX_num*3;
|
|
for(uint8_t i=0;i<3;i++)
|
|
eeprom_write_byte((EE_ADDR)(addr+i),packet_in[3+i]);
|
|
//Switch to normal mode
|
|
BIND_DONE;
|
|
phase = JIABAILE_PREP_DATA;
|
|
}
|
|
#ifdef DEBUG_SERIAL
|
|
else
|
|
debug("Wrong Sum");
|
|
}
|
|
else
|
|
debug("Wrong TX ID");
|
|
}
|
|
else
|
|
debug("Bad CRC");
|
|
debugln("");
|
|
#else
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
XN297_SetTxRxMode(TXRX_OFF);
|
|
JIABAILE_send_packet();
|
|
return JIABAILE_WRITE_TIME;
|
|
case JIABAILE_RX:
|
|
//Wait for the packet transmission to finish
|
|
while(XN297_IsPacketSent()==false);
|
|
//Switch to RX
|
|
XN297_SetTxRxMode(TXRX_OFF);
|
|
XN297_SetTxRxMode(RX_EN);
|
|
phase = JIABAILE_BIND;
|
|
return JIABAILE_BIND_PACKET_PERIOD - JIABAILE_WRITE_TIME;
|
|
case JIABAILE_PREP_DATA:
|
|
//Read the RXID
|
|
addr=JIABAILE_EEPROM_OFFSET+RX_num*3;
|
|
for(uint8_t i=0;i<3;i++)
|
|
rx_id[i+1] = eeprom_read_byte((EE_ADDR)(addr+i));
|
|
#ifdef DEBUG_SERIAL
|
|
debug("RXID ");
|
|
for(uint8_t i=0; i < 3; i++)
|
|
debug(" %02X", rx_id[i+1]);
|
|
#endif
|
|
XN297_SetTxRxMode(TXRX_OFF);
|
|
XN297_SetTXAddr(rx_id, 5);
|
|
//Set the normal frequencies
|
|
sum=rx_id[1]&0x07;
|
|
hopping_frequency[0] = (sum>4?30:8) + sum;
|
|
if(sum==4 || sum ==7)
|
|
hopping_frequency[0]++;
|
|
hopping_frequency[1] = 40 + sum;
|
|
if((sum & 0x06) == 0x06)
|
|
hopping_frequency[1] += 21;
|
|
hopping_frequency[2] = 70 + sum;
|
|
#ifdef DEBUG_SERIAL
|
|
debug(" RF");
|
|
for(uint8_t i=0; i < 3; i++)
|
|
debug(" %d", hopping_frequency[i]);
|
|
debugln();
|
|
#endif
|
|
phase++;
|
|
default: //JIABAILE_DATA
|
|
#ifdef MULTI_SYNC
|
|
telemetry_set_input_sync(JIABAILE_PACKET_PERIOD);
|
|
#endif
|
|
JIABAILE_send_packet();
|
|
break;
|
|
}
|
|
return JIABAILE_PACKET_PERIOD;
|
|
}
|
|
|
|
void JIABAILE_init()
|
|
{
|
|
JIABAILE_initialize_txid();
|
|
JIABAILE_RF_init();
|
|
if(IS_BIND_IN_PROGRESS)
|
|
{
|
|
phase = JIABAILE_BIND;
|
|
bind_counter = JIABAILE_BIND_COUNT;
|
|
}
|
|
else
|
|
phase = JIABAILE_PREP_DATA;
|
|
hopping_frequency_no = 0;
|
|
}
|
|
|
|
#endif
|
|
/*
|
|
// CAR RX debug code
|
|
|
|
static void __attribute__((unused)) JIABAILE_RF_init()
|
|
{
|
|
XN297_Configure(XN297_CRCEN, XN297_SCRAMBLED, XN297_1M);
|
|
//Bind address
|
|
memcpy(rx_id,(uint8_t*)"\xA7\x07\x57\xA7\x26", 5);
|
|
XN297_SetTXAddr(rx_id, 5);
|
|
XN297_SetRXAddr(rx_id, JIABAILE_PAYLOAD_SIZE);
|
|
XN297_RFChannel(7);
|
|
rx_tx_addr[0] = 0x00;
|
|
rx_tx_addr[1] = RX_num;
|
|
rx_tx_addr[2] = 0x00;
|
|
}
|
|
|
|
uint16_t JIABAILE_callback()
|
|
{
|
|
switch(phase)
|
|
{
|
|
case JIABAILE_BIND:
|
|
if(XN297_IsRX())
|
|
{
|
|
if(XN297_ReadPayload(packet_in, JIABAILE_PAYLOAD_SIZE))
|
|
{//CRC OK
|
|
XN297_SetTxRxMode(TXRX_OFF);
|
|
#ifdef DEBUG_SERIAL
|
|
debug("RX Bind");
|
|
for(uint8_t i=0; i < JIABAILE_PAYLOAD_SIZE; i++)
|
|
debug(" %02X", packet_in[i]);
|
|
debugln();
|
|
#endif
|
|
memcpy(packet,packet_in,3);
|
|
memcpy(&packet[3],rx_tx_addr,3);
|
|
packet[6]=0xAA + 7;
|
|
for(uint8_t i=0; i < JIABAILE_RX_PAYLOAD_SIZE-1; i++)
|
|
packet[6]+=packet[i];
|
|
XN297_SetTxRxMode(TX_EN);
|
|
memcpy(&rx_id[1],rx_tx_addr,3);
|
|
bind_counter = 10;
|
|
phase = JIABAILE_RX;
|
|
}
|
|
}
|
|
return JIABAILE_WRITE_TIME;
|
|
case JIABAILE_RX:
|
|
if(bind_counter)
|
|
{
|
|
bind_counter--;
|
|
XN297_WritePayload(packet, JIABAILE_RX_PAYLOAD_SIZE);
|
|
#ifdef DEBUG_SERIAL
|
|
debug("TX Bind");
|
|
for(uint8_t i=0; i < JIABAILE_RX_PAYLOAD_SIZE; i++)
|
|
debug(" %02X", packet[i]);
|
|
debugln();
|
|
#endif
|
|
return JIABAILE_PACKET_PERIOD;
|
|
}
|
|
//Wait for the packet transmission to finish
|
|
//while(XN297_IsPacketSent()==false);
|
|
//Switch to RX
|
|
XN297_SetTxRxMode(TXRX_OFF);
|
|
XN297_SetRXAddr(rx_id, JIABAILE_PAYLOAD_SIZE);
|
|
hopping_frequency_no++;
|
|
if(hopping_frequency_no>84)
|
|
hopping_frequency_no = 0;
|
|
debug(".");
|
|
XN297_RFChannel(hopping_frequency_no);
|
|
XN297_SetTxRxMode(RX_EN);
|
|
phase = JIABAILE_DATA;
|
|
return JIABAILE_BIND_PACKET_PERIOD;
|
|
case JIABAILE_DATA:
|
|
if(XN297_IsRX())
|
|
{
|
|
debugln("");
|
|
if(XN297_ReadPayload(packet_in, JIABAILE_PAYLOAD_SIZE))
|
|
{//CRC OK
|
|
#ifdef DEBUG_SERIAL
|
|
debug("CH=%d=%02X P:",hopping_frequency_no,hopping_frequency_no);
|
|
for(uint8_t i=0; i < JIABAILE_PAYLOAD_SIZE; i++)
|
|
debug(" %02X", packet_in[i]);
|
|
#endif
|
|
//Check packet
|
|
uint8_t sum=0x55 + hopping_frequency_no;
|
|
for(uint8_t i=0; i < JIABAILE_PAYLOAD_SIZE-1; i++)
|
|
sum+=packet_in[i];
|
|
if(sum==packet_in[7])
|
|
{
|
|
debug("Good channel");
|
|
}
|
|
else
|
|
debug("Wrong Sum");
|
|
}
|
|
else
|
|
debug("Bad CRC");
|
|
debugln("");
|
|
}
|
|
phase = JIABAILE_RX;
|
|
break;
|
|
}
|
|
return JIABAILE_PACKET_PERIOD;
|
|
}
|
|
|
|
void JIABAILE_init()
|
|
{
|
|
JIABAILE_RF_init();
|
|
XN297_SetTxRxMode(TXRX_OFF);
|
|
XN297_SetTxRxMode(RX_EN);
|
|
phase = JIABAILE_BIND;
|
|
hopping_frequency_no = 7;
|
|
}
|
|
*/
|