| 211,10 → 211,20 |
|---|
| CanReceive(); |
| |
| errorcnt = CAN_GetTransmitErrorCounter(); |
| DebugOut.Analog[18] = errorcnt; |
| //DebugOut.Analog[18] = errorcnt; |
| //if(errorcnt > 200) CanbusInit(); |
| |
| //DebugOut.Analog[16] = CAN->SR ; |
| if(CanbusTimeOut < 3) |
| { |
| if(CanbusTimeOut == 1) Partner.ErrorCode = 39; // ERR: Canbus |
| Partner.StatusFlags = 0; |
| Partner.StatusFlags2 = 0; |
| Partner.StatusFlags3 = 0; |
| Partner.NC_To_FC_Flags = 0; |
| Partner.MagnetField = 0; |
| Partner.GyroCompassCorrected = -1; |
| } |
| |
| if(AllMsgsReceived) |
| { |
| 246,6 → 256,7 |
|---|
| //DebugOut.Analog[18] = CanRxMessage[CAN_ID_FS_LAT].D.sLong / 100000; |
| } |
| } |
| |
| } |
| |
| |