Subversion Repositories Projects

Rev

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

Rev 753 Rev 761
Line 24... Line 24...
24 
#include "osd_ncmode_default.h"
 24 
#include "osd_ncmode_default.h"
Line 25... Line 25...
25 
 
 25 
 
Line 26... Line 26...
26 
#if !(ALLCHARSDEBUG|(WRITECHARS != -1))
 26 
#if !(ALLCHARSDEBUG|(WRITECHARS != -1))
27 
 
 - 
 
28 
int osd_ncmode_minimal() {
 - 
 
29 
 
 - 
 
30 
        if (COSD_FLAGS_MODES & COSD_FLAG_HUD) {
 - 
 
31 
                // write icons at init or after menu/mode-switch
 - 
 
32 
                if (!(COSD_FLAGS_RUNTIME & COSD_ICONS_WRITTEN)) {
 - 
 
33 
                        write_char_xy(4, top_line, 0xCB); // km/h
 - 
 
34 
                        write_char_xy(15, top_line, 0xCC); // small meters m height
 - 
 
35 
                        write_char_xy(26, top_line, 0xCC); // small meters m height
 - 
 
36 
                        write_char_xy(16, top_line, 0xB0); // left circle
 - 
 
37 
                        write_char_xy(18, top_line, 0xB2); // right circle
 - 
 
38 
                        write_char_xy(7, bottom_line, 0x9E); // small V
 - 
 
39 
                        write_char_xy(17, bottom_line, 0xD2); // fly clock
 - 
 
40 
                        write_char_xy(26, bottom_line, 0xC8); // sat1
 - 
 
41 
                        write_char_xy(27, bottom_line, 0xC9); // sat2
 - 
 
42 
                        COSD_FLAGS_RUNTIME |= COSD_ICONS_WRITTEN;
 - 
 
43 
                }
 - 
 
44 
 
 - 
 
45 
                // first line
 - 
 
46 
                write_ndigit_number_u(1, top_line, (uint16_t) (((uint32_t) naviData.GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 3, 0);
 - 
 
47 
 
 - 
 
48 
                write_ndigit_number_u(12, top_line, naviData.HomePositionDeviation.Distance / 10, 3, 0);
 - 
 
49 
 
 - 
 
50 
                uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
 - 
 
51 
                write_char_xy(17, top_line, 0xa0 + heading_fine_conv(heading_home));
 - 
 
52 
 
 - 
 
53 
                if (naviData.Altimeter > 300 || naviData.Altimeter < -300) {
 - 
 
54 
                        // above 10m only write full meters
 - 
 
55 
                        write_ndigit_number_s(22, top_line, naviData.Altimeter / 30, 4, 0);
 - 
 
56 
                } else {
 - 
 
57 
                        // up to 10m write meters.dm
 - 
 
58 
                        write_ndigit_number_s_10th(22, top_line, naviData.Altimeter / 3, 3, 0);
 - 
 
59 
                }
 - 
 
60 
 
 - 
 
61 
                draw_variometer(27, top_line, naviData.Variometer);
 - 
 
62 
 
 - 
 
63 
 
 - 
 
64 
                // center
 - 
 
65 
                if (naviData.FCFlags & FLAG_MOTOR_RUN) { // should be engines running
 - 
 
66 
                    if (!(old_MKFlags & FLAG_MOTOR_RUN)) { // motors just started, clear middle
 - 
 
67 
                        clear();
 - 
 
68 
                        // update flags to paint display again if needed
 - 
 
69 
                        COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN;
 - 
 
70 
                    }
 - 
 
71 
                    if (COSD_FLAGS_MODES & COSD_FLAG_ARTHORIZON) {
 - 
 
72 
                                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
 - 
 
73 
                                draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
 - 
 
74 
                                } else {
 - 
 
75 
                                draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
 - 
 
76 
                                }
 - 
 
77 
                    }
 - 
 
78 
                    // motors are on, assume we were/are flying
 - 
 
79 
                    COSD_FLAGS_RUNTIME |= COSD_WASFLYING;
 - 
 
80 
                } else {
 - 
 
81 
                    // stats
 - 
 
82 
                    if ((COSD_FLAGS_RUNTIME & COSD_WASFLYING) && (COSD_FLAGS_MODES & COSD_FLAG_STATS)) {
 - 
 
83 
                                uint8_t line = 3;
 - 
 
84 
                        write_ascii_string_pgm(2, line, (const char *) (pgm_read_word(&(stats_item_pointers[0])))); // max Altitude
 - 
 
85 
                        write_ndigit_number_s(18, line, max_Altimeter / 30, 4, 0);
 - 
 
86 
                        write_char_xy(22, line, 204); // small meters m
 - 
 
87 
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[1])))); // max Speed
 - 
 
88 
                        write_ndigit_number_u(19, line, (uint16_t) (((uint32_t) max_GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 3, 0);
 - 
 
89 
                        write_char_xy(22, line, 203); // km/h
 - 
 
90 
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[2])))); // max Distance
 - 
 
