piotr/edgetx-gx12
1
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

[Taranis] DSM2 fix

Browse Source
This commit is contained in:
bsongis@gmail.com
2013-06-21 22:46:38 +00:00
parent e86aa51a22
commit 5ee5fa7e98
1 changed files with 7 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/protocols/dsm2_arm.cpp
+7 -3
View File
@@ -57,9 +57,11 @@ uint8_t dsm2SerialBitCount;
#define BITLEN_DSM2 (8*2) //125000 Baud => 8uS per bit #define BITLEN_DSM2 (8*2) //125000 Baud => 8uS per bit
#if defined(PCBTARANIS) #if defined(PCBTARANIS)
uint16_t dsm2Value;
void _send_1(uint8_t v) void _send_1(uint8_t v)
{ {
*dsm2StreamPtr++ = v; dsm2Value += v;
*dsm2StreamPtr++ = dsm2Value;
} }
void sendByteDsm2(uint8_t b) //max 10changes 0 10 10 10 10 1 void sendByteDsm2(uint8_t b) //max 10changes 0 10 10 10 10 1
@@ -68,11 +70,11 @@ void sendByteDsm2(uint8_t b) //max 10changes 0 10 10 10 10 1
uint8_t len = BITLEN_DSM2; //max val: 9*16 < 256 uint8_t len = BITLEN_DSM2; //max val: 9*16 < 256
for (uint8_t i=0; i<=8; i++) { //8Bits + Stop=1 for (uint8_t i=0; i<=8; i++) { //8Bits + Stop=1
bool nlev = b & 1; //lsb first bool nlev = b & 1; //lsb first
if (lev == nlev){ if (lev == nlev) {
len += BITLEN_DSM2; len += BITLEN_DSM2;
} }
else { else {
_send_1(len -1); _send_1(len-1);
len = BITLEN_DSM2; len = BITLEN_DSM2;
lev = nlev; lev = nlev;
} }
@@ -126,6 +128,8 @@ void setupPulsesDSM2(unsigned int port)
#if defined(PCBSKY9X) #if defined(PCBSKY9X)
dsm2SerialByte = 0 ; dsm2SerialByte = 0 ;
dsm2SerialBitCount = 0 ; dsm2SerialBitCount = 0 ;
#else
dsm2Value = 0;
#endif #endif
dsm2StreamPtr = dsm2Stream; dsm2StreamPtr = dsm2Stream;