| 25,11 → 25,11 |
|---|
| ToNaviCtrl.Sync2 = 0x55; |
| |
| ToNaviCtrl.Comp = 12; |
| ToNaviCtrl.IntegralNick = 12345; |
| ToNaviCtrl.IntegralPitch = 12345; |
| ToNaviCtrl.IntegralRoll = 56789; |
| ToNaviCtrl.StickNick = 100; |
| ToNaviCtrl.StickPitch = 100; |
| ToNaviCtrl.StickRoll = 150;//(char) StickRoll; |
| ToNaviCtrl.StickGier = 200;//(char) StickGier; |
| ToNaviCtrl.StickYaw = 200;//(char) StickYaw; |
| |
| } |
| |
| 47,9 → 47,9 |
|---|
| DebugOut.Analog[16]++; |
| // -- Debug-Output --- |
| /* DebugOut.Analog[20] = FromNaviCtrl.Comp; |
| DebugOut.Analog[21] = FromNaviCtrl.GPS_Nick; |
| DebugOut.Analog[21] = FromNaviCtrl.GPS_Pitch; |
| DebugOut.Analog[22] = FromNaviCtrl.GPS_Roll; |
| DebugOut.Analog[23] = FromNaviCtrl.CompassValue; |
| DebugOut.Analog[23] = FromNaviCtrl.CompassHeading; |
| */ |
| //---- |
| SPDR = ToNaviCtrl.Sync1; // Start transmission |
| 100,11 → 100,11 |
|---|
| /*static unsigned char i =0; |
| cli(); |
| ToNaviCtrl.Comp = SPI_PROTOCOL_COMP; |
| ToNaviCtrl.IntegralNick = (int) (IntegralNick >> 4); |
| ToNaviCtrl.IntegralPitch = (int) (IntegralPitch >> 4); |
| ToNaviCtrl.IntegralRoll = (int) (IntegralRoll >> 4); |
| ToNaviCtrl.StickNick = 4; |
| ToNaviCtrl.StickPitch = 4; |
| ToNaviCtrl.StickRoll = 5;//(char) StickRoll; |
| ToNaviCtrl.StickGier = 6;//(char) StickGier; |
| ToNaviCtrl.StickYaw = 6;//(char) StickYaw; |
| sei(); |
| */ |
| } |