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

OMP fixes

Browse Source
This commit is contained in:
Pascal Langer 2020-08-17 08:26:42 +02:00
parent 15e37cefee
commit e8037c857f
2 changed files with 10 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
Multiprotocol/Multiprotocol.h
View File

@ -19,7 +19,7 @@
#define VERSION_MAJOR 1
#define VERSION_MINOR 3
#define VERSION_REVISION 1
#define VERSION_PATCH_LEVEL 57
#define VERSION_PATCH_LEVEL 58
//******************
// Protocols

18
Multiprotocol/OMP_nrf24l01.ino
View File

@ -17,7 +17,7 @@ Multiprotocol is distributed in the hope that it will be useful,
#include "iface_nrf250k.h"
#define FORCE_OMP_ORIGINAL_ID
//#define FORCE_OMP_ORIGINAL_ID
#define OMP_INITIAL_WAIT 500
#define OMP_PACKET_PERIOD 5000
@ -67,19 +67,19 @@ static void __attribute__((unused)) OMP_send_packet()
uint16_t channel=convert_channel_16b_limit(THROTTLE,0,2047);
packet[7 ] = channel;
packet[8 ] = channel>>8;
channel=convert_channel_16b_limit(AILERON,0,2047);
channel=convert_channel_16b_limit(AILERON,2047,0);
packet[8 ] |= channel<<3;
packet[9 ] = channel>>5;
channel=convert_channel_16b_limit(ELEVATOR,0,2047);
packet[10] |= channel<<6;
packet[11] = channel>>2;
packet[12] = channel>>10;
channel=convert_channel_16b_limit(RUDDER,0,2047);
packet[12] |= channel<<1;
packet[13] = channel>>8;
packet[9] |= channel<<6;
packet[10] = channel>>2;
packet[11] = channel>>10;
channel=convert_channel_16b_limit(RUDDER,2047,0);
packet[11] |= channel<<1;
packet[12] = channel>>7;
//unknown
//packet[14] = 0x00;
//packet[13..15]
packet[15] = 0x04;
}