91 
                        write_ndigit_number_u(19, line, max_Distance / 10, 3, 0);
 - 
 
92 
                        write_char_xy(22, line, 204); // small meters m
 - 
 
93 
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[3])))); // min voltage
 - 
 
94 
                        write_ndigit_number_u_10th(18, line, min_UBat, 3, 0);
 - 
 
95 
                        write_char_xy(22, line, 0x9E); // small V
 - 
 
96 
                                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
 - 
 
97 
                                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[7])))); // ampere
 - 
 
98 
                                        write_ndigit_number_u_10th(18, line, max_ampere / 10, 3, 0);
 - 
 
99 
                                        write_char_xy(22, line, 0x9F); // small A
 - 
 
100 
                                }
 - 
 
101 
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[4])))); // max time
 - 
 
102 
                        write_time(16, line, max_FlyingTime);
 - 
 
103 
                        write_char_xy(22, line, 210); // fly clock
 - 
 
104 
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[5])))); // longitude
 - 
 
105 
                        write_gps_pos(15, line, naviData.CurrentPosition.Longitude);
 - 
 
106 
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[6])))); // latitude
 - 
 
107 
                        write_gps_pos(15, line, naviData.CurrentPosition.Latitude);
 - 
 
108 
                    } else if (COSD_FLAGS_MODES & COSD_FLAG_ARTHORIZON) { // if no stats there is space horizon
 - 
 
109 
                                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
 - 
 
110 
                                draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
 - 
 
111 
                                } else {
 - 
 
112 
                                draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
 - 
 
113 
                                }
 - 
 
114 
                    }
 - 
 
115 
                }
 - 
 
116 
                if (COSD_FLAGS_MODES & COSD_FLAG_BIGVARIO) {
 - 
 
117 
                    draw_big_variometer(27, 8, naviData.Variometer);
 - 
 
118 
                }
 - 
 
119 
 
 - 
 
120 
                // pre-bottom line
 - 
 
121 
                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
 - 
 
122 
                        //write_ndigit_number_s(3, bottom_line - 1, ampere, 4, 0);
 - 
 
123 
                        write_ndigit_number_u_10th(3, bottom_line - 1, ampere / 10, 3, 0);
 - 
 
124 
                        write_ndigit_number_s(10, bottom_line - 1, ampere_wasted / 10, 4, 0);
 - 
 
125 
                }
 - 
 
126 
 
 - 
 
127 
                // bottom line
 - 
 
128 
                draw_battery(2, bottom_line, min_voltage, naviData.UBat, max_voltage);
 - 
 
129 
                write_ndigit_number_u_10th(3, bottom_line, naviData.UBat, 3, 0);
 - 
 
130 
                if (naviData.UBat <= min_voltage && last_UBat > min_voltage) {
 - 
 
131 
                    for (uint8_t x = 2; x < 8; x++)
 - 
 
132 
                        write_char_att_xy(x, bottom_line, BLINK);
 - 
 
133 
                } else if (naviData.UBat > min_voltage && last_UBat < min_voltage) {
 - 
 
134 
                    for (uint8_t x = 2; x < 8; x++)
 - 
 
135 
                        write_char_att_xy(x, bottom_line, 0);
 - 
 
136 
                }
 - 
 
