131,7 → 131,6 |
|
case 2: // get normal NC data packets |
SPI_Buffer[SPI_RxBufferIndex++]= rxdata; // get data |
//DebugOut.Analog[19]++; |
if (SPI_RxBufferIndex >= sizeof(FromNaviCtrl)) |
{ |
if (rxdata == rxchksum) |
258,7 → 257,6 |
FC_StatusFlags &= ~(FC_STATUS_CALIBRATE | FC_STATUS_START); |
if(!(PORTC & (1<<PORTC2))) FC_StatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE; // Out1 (J16) |
|
|
//ToNaviCtrl.Param.sInt[9] = DebugOut.Analog[17]; |
// 8 = 16,17 |
// 9 = 18,19 |
297,6 → 295,7 |
ToNaviCtrl.Param.Byte[10] = EE_Parameter.NaviAccCompensation; |
ToNaviCtrl.Param.Byte[11] = EE_Parameter.NaviAngleLimitation; |
ToNaviCtrl.Param.sInt[6] = ToNC_LaserAltCorrect_dm; // 12 & 13 |
ToNaviCtrl.Param.Byte[14] = Parameter_LaserAltitude; |
slow_command++; |
break; |
case 2: |
449,8 → 448,8 |
} |
else ToNaviCtrl.Param.Byte[0] = WinkelOut.CalcState; |
ToNaviCtrl.Param.Byte[1] = HoverGas / 4; |
ToNaviCtrl.Param.Int[1] = (int)(HoehenWert/5); //2 & 3 |
ToNaviCtrl.Param.Int[2] = (int)(SollHoehe/5); //4 & 5 |
ToNaviCtrl.Param.Int[1] = (int)(HoehenWert/10); //2 & 3 |
ToNaviCtrl.Param.Int[2] = (int)(SollHoehe/10); //4 & 5 |
ToNaviCtrl.Param.Byte[6] = VersionInfo.HardwareError[0]; |
ToNaviCtrl.Param.Byte[7] = VersionInfo.HardwareError[1]; |
VersionInfo.HardwareError[0] &= ~FC_ERROR0_CAREFREE; // VersionInfo.HardwareError[0] = 0; |