Rev 736 | Rev 757 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 736 | Rev 753 | ||
|---|---|---|---|
| 1 | /**************************************************************************** |
1 | /**************************************************************************** |
| 2 | * Copyright (C) 2009-2010 by Claas Anders "CaScAdE" Rathje * |
2 | * Copyright (C) 2009-2010 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 * |
| 8 | * the Free Software Foundation; either version 2 of the License. * |
8 | * the Free Software Foundation; either version 2 of the License. * |
| 9 | * * |
9 | * * |
| 10 | * This program is distributed in the hope that it will be useful, * |
10 | * This program is distributed in the hope that it will be useful, * |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of * |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of * |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * |
| 13 | * GNU General Public License for more details. * |
13 | * GNU General Public License for more details. * |
| 14 | * * |
14 | * * |
| 15 | * You should have received a copy of the GNU General Public License * |
15 | * You should have received a copy of the GNU General Public License * |
| 16 | * along with this program; if not, write to the * |
16 | * along with this program; if not, write to the * |
| 17 | * Free Software Foundation, Inc., * |
17 | * Free Software Foundation, Inc., * |
| 18 | * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * |
18 | * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * |
| 19 | ****************************************************************************/ |
19 | ****************************************************************************/ |
| 20 | 20 | ||
| 21 | #include <avr/pgmspace.h> |
21 | #include <avr/pgmspace.h> |
| 22 | #include "mk-data-structs.h" |
22 | #include "mk-data-structs.h" |
| 23 | 23 | ||
| 24 | /* ########################################################################## |
24 | /* ########################################################################## |
| 25 | * Debugging and general purpose definitions |
25 | * Debugging and general purpose definitions |
| 26 | * ##########################################################################*/ |
26 | * ##########################################################################*/ |
| 27 | #ifndef BUILDDATE |
27 | #ifndef BUILDDATE |
| 28 | #define BUILDDATE "DEVEL-BUILD" // build date, this is testing... |
28 | #define BUILDDATE "DEVEL-BUILD" // build date, this is testing... |
| 29 | #endif |
29 | #endif |
| 30 | 30 | ||
| 31 | #define ALLCHARSDEBUG 0 // set to 1 and flash firmware to see all chars |
31 | #define ALLCHARSDEBUG 0 // set to 1 and flash firmware to see all chars |
| 32 | 32 | ||
| 33 | #ifndef WRITECHARS // if WRITECHARS not set via makefile |
33 | #ifndef WRITECHARS // if WRITECHARS not set via makefile |
| 34 | #define WRITECHARS -1 // set to 1 and flash firmware to write all chars |
34 | #define WRITECHARS -1 // set to 1 and flash firmware to write all chars |
| 35 | #endif |
35 | #endif |
| 36 | 36 | ||
| 37 | #ifndef NTSC // if NTSC is not thet via makefile |
37 | #ifndef NTSC // if NTSC is not thet via makefile |
| 38 | #define NTSC 0 // set to 1 for NTSC mode + lifts the bottom line |
38 | #define NTSC 0 // set to 1 for NTSC mode + lifts the bottom line |
| 39 | #endif |
39 | #endif |
| 40 | 40 | ||
| 41 | #ifndef FCONLY |
41 | #ifndef FCONLY |
| 42 | #define FCONLY 0 // set to 1 if you do NOT have a NaviCtrl and the OSD is |
42 | #define FCONLY 0 // set to 1 if you do NOT have a NaviCtrl and the OSD is |
| 43 | #endif // connected to the FC directly |
43 | #endif // connected to the FC directly |
| - | 44 | ||
| - | 45 | #define NEW_ARTHORIZON 0 // set to 1 for full artificial horizon (agr type) |
|
| 44 | 46 | ||
| 45 | #define HUD 1 // set to 0 to disable HUD by default |
47 | #define HUD 1 // set to 0 to disable HUD by default |
| 46 | #define ARTHORIZON 0 // set to 1 to enable roll&nick artificial horizon by default |
48 | #define ARTHORIZON 0 // set to 1 to enable roll&nick artificial horizon by default |
| 47 | #define BIGVARIO 0 // set to 1 to enable the big vario bar on right side |
49 | #define BIGVARIO 0 // set to 1 to enable the big vario bar on right side |
| 48 | #define STATS 1 // set to 1 to enable statistics during motor off by default |
50 | #define STATS 1 // set to 1 to enable statistics during motor off by default |
| 49 | #define WARNINGS 1 // set to 1 to display battery+rc warning even if HUD is disabled |
51 | #define WARNINGS 1 // set to 1 to display battery+rc warning even if HUD is disabled |
| 50 | 52 | ||
| 51 | //#define UBAT_WRN 94 // voltage for blinking warning, like FC settings (deprecated) |
53 | //#define UBAT_WRN 94 // voltage for blinking warning, like FC settings (deprecated) |
| 52 | //#define UBAT_MAX 114 // maximal battery voltage for battery-sign (deprecated) |
54 | //#define UBAT_MAX 114 // maximal battery voltage for battery-sign (deprecated) |
| 53 | #define CELL_VOLT_MAX 37 // max voltage per battery cell (37 for LiPo) |
55 | #define CELL_VOLT_MAX 37 // max voltage per battery cell (37 for LiPo) |
| 54 | #define CELL_VOLT_MIN 32 // min voltage per battery cell (maybe 32 for LiPo?) |
56 | #define CELL_VOLT_MIN 32 // min voltage per battery cell (maybe 32 for LiPo?) |
| 55 | #define CELL_NUM -1 // -1 for auto, 3 for 3s1p and 4 for 4s1p |
57 | #define CELL_NUM -1 // -1 for auto, 3 for 3s1p and 4 for 4s1p |
| 56 | #define RCLVL_WRN 100 // make the RC level blink if below this number |
58 | #define RCLVL_WRN 100 // make the RC level blink if below this number |
| 57 | 59 | ||
| 58 | // ### read datasheet before changing stuff below this line :) |
60 | // ### read datasheet before changing stuff below this line :) |
| 59 | #define BLINK 0b01001111 // attribute byte for blinking characters |
61 | #define BLINK 0b01001111 // attribute byte for blinking characters |
| 60 | #define INVERT 0b00101111 // attribute byte for inverted characters |
62 | #define INVERT 0b00101111 // attribute byte for inverted characters |
| 61 | #define BLACKBG 0b10001111 // attribute byte for _black background_ on characters |
63 | #define BLACKBG 0b10001111 // attribute byte for _black background_ on characters |
| 62 | 64 | ||
| 63 | /* ########################################################################## |
65 | /* ########################################################################## |
| 64 | * FLAGS usable during runtime that get saved |
66 | * FLAGS usable during runtime that get saved |
| 65 | * ##########################################################################*/ |
67 | * ##########################################################################*/ |
| 66 | #define COSD_FLAG_HUD 1 |
68 | #define COSD_FLAG_HUD 1 |
| 67 | #define COSD_FLAG_ARTHORIZON 2 |
69 | #define COSD_FLAG_ARTHORIZON 2 |
| 68 | #define COSD_FLAG_BIGVARIO 4 |
70 | #define COSD_FLAG_BIGVARIO 4 |
| 69 | #define COSD_FLAG_STATS 8 |
71 | #define COSD_FLAG_STATS 8 |
| 70 | #define COSD_FLAG_WARNINGS 16 |
72 | #define COSD_FLAG_WARNINGS 16 |
| 71 | #define COSD_FLAG_STROMVOLT 32 |
73 | #define COSD_FLAG_STROMVOLT 32 |
| 72 | #define COSD_FLAG_FCCURRENT 64 |
74 | #define COSD_FLAG_FCCURRENT 64 |
| 73 | 75 | ||
| 74 | 76 | ||
| 75 | #define COSD_FLAG_NTSC 1 |
77 | #define COSD_FLAG_NTSC 1 |
| 76 | #define COSD_FLAG_GPSHEIGHT 2 |
78 | #define COSD_FLAG_GPSHEIGHT 2 |
| 77 | #define COSD_FLAG_FCMODE 4 |
79 | #define COSD_FLAG_FCMODE 4 |
| 78 | 80 | ||
| 79 | /* ########################################################################## |
81 | /* ########################################################################## |
| 80 | * FLAGS only usable during runtime (not saved) |
82 | * FLAGS only usable during runtime (not saved) |
| 81 | * ##########################################################################*/ |
83 | * ##########################################################################*/ |
| 82 | #define COSD_FLAG_STROMREC 1 |
84 | #define COSD_FLAG_STROMREC 1 |
| 83 | #define COSD_ICONS_WRITTEN 2 |
85 | #define COSD_ICONS_WRITTEN 2 |
| 84 | #define COSD_WASFLYING 4 |
86 | #define COSD_WASFLYING 4 |
| 85 | 87 | ||
| 86 | /* ########################################################################## |
88 | /* ########################################################################## |
| 87 | * LED controll |
89 | * LED controll |
| 88 | * ##########################################################################*/ |
90 | * ##########################################################################*/ |
| 89 | #define LED1_ON PORTC |= (1 << PC0); |
91 | #define LED1_ON PORTC |= (1 << PC0); |
| 90 | #define LED1_OFF PORTC &= ~(1 << PC0); |
92 | #define LED1_OFF PORTC &= ~(1 << PC0); |
| 91 | #define LED2_ON PORTC |= (1 << PC1); |
93 | #define LED2_ON PORTC |= (1 << PC1); |
| 92 | #define LED2_OFF PORTC &= ~(1 << PC1); |
94 | #define LED2_OFF PORTC &= ~(1 << PC1); |
| 93 | #define LED3_ON PORTC |= (1 << PC2); |
95 | #define LED3_ON PORTC |= (1 << PC2); |
| 94 | #define LED3_OFF PORTC &= ~(1 << PC2); |
96 | #define LED3_OFF PORTC &= ~(1 << PC2); |
| 95 | #define LED4_ON PORTC |= (1 << PC3); |
97 | #define LED4_ON PORTC |= (1 << PC3); |
| 96 | #define LED4_OFF PORTC &= ~(1 << PC3); |
98 | #define LED4_OFF PORTC &= ~(1 << PC3); |
| 97 | 99 | ||
| 98 | /* ########################################################################## |
100 | /* ########################################################################## |
| 99 | * switch controll |
101 | * switch controll |
| 100 | * ##########################################################################*/ |
102 | * ##########################################################################*/ |
| 101 | #define S1_PRESSED !(PINC & (1<<PC5)) |
103 | #define S1_PRESSED !(PINC & (1<<PC5)) |
| 102 | #define S2_PRESSED !(PINC & (1<<PC4)) |
104 | #define S2_PRESSED !(PINC & (1<<PC4)) |
| 103 | 105 | ||
| 104 | /* ########################################################################## |
106 | /* ########################################################################## |
| 105 | * extern spi controlled vars |
107 | * extern spi controlled vars |
| 106 | * ##########################################################################*/ |
108 | * ##########################################################################*/ |
| 107 | extern volatile uint16_t icnt; |
109 | extern volatile uint16_t icnt; |
| 108 | extern volatile unsigned char * iptr; |
110 | extern volatile unsigned char * iptr; |
| 109 | extern volatile uint8_t spi_cmd_buffer[]; |
111 | extern volatile uint8_t spi_cmd_buffer[]; |
| 110 | extern volatile uint8_t spi_ready; |
112 | extern volatile uint8_t spi_ready; |
| 111 | extern int16_t ampere, max_ampere, s_volt; |
113 | extern int16_t ampere, max_ampere, s_volt; |
| 112 | extern int32_t ampere_wasted; |
114 | extern int32_t ampere_wasted; |
| 113 | 115 | ||
| 114 | /* ########################################################################## |
116 | /* ########################################################################## |
| 115 | * struct for displaymodes |
117 | * struct for displaymodes |
| 116 | * ##########################################################################*/ |
118 | * ##########################################################################*/ |
| 117 | typedef struct { |
119 | typedef struct { |
| 118 | int (*dfun)(void); // function pointer |
120 | int (*dfun)(void); // function pointer |
| 119 | char *desc; // description text |
121 | char *desc; // description text |
| 120 | } displaymode_t; |
122 | } displaymode_t; |
| 121 | 123 | ||
| 122 | const displaymode_t ncdisplaymodes[2]; |
124 | const displaymode_t ncdisplaymodes[2]; |
| 123 | const displaymode_t fcdisplaymodes[2]; |
125 | const displaymode_t fcdisplaymodes[2]; |
| 124 | 126 | ||
| 125 | int (*osd_ncmode)(void); |
127 | int (*osd_ncmode)(void); |
| 126 | int (*osd_fcmode)(void); |
128 | int (*osd_fcmode)(void); |
| 127 | 129 | ||
| 128 | /* ########################################################################## |
130 | /* ########################################################################## |
| 129 | * vars used by other parts as well |
131 | * vars used by other parts as well |
| 130 | * ##########################################################################*/ |
132 | * ##########################################################################*/ |
| 131 | volatile uint16_t setsReceived; |
133 | volatile uint16_t setsReceived; |
| 132 | 134 | ||
| 133 | volatile NaviData_t naviData; |
135 | volatile NaviData_t naviData; |
| 134 | volatile DebugOut_t debugData; |
136 | volatile DebugOut_t debugData; |
| 135 | 137 | ||
| 136 | // cache old vars for blinking attribute, checkup is faster than full |
138 | // cache old vars for blinking attribute, checkup is faster than full |
| 137 | // attribute write each time |
139 | // attribute write each time |
| 138 | volatile uint8_t last_UBat; |
140 | volatile uint8_t last_UBat; |
| 139 | volatile uint8_t last_RC_Quality; |
141 | volatile uint8_t last_RC_Quality; |
| 140 | 142 | ||
| 141 | // 16bit should be enough, normal LiPos don't last that long |
143 | // 16bit should be enough, normal LiPos don't last that long |
| 142 | volatile uint16_t uptime; |
144 | volatile uint16_t uptime; |
| 143 | volatile uint16_t timer; |
145 | volatile uint16_t timer; |
| 144 | volatile uint16_t flytime_fc; |
146 | volatile uint16_t flytime_fc; |
| 145 | volatile uint16_t wasted_ampere_offset; |
147 | volatile uint16_t wasted_ampere_offset; |
| 146 | 148 | ||
| 147 | // remember last time data was received |
149 | // remember last time data was received |
| 148 | volatile uint8_t seconds_since_last_data; |
150 | volatile uint8_t seconds_since_last_data; |
| 149 | 151 | ||
| 150 | // general PAL|NTSC distingiusch stuff |
152 | // general PAL|NTSC distingiusch stuff |
| 151 | uint8_t top_line; |
153 | uint8_t top_line; |
| 152 | uint8_t bottom_line; |
154 | uint8_t bottom_line; |
| 153 | 155 | ||
| 154 | // battery voltages |
156 | // battery voltages |
| 155 | uint8_t min_voltage; |
157 | uint8_t min_voltage; |
| 156 | uint8_t max_voltage; |
158 | uint8_t max_voltage; |
| 157 | 159 | ||
| 158 | // Flags |
160 | // Flags |
| 159 | uint8_t COSD_FLAGS_MODES, COSD_FLAGS_CONFIG, COSD_FLAGS_RUNTIME, COSD_DISPLAYMODE; |
161 | uint8_t COSD_FLAGS_MODES, COSD_FLAGS_CONFIG, COSD_FLAGS_RUNTIME, COSD_DISPLAYMODE; |
| 160 | 162 | ||
| 161 | // stats for after flight |
163 | // stats for after flight |
| 162 | int16_t max_Altimeter, altimeter_offset; |
164 | int16_t max_Altimeter, altimeter_offset; |
| 163 | uint8_t min_UBat; |
165 | uint8_t min_UBat; |
| 164 | 166 | ||
| 165 | uint16_t max_GroundSpeed; |
167 | uint16_t max_GroundSpeed; |
| 166 | int16_t max_Distance; |
168 | int16_t max_Distance; |
| 167 | uint16_t max_FlyingTime; |
169 | uint16_t max_FlyingTime; |
| 168 | 170 | ||
| 169 | // flags from last round to check for changes |
171 | // flags from last round to check for changes |
| 170 | uint8_t old_MKFlags; |
172 | uint8_t old_MKFlags; |
| 171 | 173 | ||
| 172 | const char *directions[8]; |
174 | const char *directions[8]; |
| 173 | const char *stats_item_pointers[8]; |
175 | const char *stats_item_pointers[8]; |
| 174 | 176 | ||