Subversion Repositories Projects

Rev

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

Rev 2099 Rev 2225
Line 1... Line 1...
1
/****************************************************************************
1
/****************************************************************************
2
 *   Copyright (C) 2009-2015 by Claas Anders "CaScAdE" Rathje               *
2
 *   Copyright (C) 2009-2016 by Claas Anders "CaScAdE" Rathje               *
3
 *   admiralcascade@gmail.com                                               *
3
 *   admiralcascade@gmail.com                                               *
4
 *   Project-URL: http://www.mylifesucks.de/oss/c-osd/                      *
4
 *   Project-URL: http://www.mylifesucks.de/oss/c-osd/                      *
5
 *                                                                          *
5
 *                                                                          *
6
 *   This program is free software; you can redistribute it and/or modify   *
6
 *   This program is free software; you can redistribute it and/or modify   *
7
 *   it under the terms of the GNU General Public License as published by   *
7
 *   it under the terms of the GNU General Public License as published by   *
Line 49... Line 49...
49
        write_ndigit_number_u(12, top_line, naviData.HomePositionDeviation.Distance / 10, 3, 0);
49
        write_ndigit_number_u(12, top_line, naviData.HomePositionDeviation.Distance / 10, 3, 0);
Line 50... Line 50...
50
 
50
 
51
        uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
51
        uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
Line 52... Line 52...
52
        write_char_xy(17, top_line, 0xa0 + heading_fine_conv(heading_home));
52
        write_char_xy(17, top_line, 0xa0 + heading_fine_conv(heading_home));
53
 
53
 
54
        if (naviData.Altimeter > 200 || naviData.Altimeter < -200) {
54
        if (naviData.Altimeter_5cm > 200 || naviData.Altimeter_5cm < -200) {
55
            // above 10m only write full meters
55
            // above 10m only write full meters
56
            write_ndigit_number_s(22, top_line, naviData.Altimeter / 20, 4, 0);
56
            write_ndigit_number_s(22, top_line, naviData.Altimeter_5cm / 20, 4, 0);
57
        } else {
57
        } else {
58
            // up to 10m write meters.dm
58
            // up to 10m write meters.dm
Line 59... Line 59...
59
            write_ndigit_number_s_10th(22, top_line, naviData.Altimeter / 2, 3, 0);
59
            write_ndigit_number_s_10th(22, top_line, naviData.Altimeter_5cm / 2, 3, 0);
Line 122... Line 122...
122
    // remember statistics (only when engines running)
122
    // remember statistics (only when engines running)
123
    if (naviData.FCStatusFlags & FCFLAG_MOTOR_RUN) {
123
    if (naviData.FCStatusFlags & FCFLAG_MOTOR_RUN) {
124
        if (COSD_FLAGS_CONFIG & COSD_FLAG_GPSHEIGHT) {
124
        if (COSD_FLAGS_CONFIG & COSD_FLAG_GPSHEIGHT) {
125
            if (naviData.CurrentPosition.Altitude / 1000 - altimeter_offset > max_Altimeter) max_Altimeter = naviData.CurrentPosition.Altitude / 1000;
125
            if (naviData.CurrentPosition.Altitude / 1000 - altimeter_offset > max_Altimeter) max_Altimeter = naviData.CurrentPosition.Altitude / 1000;
126
        } else {
126
        } else {
127
            if (naviData.Altimeter / 20 > max_Altimeter) max_Altimeter = naviData.Altimeter / 20;
127
            if (naviData.Altimeter_5cm / 20 > max_Altimeter) max_Altimeter = naviData.Altimeter_5cm / 20;
128
        }
128
        }
129
        if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
129
        if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
130
        if (naviData.HomePositionDeviation.Distance > max_Distance) {
130
        if (naviData.HomePositionDeviation.Distance > max_Distance) {
131
            max_Distance = naviData.HomePositionDeviation.Distance;
131
            max_Distance = naviData.HomePositionDeviation.Distance;
132
        }
132
        }