Rev 864 | Rev 869 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 864 | Rev 865 | ||
|---|---|---|---|
| Line 216... | Line 216... | ||
| 216 | if((FC.StatusFlags3 & FC_STATUS3_BOAT)) {sprintf(string, "<BoatMode>On</BoatMode>\r\n");CheckSumAndWrite(&Check16File,string, doc->file);} |
216 | if((FC.StatusFlags3 & FC_STATUS3_BOAT)) {sprintf(string, "<BoatMode>On</BoatMode>\r\n");CheckSumAndWrite(&Check16File,string, doc->file);} |
| 217 | if(Parameter.Driftkomp) {sprintf(string, "<DriftComp>%i</DriftComp>\r\n",Parameter.Driftkomp);CheckSumAndWrite(&Check16File,string, doc->file);}; |
217 | if(Parameter.Driftkomp) {sprintf(string, "<DriftComp>%i</DriftComp>\r\n",Parameter.Driftkomp);CheckSumAndWrite(&Check16File,string, doc->file);}; |
| 218 | sprintf(string, "<BaroKompens.>%i</BaroKompens.>\r\n",LuftdruckTemperaturKompensation);CheckSumAndWrite(&Check16File,string, doc->file); |
218 | sprintf(string, "<BaroKompens.>%i</BaroKompens.>\r\n",LuftdruckTemperaturKompensation);CheckSumAndWrite(&Check16File,string, doc->file); |
| 219 | sprintf(string, "<FcTemperat.>%i.%1i</FcTemperat.>\r\n",FC_Temperatur/10,abs(FC_Temperatur)%10);CheckSumAndWrite(&Check16File,string, doc->file); |
219 | sprintf(string, "<FcTemperat.>%i.%1i</FcTemperat.>\r\n",FC_Temperatur/10,abs(FC_Temperatur)%10);CheckSumAndWrite(&Check16File,string, doc->file); |
| 220 | if(FromGimbalCtrl.GimbalStatus) {sprintf(string, "<GimbalCtrV>%i.%02i</GimbalCtrV>\r\n",1 + FromGimbalCtrl.Version / 100, FromGimbalCtrl.Version % 100);CheckSumAndWrite(&Check16File,string, doc->file);} |
220 | if(FromGimbalCtrl.GimbalStatus) {sprintf(string, "<GimbalCtrV>%i.%02i</GimbalCtrV>\r\n",1 + FromGimbalCtrl.Version / 100, FromGimbalCtrl.Version % 100);CheckSumAndWrite(&Check16File,string, doc->file);} |
| 221 | - | ||
| - | 221 | if(EE_Parameter.ExternalControl) {sprintf(string, "<ExternalControl>%i,%02x,%02x</ExternalControl>\r\n",EE_Parameter.ExternalControl,FromFC_ExternalCtrlCfg,FromFC_ExternalCtrlSwitch);CheckSumAndWrite(&Check16File,string, doc->file);} |
|
| 222 | //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
222 | //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| 223 | // Magnetometer |
223 | // Magnetometer |
| 224 | if(Compass_I2CPort == NCMAG_PORT_EXTERN) sprintf(string, "<MagSensor>external2,(%i),",NCMAG_Orientation); |
224 | if(Compass_I2CPort == NCMAG_PORT_EXTERN) sprintf(string, "<MagSensor>external2,(%i),",NCMAG_Orientation); |
| 225 | else if(NCMAG_Compass_use_Orientation) sprintf(string, "<MagSensor>external1,(%i),",NCMAG_Orientation); |
225 | else if(NCMAG_Compass_use_Orientation) sprintf(string, "<MagSensor>external1,(%i),",NCMAG_Orientation); |
| 226 | else sprintf(string, "<MagSensor>internal,"); |
226 | else sprintf(string, "<MagSensor>internal,"); |
| Line 692... | Line 692... | ||
| 692 | sprintf(string, "<RCSticks>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</RCSticks>\r\n", FC.StickNick,FC.StickRoll, FC.StickYaw, FC.StickGas,FC.Poti[0],FC.Poti[1],FC.Poti[2],FC.Poti[3],FC.Poti[4],FC.Poti[5],FC.Poti[6],FC.Poti[7]); |
692 | sprintf(string, "<RCSticks>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</RCSticks>\r\n", FC.StickNick,FC.StickRoll, FC.StickYaw, FC.StickGas,FC.Poti[0],FC.Poti[1],FC.Poti[2],FC.Poti[3],FC.Poti[4],FC.Poti[5],FC.Poti[6],FC.Poti[7]); |
| 693 | CheckSumAndWrite(&Check16Block,string, doc->file); |
693 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 694 | // GPS Sticks as Nick/Roll/Yaw |
694 | // GPS Sticks as Nick/Roll/Yaw |
| 695 | sprintf(string, "<GPSSticks>%d,%d,%d,'%c'</GPSSticks>\r\n", ToFlightCtrl.GPSStick.Nick, ToFlightCtrl.GPSStick.Roll, 0 ,NC_GPS_ModeCharacter); |
695 | sprintf(string, "<GPSSticks>%d,%d,%d,'%c'</GPSSticks>\r\n", ToFlightCtrl.GPSStick.Nick, ToFlightCtrl.GPSStick.Roll, 0 ,NC_GPS_ModeCharacter); |
| 696 | CheckSumAndWrite(&Check16Block,string, doc->file); |
696 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| - | 697 | if(EE_Parameter.ExternalControl) |
|
| - | 698 | { |
|
| - | 699 | sprintf(string, "<ExCtl>%02x,%02x,%i,%i,%i,%i</ExCtl>\r\n",FromFC_ExternalCtrlCfg,FromFC_ExternalCtrlSwitch,ExternControl.Nick, ExternControl.Roll,ExternControl.Gier,ExternControl.Gas); |
|
| - | 700 | CheckSumAndWrite(&Check16File,string, doc->file); |
|
| - | 701 | } |
|
| 697 | // RC Quality |
702 | // RC Quality |
| 698 | sprintf(string, "<RCQuality>%d</RCQuality>\r\n", FC.RC_Quality); |
703 | sprintf(string, "<RCQuality>%d</RCQuality>\r\n", FC.RC_Quality); |
| 699 | CheckSumAndWrite(&Check16Block,string, doc->file); |
704 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 700 | // raw GPS altitude |
705 | // raw GPS altitude |
| 701 | i32_2 = altitude; |
706 | i32_2 = altitude; |
| Line 728... | Line 733... | ||
| 728 | if(FromGimbalCtrl.GimbalStatus) |
733 | if(FromGimbalCtrl.GimbalStatus) |
| 729 | { |
734 | { |
| 730 | sprintf(string, "<Gimbal>%d.%01d,%d.%01d</Gimbal>\r\n",FromGimbalCtrl.Nick/10,abs(FromGimbalCtrl.Nick%10),FromGimbalCtrl.Roll/10,abs(FromGimbalCtrl.Roll%10)); |
735 | sprintf(string, "<Gimbal>%d.%01d,%d.%01d</Gimbal>\r\n",FromGimbalCtrl.Nick/10,abs(FromGimbalCtrl.Nick%10),FromGimbalCtrl.Roll/10,abs(FromGimbalCtrl.Roll%10)); |
| 731 | CheckSumAndWrite(&Check16Block,string, doc->file); |
736 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 732 | } |
737 | } |
| 733 | - | ||
| 734 | // sprintf(string, "<FCTemperat>%d</FCTemperat>\r\n",FC_Temperatur); |
738 | // sprintf(string, "<FCTemperat>%d</FCTemperat>\r\n",FC_Temperatur); |
| 735 | // CheckSumAndWrite(&Check16Block,string, doc->file); |
739 | // CheckSumAndWrite(&Check16Block,string, doc->file); |
| Line 736... | Line 740... | ||
| 736 | 740 | ||
| 737 | // eof extensions |
741 | // eof extensions |