Subversion Repositories Projects

Rev

Rev 2039 | Rev 2225 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2039 Rev 2041
Line 366... Line 366...
366
                //debugData = *((str_DebugOut*)pRxData);
366
                //debugData = *((str_DebugOut*)pRxData);
367
                                memcpy((char*)(&debugData), (char*)pRxData, sizeof(str_DebugOut));
367
                                memcpy((char*)(&debugData), (char*)pRxData, sizeof(str_DebugOut));
368
                                rxd_buffer_locked = 0;
368
                                rxd_buffer_locked = 0;
Line 369... Line 369...
369
 
369
 
370
                // init on first data retrival, distinguished by last battery :)
370
                // init on first data retrival, distinguished by last battery :)
371
                if (last_UBat == 255) {
371
                if (!(COSD_FLAGS_RUNTIME & COSD_OSD_STARTED)) {
372
                    if (debugData.Analog[9] > 40) {
372
                    if (debugData.Analog[9] > 40) {
373
                        // fix for min_UBat
373
                        // fix for min_UBat
374
                        min_UBat = debugData.Analog[9];
374
                        min_UBat = debugData.Analog[9];
375
                        last_UBat = debugData.Analog[9];
375
                        last_UBat = debugData.Analog[9];
-
 
376
                        init_cosd(last_UBat);
376
                        init_cosd(last_UBat);
377
                                                COSD_FLAGS_RUNTIME |= COSD_OSD_STARTED;
377
                    }
378
                    }
378
                } else {
379
                } else {
379
                    osd_fcmode();
380
                    osd_fcmode();
380
                }
381
                }
Line 394... Line 395...
394
                naviData.AngleRoll = (int8_t)(((int16_t)naviData.AngleRoll - (int16_t)naviData.AngleNick) / 2);
395
                naviData.AngleRoll = (int8_t)(((int16_t)naviData.AngleRoll - (int16_t)naviData.AngleNick) / 2);
395
                naviData.CompassHeading = (naviData.CompassHeading + (360 - 45)) % 360;
396
                naviData.CompassHeading = (naviData.CompassHeading + (360 - 45)) % 360;
396
                #endif
397
                #endif
Line 397... Line 398...
397
 
398
 
398
                // init on first data retrival, distinguished by last battery :)
399
                // init on first data retrival, distinguished by last battery :)
399
                if (last_UBat == 255) {
400
                                if (!(COSD_FLAGS_RUNTIME & COSD_OSD_STARTED)) {
400
                    if (naviData.UBat > 40) {
401
                    if (naviData.UBat > 40) {
401
                        // fix for min_UBat
402
                        // fix for min_UBat
402
                        min_UBat = naviData.UBat;
403
                        min_UBat = naviData.UBat;
403
                        last_UBat = naviData.UBat;
404
                        last_UBat = naviData.UBat;
-
 
405
                        init_cosd(last_UBat);
404
                        init_cosd(last_UBat);
406
                                                COSD_FLAGS_RUNTIME |= COSD_OSD_STARTED;
405
                    }
407
                    }
406
                } else {
408
                } else {
407
                    osd_ncmode();
409
                    osd_ncmode();
408
                }
410
                }