rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-29 14:52:12 +01:00
Code Issues Releases Activity

OP-22 Flight/PiOS: Spektrum parser handles all known TXs, or atleast should. Test it well before sending aircraft to the sky.

Browse Source 
git-svn-id: svn://svn.openpilot.org/OpenPilot/trunk@3133 ebee16cc-31ac-478f-84a7-5cbb03baadba
This commit is contained in:
sambas 2011-04-09 14:17:23 +00:00 committed by sambas
parent 8e7fd4da81
commit cdfbf8614c
1 changed files with 30 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

39
flight/PiOS/STM32F10x/pios_spektrum.c
View File

@ -188,13 +188,15 @@ uint8_t PIOS_SPEKTRUM_Bind(void)
*/ */
int32_t PIOS_SPEKTRUM_Decode(uint8_t b) int32_t PIOS_SPEKTRUM_Decode(uint8_t b)
{ {
static uint16_t channel = 0, sync_word = 0; static uint16_t channel = 0; /*, sync_word = 0;*/
uint8_t channeln = 0, frame = 0; uint8_t channeln = 0, frame = 0, datalength=0;
uint16_t data = 0; uint16_t data = 0;
byte_array[bytecount] = b; byte_array[bytecount] = b;
bytecount++; bytecount++;
if (sync == 0) { if (sync == 0) {
sync_word = (prev_byte << 8) + b; //sync_word = (prev_byte << 8) + b;
#if 0
/* maybe create object to show this data */
if(bytecount==1) if(bytecount==1)
{ {
/* record losscounter into channel8 */ /* record losscounter into channel8 */
@ -202,19 +204,38 @@ int32_t PIOS_SPEKTRUM_Decode(uint8_t b)
/* instant write */ /* instant write */
CaptureValue[7]=b; CaptureValue[7]=b;
} }
if (((sync_word & 0x00FE) == 0) && (bytecount == 2)) { #endif
/* sync low byte always 0x01, high byte seems to be random when switching TX on off on, loss counter??? */ /* Known sync bytes, 0x01, 0x02, 0x12 */
if (sync_word & 0x01) { if (bytecount == 2) {
if (b == 0x01) {
datalength=0; // 10bit
//frames=1;
sync = 1; sync = 1;
bytecount = 2; bytecount = 2;
} }
else if(b == 0x02) {
datalength=0; // 10bit
//frames=2;
sync = 1;
bytecount = 2;
}
else if(b == 0x12) {
datalength=1; // 11bit
//frames=2;
sync = 1;
bytecount = 2;
}
else
{
bytecount = 0;
}
} }
} else { } else {
if ((bytecount % 2) == 0) { if ((bytecount % 2) == 0) {
channel = (prev_byte << 8) + b; channel = (prev_byte << 8) + b;
frame = channel >> 15; frame = channel >> 15;
channeln = (channel >> 10) & 0x0F; channeln = (channel >> (10+datalength)) & 0x0F;
data = channel & 0x03FF; data = channel & (0x03FF+(0x0400*datalength));
if(channeln==0 && data<10) // discard frame if throttle misbehaves if(channeln==0 && data<10) // discard frame if throttle misbehaves
{ {
frame_error=1; frame_error=1;
@ -271,7 +292,7 @@ void PIOS_SPEKTRUM_irq_handler() {
/* Clear timer interrupt pending bit */ /* Clear timer interrupt pending bit */
TIM_ClearITPendingBit(pios_spektrum_cfg.timer, TIM_IT_Update); TIM_ClearITPendingBit(pios_spektrum_cfg.timer, TIM_IT_Update);
/* sync between frames, TODO! DX7SE */ /* sync between frames */
sync = 0; sync = 0;
bytecount = 0; bytecount = 0;
prev_byte = 0xFF; prev_byte = 0xFF;