Rev 480 | Rev 483 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 480 | Rev 482 | ||
---|---|---|---|
Line 271... | Line 271... | ||
271 | } |
271 | } |
272 | } |
272 | } |
273 | return(retvalue); |
273 | return(retvalue); |
274 | } |
274 | } |
Line 275... | Line -... | ||
275 | - | ||
276 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
- | |
277 | // + extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55) |
- | |
278 | // +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
- | |
279 | unsigned int BL3_Current(unsigned char who) // in 0,1A |
- | |
280 | { |
- | |
281 | if(Motor[who].Current <= 200) return((unsigned int) Motor[who].Current); |
- | |
282 | else |
- | |
283 | { |
- | |
284 | if(Motor_Version[who] & MOTOR_STATE_BL30) return(200 + 10 * (unsigned int) (Motor[who].Current-200)); |
- | |
285 | else return((unsigned int) Motor[who].Current); |
- | |
286 | } |
- | |
287 | } |
- | |
288 | - | ||
289 | 275 | ||
290 | //________________________________________________________________________________________________________________________________________ |
276 | //________________________________________________________________________________________________________________________________________ |
291 | // Function: u8 GPX_TrackSegementAddPoint(GPS_Pos_t * pGPS_Position ,GPX_Document_t *doc); |
277 | // Function: u8 GPX_TrackSegementAddPoint(GPS_Pos_t * pGPS_Position ,GPX_Document_t *doc); |
292 | // |
278 | // |
293 | // Description: This function adds a pointof a track segement to the specified document. |
279 | // Description: This function adds a pointof a track segement to the specified document. |
Line 401... | Line 387... | ||
401 | sprintf(string, "<RCRSSI>%d</RCRSSI>\r\n", FC.RC_RSSI); |
387 | sprintf(string, "<RCRSSI>%d</RCRSSI>\r\n", FC.RC_RSSI); |
402 | fputs_(string, doc->file); |
388 | fputs_(string, doc->file); |
403 | } |
389 | } |
404 | */ // Compassind deg |
390 | */ // Compassind deg |
405 | i16_1 = FromFlightCtrl.GyroHeading / 10; |
391 | i16_1 = FromFlightCtrl.GyroHeading / 10; |
406 | sprintf(string, "<Compass>%03d,%03d,%03d</Compass>\r\n", i16_1,ToFlightCtrl.CompassHeading, GyroCompassCorrected/10); |
392 | sprintf(string, "<Compass>%03d,%03d,%03d</Compass>\r\n", i16_1,ToFlightCtrl.CompassHeading,GyroCompassCorrected/10); |
407 | fputs_(string, doc->file); |
393 | fputs_(string, doc->file); |
408 | // magnetic field |
394 | // magnetic field |
409 | sprintf(string, "<MagnetField>%03d</MagnetField>\r\n",(u16) (EarthMagneticFieldFiltered/5)); |
395 | sprintf(string, "<MagnetField>%03d</MagnetField>\r\n",(u16) (EarthMagneticFieldFiltered/5)); |
410 | fputs_(string, doc->file); |
396 | fputs_(string, doc->file); |
411 | // magnetic inclination & error |
397 | // magnetic inclination & error |