60,7 → 60,7 |
typedef struct |
{ |
int16_t Heading; |
} Heading_t; |
} __attribute__((packed)) Heading_t; |
|
DebugOut_t DebugOut; |
ExternControl_t ExternControl; |
438,9 → 438,7 |
{ |
#ifdef USE_MK3MAG |
case 'K':// compass value |
Heading_t* pMK3MagHeading; |
pMK3MagHeading = (Heading_t *) pRxData; |
CompassHeading = *pMK3MagHeading; |
CompassHeading = ((Heading_t *)pRxData)->Heading; |
CompassOffCourse = ((540 + CompassHeading - CompassCourse) % 360) - 180; |
break; |
#endif |
499,15 → 497,6 |
|
switch(rxd_buffer[2]) |
{ |
// only for compatibility to old MK3Mag Version taht does not send the right Slave Address |
#ifdef USE_MK3MAG |
case 'K':// compass value |
Heading_t* pMK3MagHeading; |
pMK3MagHeading = (Heading_t *) pRxData; |
CompassHeading = *pMK3MagHeading; |
CompassOffCourse = ((540 + CompassHeading - CompassCourse) % 360) - 180; |
break; |
#endif |
case 'a':// request for labels of the analog debug outputs |
Request_DebugLabel = pRxData[0]; |
if(Request_DebugLabel > 31) Request_DebugLabel = 31; |