Rev 798 | Rev 864 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 798 | Rev 837 | ||
---|---|---|---|
Line 623... | Line 623... | ||
623 | case 6: |
623 | case 6: |
624 | /* sprintf(string, "<BL_State>0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x</BL_State>\r\n",Motor.State[0],Motor.State[1],Motor.State[2],Motor.State[3],Motor.State[4],Motor.State[5],Motor.State[6],Motor.State[7],Motor.State[8],Motor.State[9],Motor.State[10],Motor.State[11]); |
624 | /* sprintf(string, "<BL_State>0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x,0x%02x</BL_State>\r\n",Motor.State[0],Motor.State[1],Motor.State[2],Motor.State[3],Motor.State[4],Motor.State[5],Motor.State[6],Motor.State[7],Motor.State[8],Motor.State[9],Motor.State[10],Motor.State[11]); |
625 | CheckSumAndWrite(&Check16Block,string, doc->file); |
625 | CheckSumAndWrite(&Check16Block,string, doc->file); |
626 | sprintf(string, "<BL_MaxPWM>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</BL_MaxPWM>\r\n",Motor.MaxPWM[0],Motor.MaxPWM[1],Motor.MaxPWM[2],Motor.MaxPWM[3],Motor.MaxPWM[4],Motor.MaxPWM[5],Motor.MaxPWM[6],Motor.MaxPWM[7],Motor.MaxPWM[8],Motor.MaxPWM[9],Motor.MaxPWM[10],Motor.MaxPWM[11]); |
626 | sprintf(string, "<BL_MaxPWM>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</BL_MaxPWM>\r\n",Motor.MaxPWM[0],Motor.MaxPWM[1],Motor.MaxPWM[2],Motor.MaxPWM[3],Motor.MaxPWM[4],Motor.MaxPWM[5],Motor.MaxPWM[6],Motor.MaxPWM[7],Motor.MaxPWM[8],Motor.MaxPWM[9],Motor.MaxPWM[10],Motor.MaxPWM[11]); |
627 | CheckSumAndWrite(&Check16Block,string, doc->file); |
627 | CheckSumAndWrite(&Check16Block,string, doc->file); |
- | 628 | */ |
|
628 | */ sprintf(string, "<AvaiableMotorPower>%03d</AvaiableMotorPower>\r\n",Logging_BL_MinOfMaxPWM); |
629 | sprintf(string, "<AvaiableMotorPower>%03d</AvaiableMotorPower>\r\n",Logging_BL_MinOfMaxPWM); |
629 | Logging_BL_MinOfMaxPWM = BL_MinOfMaxPWM; |
630 | Logging_BL_MinOfMaxPWM = BL_MinOfMaxPWM; |
630 | CheckSumAndWrite(&Check16Block,string, doc->file); |
631 | CheckSumAndWrite(&Check16Block,string, doc->file); |
631 | - | ||
632 | // Gas values |
632 | // Gas values |
633 | if(LoggingGasCnt > 1) LoggingGasFilter = LoggingGasFilter / LoggingGasCnt; |
633 | if(LoggingGasCnt > 1) LoggingGasFilter = LoggingGasFilter / LoggingGasCnt; |
634 | sprintf(string, "<Gas>%03d,%03d</Gas>\r\n",(u16)LoggingGasFilter,HoverGas); |
634 | sprintf(string, "<Gas>%03d,%03d</Gas>\r\n",(u16)LoggingGasFilter,HoverGas); |
635 | LoggingGasCnt = 0; |
635 | LoggingGasCnt = 0; |
Line 640... | Line 640... | ||
640 | sprintf(string, "<FC_SPI_ErrorCounter>%03d</FC_SPI_ErrorCounter>\r\n",(s16)DebugOut.Analog[12]); |
640 | sprintf(string, "<FC_SPI_ErrorCounter>%03d</FC_SPI_ErrorCounter>\r\n",(s16)DebugOut.Analog[12]); |
641 | CheckSumAndWrite(&Check16Block,string, doc->file); |
641 | CheckSumAndWrite(&Check16Block,string, doc->file); |
642 | // Analog inputs of the NC |
642 | // Analog inputs of the NC |
643 | sprintf(string, "<AnalogInputs>%d,%d,%d,%d</AnalogInputs>\r\n",AnalogData.Ch4,AnalogData.Ch5,AnalogData.Ch6,AnalogData.Ch7); |
643 | sprintf(string, "<AnalogInputs>%d,%d,%d,%d</AnalogInputs>\r\n",AnalogData.Ch4,AnalogData.Ch5,AnalogData.Ch6,AnalogData.Ch7); |
644 | CheckSumAndWrite(&Check16Block,string, doc->file); |
644 | CheckSumAndWrite(&Check16Block,string, doc->file); |
645 | sprintf(string, "<Servo>%d,%d,%d</Servo>\r\n", ServoParams.NickControl,ServoParams.RollControl,POI_KameraNick/10); // Raw Poti-Values of the Servo control and the POI_Nick in 1° |
645 | sprintf(string, "<Servo>%d,%d,%d</Servo>\r\n", FromFC_ServoNickControl,FromFC_ServoRollControl,POI_KameraNick/10); // Raw Poti-Values of the Servo control and the POI_Nick in 1° |
646 | CheckSumAndWrite(&Check16Block,string, doc->file); |
646 | CheckSumAndWrite(&Check16Block,string, doc->file); |
Line 647... | Line 647... | ||
647 | 647 | ||
648 | if(NC_GPS_ModeCharacter == 'F') // Failsafe Point is active |
648 | if(NC_GPS_ModeCharacter == 'F') // Failsafe Point is active |
649 | { |
649 | { |