Rev 482 | Rev 486 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 482 | Rev 483 | ||
|---|---|---|---|
| Line 271... | Line 271... | ||
| 271 | } |
271 | } |
| 272 | } |
272 | } |
| 273 | return(retvalue); |
273 | return(retvalue); |
| 274 | } |
274 | } |
| Line -... | Line 275... | ||
| - | 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 | ||
| 275 | 289 | ||
| 276 | //________________________________________________________________________________________________________________________________________ |
290 | //________________________________________________________________________________________________________________________________________ |
| 277 | // Function: u8 GPX_TrackSegementAddPoint(GPS_Pos_t * pGPS_Position ,GPX_Document_t *doc); |
291 | // Function: u8 GPX_TrackSegementAddPoint(GPS_Pos_t * pGPS_Position ,GPX_Document_t *doc); |
| 278 | // |
292 | // |
| 279 | // Description: This function adds a pointof a track segement to the specified document. |
293 | // Description: This function adds a pointof a track segement to the specified document. |
| Line 387... | Line 401... | ||
| 387 | sprintf(string, "<RCRSSI>%d</RCRSSI>\r\n", FC.RC_RSSI); |
401 | sprintf(string, "<RCRSSI>%d</RCRSSI>\r\n", FC.RC_RSSI); |
| 388 | fputs_(string, doc->file); |
402 | fputs_(string, doc->file); |
| 389 | } |
403 | } |
| 390 | */ // Compassind deg |
404 | */ // Compassind deg |
| 391 | i16_1 = FromFlightCtrl.GyroHeading / 10; |
405 | i16_1 = FromFlightCtrl.GyroHeading / 10; |
| 392 | sprintf(string, "<Compass>%03d,%03d,%03d</Compass>\r\n", i16_1,ToFlightCtrl.CompassHeading,GyroCompassCorrected/10); |
406 | sprintf(string, "<Compass>%03d,%03d,%03d</Compass>\r\n", i16_1,ToFlightCtrl.CompassHeading, GyroCompassCorrected/10); |
| 393 | fputs_(string, doc->file); |
407 | fputs_(string, doc->file); |
| 394 | // magnetic field |
408 | // magnetic field |
| 395 | sprintf(string, "<MagnetField>%03d</MagnetField>\r\n",(u16) (EarthMagneticFieldFiltered/5)); |
409 | sprintf(string, "<MagnetField>%03d</MagnetField>\r\n",(u16) (EarthMagneticFieldFiltered/5)); |
| 396 | fputs_(string, doc->file); |
410 | fputs_(string, doc->file); |
| 397 | // magnetic inclination & error |
411 | // magnetic inclination & error |