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

DM002: 2 TX ID/RF & features addition

Browse Source
This commit is contained in:
pascallanger 2017-03-23 18:05:00 +01:00
parent 59af0594dc
commit 940a89fa38
1 changed files with 25 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

29
Multiprotocol/DM002_nrf24l01.ino
View File

@ -29,7 +29,12 @@ enum DM002_FLAGS {
// flags going to packet[9] // flags going to packet[9]
DM002_FLAG_FLIP = 0x01, DM002_FLAG_FLIP = 0x01,
DM002_FLAG_LED = 0x02, DM002_FLAG_LED = 0x02,
DM002_FLAG_HEADLESS = 0x10, DM002_FLAG_MEDIUM = 0x04,
DM002_FLAG_HIGH = 0x08,
DM002_FLAG_RTH = 0x10,
DM002_FLAG_HEADLESS = 0x20,
DM002_FLAG_CAMERA1 = 0x40,
DM002_FLAG_CAMERA2 = 0x80,
}; };
static void __attribute__((unused)) DM002_send_packet(uint8_t bind) static void __attribute__((unused)) DM002_send_packet(uint8_t bind)
@ -54,8 +59,12 @@ static void __attribute__((unused)) DM002_send_packet(uint8_t bind)
packet[4] = convert_channel_8b_scale(ELEVATOR, 0xA7, 0x57); packet[4] = convert_channel_8b_scale(ELEVATOR, 0xA7, 0x57);
// Features // Features
packet[9] = GET_FLAG(Servo_AUX1,DM002_FLAG_FLIP) packet[9] = GET_FLAG(Servo_AUX1,DM002_FLAG_FLIP)
| GET_FLAG(Servo_AUX2,DM002_FLAG_LED) | GET_FLAG(!Servo_AUX2,DM002_FLAG_LED)
| GET_FLAG(Servo_AUX3,DM002_FLAG_HEADLESS); | GET_FLAG(Servo_AUX3,DM002_FLAG_CAMERA1)
| GET_FLAG(Servo_AUX4,DM002_FLAG_CAMERA2)
| GET_FLAG(Servo_AUX5,DM002_FLAG_HEADLESS)
| GET_FLAG(Servo_AUX6,DM002_FLAG_RTH)
| GET_FLAG(!Servo_AUX7,DM002_FLAG_HIGH);
// Packet counter // Packet counter
if(packet_count&0x03) if(packet_count&0x03)
{ {
@ -123,10 +132,18 @@ uint16_t DM002_callback()
static void __attribute__((unused)) DM002_initialize_txid() static void __attribute__((unused)) DM002_initialize_txid()
{ {
// lani TXID // Only 2 IDs/RFs are available, RX_NUM is used to switch between them
memcpy(rx_tx_addr,(uint8_t *)"\xAC\xA1\x00\x00\xD5",5);
// lani hopping_frequency // RF channels
if(rx_tx_addr[3]&1)
memcpy(hopping_frequency,(uint8_t *)"\x34\x39\x43\x48",4);
else
memcpy(hopping_frequency,(uint8_t *)"\x35\x39\x3B\x3D",4); memcpy(hopping_frequency,(uint8_t *)"\x35\x39\x3B\x3D",4);
// TX IDs
if(rx_tx_addr[3]&1)
memcpy(rx_tx_addr,(uint8_t *)"\x47\x93\x00\x00\xD5",5);
else
memcpy(rx_tx_addr,(uint8_t *)"\xAC\xA1\x00\x00\xD5",5);
} }
uint16_t initDM002(void) uint16_t initDM002(void)