Rev 865 | Rev 878 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 865 | Rev 869 | ||
|---|---|---|---|
| Line 71... | Line 71... | ||
| 71 | #include "ncmag.h" |
71 | #include "ncmag.h" |
| 72 | #include "uart0.h" |
72 | #include "uart0.h" |
| 73 | #include "settings.h" |
73 | #include "settings.h" |
| 74 | #include "crc16.h" |
74 | #include "crc16.h" |
| 75 | #include "camctrl.h" |
75 | #include "camctrl.h" |
| 76 | - | ||
| - | 76 | #include "ssc.h" |
|
| Line 77... | Line 77... | ||
| 77 | 77 | ||
| 78 | u16 Check16File; |
78 | u16 Check16File; |
| Line 79... | Line 79... | ||
| 79 | u16 Check16Block; |
79 | u16 Check16Block; |
| Line 217... | Line 217... | ||
| 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 | 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);} |
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 | ||
| - | 223 | sprintf(string, "<Channels>ALT:%i,GPS:%i,CF:%i,SL:%i,FS:%i,MSS:%i,SWP:%i,NWP:%i,CCM:%i,CCZ:%i</Channels>\r\n",EE_Parameter.HoeheChannel,EE_Parameter.NaviGpsModeChannel,EE_Parameter.CareFreeChannel, EE_Parameter.StartLandChannel, EE_Parameter.FailsafeChannel, EE_Parameter.MotorSafetySwitch,EE_Parameter.SingleWpControlChannel,EE_Parameter.MenuKeyChannel,EE_Parameter.CamCtrlModeChannel,EE_Parameter.CamCtrlZoomChannel);CheckSumAndWrite(&Check16File,string, doc->file); |
|
| - | 224 | // Alt = Altitude |
|
| - | 225 | // GPS = GPS |
|
| - | 226 | // CF = Carefree |
|
| - | 227 | // SL = Start/Land |
|
| - | 228 | // FS = Failsafe |
|
| - | 229 | // MSS = Motor Safety Switch |
|
| - | 230 | // SWP: Single WP Channel |
|
| - | 231 | // NWP: Next WP Channel |
|
| - | 232 | // CCM: CamCtrlMode |
|
| - | 233 | // CCZ: CamCtrlZoom |
|
| - | 234 | ||
| - | 235 | ||
| 222 | //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
236 | //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| 223 | // Magnetometer |
237 | // Magnetometer |
| 224 | if(Compass_I2CPort == NCMAG_PORT_EXTERN) sprintf(string, "<MagSensor>external2,(%i),",NCMAG_Orientation); |
238 | 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); |
239 | else if(NCMAG_Compass_use_Orientation) sprintf(string, "<MagSensor>external1,(%i),",NCMAG_Orientation); |
| 226 | else sprintf(string, "<MagSensor>internal,"); |
240 | else sprintf(string, "<MagSensor>internal,"); |
| Line 262... | Line 276... | ||
| 262 | else |
276 | else |
| 263 | {sprintf(string, "<FlyZonePoints>%d,hold</FlyZonePoints>\r\n",FlyzonePointCnt);CheckSumAndWrite(&Check16File,string, doc->file);} |
277 | {sprintf(string, "<FlyZonePoints>%d,hold</FlyZonePoints>\r\n",FlyzonePointCnt);CheckSumAndWrite(&Check16File,string, doc->file);} |
| 264 | } |
278 | } |
| 265 | //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
279 | //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| 266 | sprintf(string, "<Bytes>%02x,%02x,%02x</Bytes>\r\n",Parameter.GlobalConfig,Parameter.ExtraConfig,Parameter.GlobalConfig3);CheckSumAndWrite(&Check16File,string, doc->file); |
280 | sprintf(string, "<Bytes>%02x,%02x,%02x</Bytes>\r\n",Parameter.GlobalConfig,Parameter.ExtraConfig,Parameter.GlobalConfig3);CheckSumAndWrite(&Check16File,string, doc->file); |
| - | 281 | sprintf(string, "<SPI_Speed>%d</SPI_Speed>\r\n",SPI_Speed);CheckSumAndWrite(&Check16File,string, doc->file); |
|
| 267 | sprintf(string, "</settings>\r\n"); CheckSumAndWrite(&Check16File,string, doc->file); |
282 | sprintf(string, "</settings>\r\n"); CheckSumAndWrite(&Check16File,string, doc->file); |
| 268 | sprintf(string, "</extensions>\r\n"); CheckSumAndWrite(&Check16File,string, doc->file); |
283 | sprintf(string, "</extensions>\r\n"); CheckSumAndWrite(&Check16File,string, doc->file); |
| 269 | fwrite_((void*)GPX_DOCUMENT_METADATA_END, sizeof(GPX_DOCUMENT_METADATA_END)-1,1,doc->file);// write the gpx-header to the document. |
284 | fwrite_((void*)GPX_DOCUMENT_METADATA_END, sizeof(GPX_DOCUMENT_METADATA_END)-1,1,doc->file);// write the gpx-header to the document. |
| Line 270... | Line 285... | ||
| 270 | 285 | ||
| Line 687... | Line 702... | ||
| 687 | CheckSumAndWrite(&Check16Block,string, doc->file); |
702 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 688 | // Vertical Speed in cm/s |
703 | // Vertical Speed in cm/s |
| 689 | sprintf(string, "<VerticalSpeed>%d</VerticalSpeed>\r\n", NaviData.TopSpeed); |
704 | sprintf(string, "<VerticalSpeed>%d</VerticalSpeed>\r\n", NaviData.TopSpeed); |
| 690 | CheckSumAndWrite(&Check16Block,string, doc->file); |
705 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 691 | // RC Sticks as Nick/Roll/Yaw |
706 | // RC Sticks as Nick/Roll/Yaw |
| 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]); |
707 | // 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]); |
| - | 708 | ||
| - | 709 | sprintf(string, "<RCSticks>%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d</RCSticks>\r\n", FC.StickNick,FC.StickRoll, FC.StickYaw, FC.StickGas,PPM_In[5],PPM_In[6],PPM_In[7],PPM_In[8],PPM_In[9],PPM_In[10],PPM_In[11],PPM_In[12],PPM_In[13],PPM_In[14],PPM_In[15],PPM_In[16]); |
|
| - | 710 | ||
| 693 | CheckSumAndWrite(&Check16Block,string, doc->file); |
711 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 694 | // GPS Sticks as Nick/Roll/Yaw |
712 | // 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); |
713 | 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); |
714 | CheckSumAndWrite(&Check16Block,string, doc->file); |
| 697 | if(EE_Parameter.ExternalControl) |
715 | if(EE_Parameter.ExternalControl) |