/* * Copyright (C) OpenTX * * Based on code named * th9x - http://code.google.com/p/th9x * er9x - http://code.google.com/p/er9x * gruvin9x - http://code.google.com/p/gruvin9x * * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program 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. */ #include "../opentx.h" #define DSM2_SEND_BIND (1 << 7) #define DSM2_SEND_RANGECHECK (1 << 5) #if defined(PCBSKY9X) uint8_t dsm2BindTimer = DSM2_BIND_TIMEOUT; #endif // DSM2 control bits #define DSM2_CHANS 6 #define FRANCE_BIT 0x10 #define DSMX_BIT 0x08 #define BAD_DATA 0x47 #define BITLEN_DSM2 (8*2) //125000 Baud => 8uS per bit #if !defined(PPM_PIN_HW_SERIAL) void _send_1(uint8_t v) { if (modulePulsesData[EXTERNAL_MODULE].dsm2.index == 0) v -= 2; else v += 2; modulePulsesData[EXTERNAL_MODULE].dsm2.value += v; *modulePulsesData[EXTERNAL_MODULE].dsm2.ptr++ = modulePulsesData[EXTERNAL_MODULE].dsm2.value; modulePulsesData[EXTERNAL_MODULE].dsm2.index = (modulePulsesData[EXTERNAL_MODULE].dsm2.index+1) % 2; } void sendByteDsm2(uint8_t b) //max 10 changes 0 10 10 10 10 1 { bool lev = 0; uint8_t len = BITLEN_DSM2; //max val: 9*16 < 256 for (uint8_t i=0; i<=8; i++) { //8Bits + Stop=1 bool nlev = b & 1; //lsb first if (lev == nlev) { len += BITLEN_DSM2; } else { _send_1(len); // _send_1(nlev ? len-5 : len+3); len = BITLEN_DSM2; lev = nlev; } b = (b>>1) | 0x80; //shift in stop bit } _send_1(len+BITLEN_DSM2); // _send_1(len+BITLEN_DSM2+3); // 2 stop bits } void putDsm2Flush() { modulePulsesData[EXTERNAL_MODULE].dsm2.ptr--; //remove last stopbits and *modulePulsesData[EXTERNAL_MODULE].dsm2.ptr++ = 44010; // Past the 44000 of the ARR } #else void putDsm2SerialBit(uint8_t bit) { modulePulsesData[EXTERNAL_MODULE].dsm2.serialByte >>= 1; if (bit & 1) { modulePulsesData[EXTERNAL_MODULE].dsm2.serialByte |= 0x80; } if (++modulePulsesData[EXTERNAL_MODULE].dsm2.serialBitCount >= 8) { *modulePulsesData[EXTERNAL_MODULE].dsm2.ptr++ = modulePulsesData[EXTERNAL_MODULE].dsm2.serialByte; modulePulsesData[EXTERNAL_MODULE].dsm2.serialBitCount = 0; } } void sendByteDsm2(uint8_t b) // max 10changes 0 10 10 10 10 1 { putDsm2SerialBit(0); // Start bit for (uint8_t i=0; i<8; i++) { // 8 data Bits putDsm2SerialBit(b & 1); b >>= 1; } putDsm2SerialBit(1); // Stop bit putDsm2SerialBit(1); // Stop bit } void putDsm2Flush() { for (int i=0; i<16; i++) { putDsm2SerialBit(1); // 16 extra stop bits } } #endif // This is the data stream to send, prepare after 19.5 mS // Send after 22.5 mS //static uint8_t *Dsm2_pulsePtr = pulses2MHz.pbyte ; void setupPulsesDSM2(unsigned int port) { static uint8_t dsmDat[2+6*2]={0xFF,0x00, 0x00,0xAA, 0x05,0xFF, 0x09,0xFF, 0x0D,0xFF, 0x13,0x54, 0x14,0xAA}; #if defined(PPM_PIN_HW_SERIAL) modulePulsesData[EXTERNAL_MODULE].dsm2.serialByte = 0 ; modulePulsesData[EXTERNAL_MODULE].dsm2.serialBitCount = 0 ; #else modulePulsesData[EXTERNAL_MODULE].dsm2.value = 0; modulePulsesData[EXTERNAL_MODULE].dsm2.index = 1; #endif modulePulsesData[EXTERNAL_MODULE].dsm2.ptr = modulePulsesData[EXTERNAL_MODULE].dsm2.pulses; #if !defined(PPM_PIN_HW_SERIAL) modulePulsesData[EXTERNAL_MODULE].dsm2.value = 100; *modulePulsesData[EXTERNAL_MODULE].dsm2.ptr++ = modulePulsesData[EXTERNAL_MODULE].dsm2.value; #endif switch (s_current_protocol[port]) { case PROTO_DSM2_LP45: dsmDat[0] = 0x00; break; case PROTO_DSM2_DSM2: dsmDat[0] = 0x10; break; default: // DSMX dsmDat[0] = 0x10 | DSMX_BIT; break; } #if !defined(PPM_PIN_HW_SERIAL) if (moduleFlag[port] == MODULE_BIND) dsmDat[0] |= DSM2_SEND_BIND; else if (moduleFlag[port] == MODULE_RANGECHECK) dsmDat[0] |= DSM2_SEND_RANGECHECK; #else #if defined(PCBSKY9X) // TODO needed? if (dsm2BindTimer > 0) { dsm2BindTimer--; if (switchState(SW_DSM2_BIND)) { moduleFlag[port] = MODULE_BIND; dsmDat[0] |= DSM2_SEND_BIND; } } else #endif if (moduleFlag[port] == MODULE_RANGECHECK) { dsmDat[0] |= DSM2_SEND_RANGECHECK; } else { moduleFlag[port] = 0; } #endif dsmDat[1] = g_model.header.modelId[port]; // DSM2 Header second byte for model match for (int i=0; i>5)+512, 1023); dsmDat[2+2*i] = (i<<2) | ((pulse>>8)&0x03); dsmDat[3+2*i] = pulse & 0xff; } for (int i=0; i<14; i++) { sendByteDsm2(dsmDat[i]); } putDsm2Flush(); }