137 
 
 - 
 
138 
                write_time(11, bottom_line, naviData.FlyingTime);
 - 
 
139 
 
 - 
 
140 
                write_ndigit_number_u(24, bottom_line, naviData.SatsInUse, 2, 0);
 - 
 
141 
 
 - 
 
142 
                if (naviData.NCFlags & NC_FLAG_CH) {
 - 
 
143 
                    write_char_xy(27, bottom_line, 231); // gps ch
 - 
 
144 
                } else if (naviData.NCFlags & NC_FLAG_PH) {
 - 
 
145 
                    write_char_xy(27, bottom_line, 230); // gps ph
 - 
 
146 
                } else { // (naviData.NCFlags & NC_FLAG_FREE)
 - 
 
147 
                    write_char_xy(27, bottom_line, 201); // sat2 (free)
 - 
 
148 
                }
 - 
 
149 
        }
 - 
 
150 
 
 - 
 
151 
        // remember statistics (only when engines running)
 - 
 
152 
        if (naviData.FCFlags & FLAG_MOTOR_RUN) {
 - 
 
153 
            if (naviData.Altimeter > max_Altimeter) max_Altimeter = naviData.Altimeter;
 - 
 
154 
            if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
 - 
 
155 
            if (naviData.HomePositionDeviation.Distance > max_Distance) {
 - 
 
156 
                max_Distance = naviData.HomePositionDeviation.Distance;
 - 
 
157 
            }
 - 
 
158 
            if (naviData.UBat < min_UBat) min_UBat = naviData.UBat;
 - 
 
159 
            if (naviData.FlyingTime > max_FlyingTime) max_FlyingTime = naviData.FlyingTime;
 - 
 
160 
                if (ampere > max_ampere) max_ampere = ampere;
 - 
 
161 
        }
 - 
 
162 
 
 - 
 
163 
        // remember last values
 - 
 
164 
        last_UBat = naviData.UBat;
 - 
 
Line -... Line 27...
- 
 
 27 
 
- 
 
 28 
