gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-05 00:48:13 +00:00
Code Issues Projects Releases Wiki Activity

MT99xx fix

Browse Source
This commit is contained in:
pascallanger 2016-08-03 09:05:21 +02:00
parent cea0f1766f
commit 47ad2b5cfa
1 changed files with 10 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
Multiprotocol/MT99xx_nrf24l01.ino
View File

@ -79,17 +79,14 @@ static void __attribute__((unused)) MT99XX_send_packet()
packet[6] |= 0x40 | FLAG_MT_RATE2 packet[6] |= 0x40 | FLAG_MT_RATE2
| GET_FLAG( Servo_AUX3, FLAG_MT_SNAPSHOT ) | GET_FLAG( Servo_AUX3, FLAG_MT_SNAPSHOT )
| GET_FLAG( Servo_AUX4, FLAG_MT_VIDEO ); // max rate on MT99xx | GET_FLAG( Servo_AUX4, FLAG_MT_VIDEO ); // max rate on MT99xx
else else //LS
if(sub_protocol==LS) {
packet[6] |= 0x40 | FLAG_MT_RATE2; packet[6] |= FLAG_MT_RATE2 // max rate
else //LS | GET_FLAG( Servo_AUX5, 0x10 ); //HEADLESS
{ packet[7] = ls_mys_byte[ls_counter++];
packet[6] |= FLAG_MT_RATE2 // max rate if(ls_counter >= sizeof(ls_mys_byte))
| GET_FLAG( Servo_AUX5, 0x10 ); //HEADLESS ls_counter=0;
packet[7] = ls_mys_byte[ls_counter++]; }
if(ls_counter >= sizeof(ls_mys_byte))
ls_counter=0;
}
uint8_t result=checksum_offset; uint8_t result=checksum_offset;
for(uint8_t i=0; i<8; i++) for(uint8_t i=0; i<8; i++)
@ -99,9 +96,9 @@ static void __attribute__((unused)) MT99XX_send_packet()
else else
{ // YZ { // YZ
packet[0] = convert_channel_8b_scale(THROTTLE,0x00,0x64); // throttle packet[0] = convert_channel_8b_scale(THROTTLE,0x00,0x64); // throttle
packet[1] = convert_channel_8b_scale(RUDDER ,0x00,0x64); // rudder packet[1] = convert_channel_8b_scale(RUDDER ,0x64,0x00); // rudder
packet[2] = convert_channel_8b_scale(ELEVATOR,0x00,0x64); // elevator packet[2] = convert_channel_8b_scale(ELEVATOR,0x00,0x64); // elevator
packet[3] = convert_channel_8b_scale(AILERON ,0x00,0x64); // aileron packet[3] = convert_channel_8b_scale(AILERON ,0x64,0x00); // aileron
if(packet_count++ >= 23) if(packet_count++ >= 23)
{ {
yz_seq_num ++; yz_seq_num ++;