Rev 1850 | Rev 1855 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1850 | Rev 1852 | ||
---|---|---|---|
Line 23... | Line 23... | ||
23 | 23 | ||
24 | unsigned char SPI_CommandSequence[] = {SPI_FCCMD_STICK, SPI_FCCMD_USER, SPI_FCCMD_PARAMETER1, SPI_FCCMD_STICK, SPI_FCCMD_MISC, SPI_FCCMD_VERSION, SPI_FCCMD_STICK, SPI_FCCMD_SERVOS, SPI_FCCMD_ACCU}; |
24 | unsigned char SPI_CommandSequence[] = {SPI_FCCMD_STICK, SPI_FCCMD_USER, SPI_FCCMD_PARAMETER1, SPI_FCCMD_STICK, SPI_FCCMD_MISC, SPI_FCCMD_VERSION, SPI_FCCMD_STICK, SPI_FCCMD_SERVOS, SPI_FCCMD_ACCU}; |
25 | unsigned char SPI_CommandCounter = 0; |
25 | unsigned char SPI_CommandCounter = 0; |
26 | unsigned char NC_ErrorCode = 0; |
26 | unsigned char NC_ErrorCode = 0; |
- | 27 | signed int POI_KameraNick = 0; // in 0,1° |
|
Line 27... | Line 28... | ||
27 | signed int POI_KameraNick = 0; // in 0,1° |
28 | vector16_t MagVec = {0,0,0}; |
Line 28... | Line 29... | ||
28 | 29 | ||
29 | #ifdef USE_SPI_COMMUNICATION |
30 | #ifdef USE_SPI_COMMUNICATION |
Line 277... | Line 278... | ||
277 | { |
278 | { |
278 | GPS_Nick = FromNaviCtrl.GPS_Nick; |
279 | GPS_Nick = FromNaviCtrl.GPS_Nick; |
279 | GPS_Roll = FromNaviCtrl.GPS_Roll; |
280 | GPS_Roll = FromNaviCtrl.GPS_Roll; |
280 | } |
281 | } |
Line -... | Line 282... | ||
- | 282 | ||
- | 283 | // update compass readings |
|
- | 284 | MagVec.x = FromNaviCtrl.MagVecX; |
|
- | 285 | MagVec.y = FromNaviCtrl.MagVecY; |
|
- | 286 | MagVec.z = FromNaviCtrl.MagVecZ; |
|
281 | 287 | ||
282 | if(FromNaviCtrl.CompassValue <= 360) KompassValue = FromNaviCtrl.CompassValue; |
288 | if(FromNaviCtrl.CompassValue <= 360) KompassValue = FromNaviCtrl.CompassValue; |
Line 283... | Line 289... | ||
283 | KompassRichtung = ((540 + KompassValue - KompassSollWert) % 360) - 180; |
289 | KompassRichtung = ((540 + KompassValue - KompassSollWert) % 360) - 180; |