int osd_ncmode_minimal() {
- 
 
 29 
 
- 
 
 30 
    if (COSD_FLAGS_MODES & COSD_FLAG_HUD) {
- 
 
 31 
        // write icons at init or after menu/mode-switch
- 
 
 32 
        if (!(COSD_FLAGS_RUNTIME & COSD_ICONS_WRITTEN)) {
- 
 
 33 
            write_char_xy(4, top_line, 0xCB); // km/h
- 
 
 34 
            write_char_xy(15, top_line, 0xCC); // small meters m height
- 
 
 35 
            write_char_xy(26, top_line, 0xCC); // small meters m height
- 
 
 36 
            write_char_xy(16, top_line, 0xB0); // left circle
- 
 
 37 
            write_char_xy(18, top_line, 0xB2); // right circle
- 
 
 38 
            write_char_xy(7, bottom_line, 0x9E); // small V
- 
 
 39 
            write_char_xy(17, bottom_line, 0xD2); // fly clock
- 
 
 40 
            write_char_xy(26, bottom_line, 0xC8); // sat1
- 
 
 41 
            write_char_xy(27, bottom_line, 0xC9); // sat2
- 
 
 42 
            COSD_FLAGS_RUNTIME |= COSD_ICONS_WRITTEN;
- 
 
 43 
        }
- 
 
 44 
 
- 
 
 45 
        // first line
- 
 
 46 
        write_ndigit_number_u(1, top_line, (uint16_t)(((uint32_t)naviData.GroundSpeed * (uint32_t)9) / (uint32_t)250), 3, 0);
- 
 
 47 
 
- 
 
 48 
        write_ndigit_number_u(12, top_line, naviData.HomePositionDeviation.Distance / 10, 3, 0);
- 
 
 49 
 
- 
 
 50 
        uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
- 
 
 51 
        write_char_xy(17, top_line, 0xa0 + heading_fine_conv(heading_home));
- 
 
 52 
 
- 
 
 53 
        if (naviData.Altimeter > 300 || naviData.Altimeter < -300) {
- 
 
 54 
            // above 10m only write full meters
- 
 
 55 
            write_ndigit_number_s(22, top_line, naviData.Altimeter / 30, 4, 0);
- 
 
 56 
        } else {
- 
 
 57 
            // up to 10m write meters.dm
- 
 
 58 
            write_ndigit_number_s_10th(22, top_line, naviData.Altimeter / 3, 3, 0);
- 
 
 59 
        }
- 
 
 60 
 
- 
 
 61 
        draw_variometer(27, top_line, naviData.Variometer);
- 
 
 62 
 
- 
 
 63 
 
- 
 
 64 
        // center
- 
 
 65 
        if (naviData.FCFlags & FLAG_MOTOR_RUN) { // should be engines running
- 
 
 66 
            if (!(old_MKFlags & FLAG_MOTOR_RUN)) { // motors just started, clear middle
- 
 
 67 
                clear();
- 
 
 68 
                // update flags to paint display again if needed
- 
 
 69 
                COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN;
- 
 
 70 
            }
- 
 
 71 
            if (COSD_FLAGS_MODES & COSD_FLAG_ARTHORIZON) {
- 
 
 72 
                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
- 
 
 73 
                    draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
- 
 
 74 
                } else {
- 
 
 75 
                    draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
- 
 
 76 
                }
- 
 
 77 
            }
- 
 
 78 
            // motors are on, assume we were/are flying
- 
 
 79 
            COSD_FLAGS_RUNTIME |= COSD_WASFLYING;
- 
 
 80 
        } else {
- 
 
 81 
            // stats
- 
 
 82 
            if ((COSD_FLAGS_RUNTIME & COSD_WASFLYING) && (COSD_FLAGS_MODES & COSD_FLAG_STATS)) {
- 
 
 83 
                uint8_t line = 3;
- 
 
 84 
                write_ascii_string_pgm(2, line, (const char *)(pgm_read_word(&(stats_item_pointers[0])))); // max Altitude
- 
 
 85 
                write_ndigit_number_s(18, line, max_Altimeter / 30, 4, 0);
- 
 
 86 
                write_char_xy(22, line, 204); // small meters m
- 
 
 87 
                write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[1])))); // max Speed
- 
 
 88 
                write_ndigit_number_u(19, line, (uint16_t)(((uint32_t)max_GroundSpeed * (uint32_t)9) / (uint32_t)250), 3, 0);
- 
 
 89 
                write_char_xy(22, line, 203); // km/h
- 
 
 90 
                write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[2])))); // max Distance
- 
 
 91 
                write_ndigit_number_u(19, line, max_Distance / 10, 3, 0);
- 
 
 92 
                write_char_xy(22, line, 204); // small meters m
- 
 
 93 
                write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[3])))); // min voltage
- 
 
 94 
                write_ndigit_number_u_10th(18, line, min_UBat, 3, 0);
- 
 
 95 
                write_char_xy(22, line, 0x9E); // small V
- 
 
 96 
                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
- 
 
 97 
                    write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[7])))); // ampere
- 
 
 98 
                    write_ndigit_number_u_10th(18, line, max_ampere / 10, 3, 0);
- 
 
 99 
                    write_char_xy(22, line, 0x9F); // small A
- 
 
 100 
                }
- 
 
 101 
                write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[4])))); // max time
- 
 
 102 
                write_time(16, line, max_FlyingTime);
- 
 
 103 
                write_char_xy(22, line, 210); // fly clock
- 
 
 104 
                write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[5])))); // longitude
- 
 
 105 
                write_gps_pos(15, line, naviData.CurrentPosition.Longitude);
- 
 
 106 
                write_ascii_string_pgm(2, ++line, (const char *)(pgm_read_word(&(stats_item_pointers[6])))); // latitude
- 
 
 107 
                write_gps_pos(15, line, naviData.CurrentPosition.Latitude);
- 
 
 108 
            } else if (COSD_FLAGS_MODES & COSD_FLAG_ARTHORIZON) { // if no stats there is space horizon
- 
 
 109 
                if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
- 
 
 110 
                    draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
- 
 
 111 
                } else {
- 
 
 112 
                    draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
- 
 
 113 
                }
- 
 
 114 
            }
- 
 
 115 
        }
- 
 
 116 
        if (COSD_FLAGS_MODES & COSD_FLAG_BIGVARIO) {
- 
 
 117 
            draw_big_variometer(27, 8, naviData.Variometer);
- 
 
 118 
        }
- 
 
 119 
 
- 
 
 120 
        // pre-bottom line
- 
 
 121 
        if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
- 
 
 122 
            //write_ndigit_number_s(3, bottom_line - 1, ampere, 4, 0);
- 
 
 123 
            write_ndigit_number_u_10th(3, bottom_line - 1, ampere / 10, 3, 0);
- 
 
 124 
            write_ndigit_number_s(10, bottom_line - 1, ampere_wasted / 10, 4, 0);
- 
 
 125 
        }
- 
 
 126 
 
- 
 
 127 
        // bottom line
- 
 
 128 
        draw_battery(2, bottom_line, min_voltage, naviData.UBat, max_voltage);
- 
 
 129 
        write_ndigit_number_u_10th(3, bottom_line, naviData.UBat, 3, 0);
- 
 
 130 
        if (naviData.UBat <= min_voltage && last_UBat > min_voltage) {
- 
 
 131 
            for (uint8_t x = 2; x < 8; x++)
- 
 
 132 
                write_char_att_xy(x, bottom_line, BLINK);
- 
 
 133 
        } else if (naviData.UBat > min_voltage && last_UBat < min_voltage) {
- 
 
 134 
            for (uint8_t x = 2; x < 8; x++)
- 
 
 135 
                write_char_att_xy(x, bottom_line, 0);
- 
 
 136 
        }
- 
 
 137 
 
- 
 
 138 
        write_time(11, bottom_line, naviData.FlyingTime);
- 
 
 139 
 
- 
 
 140 
        write_ndigit_number_u(24, bottom_line, naviData.SatsInUse, 2, 0);
- 
 
 141 
 
- 
 
 142 
        if (naviData.NCFlags & NC_FLAG_CH) {
- 
 
 143 
            write_char_xy(27, bottom_line, 231); // gps ch
- 
 
 144 
        } else if (naviData.NCFlags & NC_FLAG_PH) {
- 
 
 145 
            write_char_xy(27, bottom_line, 230); // gps ph
- 
 
 146 
        } else { // (naviData.NCFlags & NC_FLAG_FREE)
- 
 
 147 
            write_char_xy(27, bottom_line, 201); // sat2 (free)
- 
 
 148 
        }
- 
 
 149 
    }
- 
 
 150 
 
- 
 
 151 
    // remember statistics (only when engines running)
- 
 
 152 
    if (naviData.FCFlags & FLAG_MOTOR_RUN) {
- 
 
 153 
        if (naviData.Altimeter > max_Altimeter) max_Altimeter = naviData.Altimeter;
- 
 
 154 
        if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
- 
 
 155 
        if (naviData.HomePositionDeviation.Distance > max_Distance) {
- 
 
 156 
            max_Distance = naviData.HomePositionDeviation.Distance;
- 
 
 157 
        }
- 
 
 158 
        if (naviData.UBat < min_UBat) min_UBat = naviData.UBat;
- 
 
 159 
        if (naviData.FlyingTime > max_FlyingTime) max_FlyingTime = naviData.FlyingTime;
- 
 
 160 
        if (ampere > max_ampere) max_ampere = ampere;
- 
 
 161 
    }
- 
 
 162 
 
- 
 
 163 
    // remember last values
- 
 
 164 
    last_UBat = naviData.UBat;
165 
        old_MKFlags = naviData.FCFlags;
 165 
    old_MKFlags = naviData.FCFlags;
166 
        seconds_since_last_data = 0;
 166 
    seconds_since_last_data = 0;
Line 167... Line 167...
167 
 
 167