Subversion Repositories Projects

Rev

Rev 728 | Rev 736 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 728 Rev 734
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
 
44
 
45
#define HUD 1               // set to 0 to disable HUD by default
45
#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
46
#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
47
#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
48
#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
49
#define WARNINGS 1                      // set to 1 to display battery+rc warning even if HUD is disabled
50
 
50
 
51
//#define UBAT_WRN  94          // voltage for blinking warning, like FC settings (deprecated)
51
//#define UBAT_WRN  94          // voltage for blinking warning, like FC settings (deprecated)
52
//#define UBAT_MAX 114          // maximal battery voltage for battery-sign (deprecated)
52
//#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)
53
#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?)
54
#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
55
#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
56
#define RCLVL_WRN 100           // make the RC level blink if below this number
57
 
57
 
58
// ### read datasheet before changing stuff below this line :)
58
// ### read datasheet before changing stuff below this line :)
59
#define BLINK   0b01001111      // attribute byte for blinking chars
59
#define BLINK   0b01001111      // attribute byte for blinking chars
60
 
60
 
61
/* ##########################################################################
61
/* ##########################################################################
62
 * FLAGS usable during runtime that get saved
62
 * FLAGS usable during runtime that get saved
63
 * ##########################################################################*/
63
 * ##########################################################################*/
64
#define COSD_FLAG_HUD                     1
64
#define COSD_FLAG_HUD                     1
65
#define COSD_FLAG_ARTHORIZON      2
65
#define COSD_FLAG_ARTHORIZON      2
66
#define COSD_FLAG_BIGVARIO                4
66
#define COSD_FLAG_BIGVARIO                4
67
#define COSD_FLAG_STATS                   8
67
#define COSD_FLAG_STATS                   8
68
#define COSD_FLAG_WARNINGS               16
68
#define COSD_FLAG_WARNINGS               16
69
#define COSD_FLAG_STROMVOLT              32
69
#define COSD_FLAG_STROMVOLT              32
70
#define COSD_FLAG_FCCURRENT              64
70
#define COSD_FLAG_FCCURRENT              64
71
 
71
 
72
 
72
 
73
#define COSD_FLAG_NTSC                    1
73
#define COSD_FLAG_NTSC                    1
74
#define COSD_FLAG_GPSHEIGHT               2
74
#define COSD_FLAG_GPSHEIGHT               2
75
#define COSD_FLAG_FCMODE                  4
75
#define COSD_FLAG_FCMODE                  4
76
 
76
 
77
/* ##########################################################################
77
/* ##########################################################################
78
 * FLAGS only usable during runtime (not saved)
78
 * FLAGS only usable during runtime (not saved)
79
 * ##########################################################################*/
79
 * ##########################################################################*/
80
#define COSD_FLAG_STROMREC                1
80
#define COSD_FLAG_STROMREC                1
81
#define COSD_ICONS_WRITTEN                2
81
#define COSD_ICONS_WRITTEN                2
82
#define COSD_WASFLYING                    4
82
#define COSD_WASFLYING                    4
83
 
83
 
84
/* ##########################################################################
84
/* ##########################################################################
85
 * LED controll
85
 * LED controll
86
 * ##########################################################################*/
86
 * ##########################################################################*/
87
#define LED1_ON                 PORTC |=  (1 << PC0);
87
#define LED1_ON                 PORTC |=  (1 << PC0);
88
#define LED1_OFF                PORTC &= ~(1 << PC0);
88
#define LED1_OFF                PORTC &= ~(1 << PC0);
89
#define LED2_ON                 PORTC |=  (1 << PC1);
89
#define LED2_ON                 PORTC |=  (1 << PC1);
90
#define LED2_OFF                PORTC &= ~(1 << PC1);
90
#define LED2_OFF                PORTC &= ~(1 << PC1);
91
#define LED3_ON                 PORTC |=  (1 << PC2);
91
#define LED3_ON                 PORTC |=  (1 << PC2);
92
#define LED3_OFF                PORTC &= ~(1 << PC2);
92
#define LED3_OFF                PORTC &= ~(1 << PC2);
93
#define LED4_ON                 PORTC |=  (1 << PC3);
93
#define LED4_ON                 PORTC |=  (1 << PC3);
94
#define LED4_OFF                PORTC &= ~(1 << PC3);
94
#define LED4_OFF                PORTC &= ~(1 << PC3);
95
 
95
 
96
/* ##########################################################################
96
/* ##########################################################################
97
 * switch controll
97
 * switch controll
98
 * ##########################################################################*/
98
 * ##########################################################################*/
99
#define S1_PRESSED              !(PINC & (1<<PC5))
99
#define S1_PRESSED              !(PINC & (1<<PC5))
100
#define S2_PRESSED              !(PINC & (1<<PC4))
100
#define S2_PRESSED              !(PINC & (1<<PC4))
101
 
101
 
102
/* ##########################################################################
102
/* ##########################################################################
103
 * extern spi controlled vars
103
 * extern spi controlled vars
104
 * ##########################################################################*/
104
 * ##########################################################################*/
105
extern volatile uint16_t icnt;
105
extern volatile uint16_t icnt;
106
extern volatile unsigned char * iptr;
106
extern volatile unsigned char * iptr;
107
extern volatile uint8_t spi_cmd_buffer[];
107
extern volatile uint8_t spi_cmd_buffer[];
108
extern volatile uint8_t spi_ready;
108
extern volatile uint8_t spi_ready;
109
extern int16_t ampere, max_ampere, s_volt;
109
extern int16_t ampere, max_ampere, s_volt;
110
extern int32_t ampere_wasted;
110
extern int32_t ampere_wasted;
111
 
111
 
112
/* ##########################################################################
112
/* ##########################################################################
113
 * struct for displaymodes
113
 * struct for displaymodes
114
 * ##########################################################################*/
114
 * ##########################################################################*/
115
typedef struct {
115
typedef struct {
116
   int (*dfun)(void);   // function pointer
116
   int (*dfun)(void);   // function pointer
117
   char *desc;                  // description text
117
   char *desc;                  // description text
118
} displaymode_t;
118
} displaymode_t;
119
 
119
 
120
const displaymode_t ncdisplaymodes[2];
120
const displaymode_t ncdisplaymodes[2];
121
const displaymode_t fcdisplaymodes[2];
121
const displaymode_t fcdisplaymodes[2];
122
 
122
 
123
int (*osd_ncmode)(void);
123
int (*osd_ncmode)(void);
124
int (*osd_fcmode)(void);
124
int (*osd_fcmode)(void);
125
 
125
 
126
/* ##########################################################################
126
/* ##########################################################################
127
 * vars used by other parts as well
127
 * vars used by other parts as well
128
 * ##########################################################################*/
128
 * ##########################################################################*/
129
volatile uint16_t setsReceived;
129
volatile uint16_t setsReceived;
130
 
130
 
131
volatile NaviData_t naviData;
131
volatile NaviData_t naviData;
132
volatile DebugOut_t debugData;
132
volatile DebugOut_t debugData;
133
 
133
 
134
// cache old vars for blinking attribute, checkup is faster than full
134
// cache old vars for blinking attribute, checkup is faster than full
135
// attribute write each time
135
// attribute write each time
136
volatile uint8_t last_UBat;
136
volatile uint8_t last_UBat;
137
volatile uint8_t last_RC_Quality;
137
volatile uint8_t last_RC_Quality;
138
 
138
 
139
// 16bit should be enough, normal LiPos don't last that long
139
// 16bit should be enough, normal LiPos don't last that long
140
volatile uint16_t uptime;
140
volatile uint16_t uptime;
141
volatile uint16_t timer;
141
volatile uint16_t timer;
142
volatile uint16_t flytime_fc;
142
volatile uint16_t flytime_fc;
-
 
143
volatile uint16_t wasted_ampere_offset;
143
 
144
 
144
// remember last time data was received
145
// remember last time data was received
145
volatile uint8_t seconds_since_last_data;
146
volatile uint8_t seconds_since_last_data;
146
 
147
 
147
// general PAL|NTSC distingiusch stuff
148
// general PAL|NTSC distingiusch stuff
148
uint8_t top_line;
149
uint8_t top_line;
149
uint8_t bottom_line;
150
uint8_t bottom_line;
150
 
151
 
151
// battery voltages
152
// battery voltages
152
uint8_t min_voltage;
153
uint8_t min_voltage;
153
uint8_t max_voltage;
154
uint8_t max_voltage;
154
 
155
 
155
// Flags
156
// Flags
156
uint8_t COSD_FLAGS_MODES, COSD_FLAGS_CONFIG, COSD_FLAGS_RUNTIME, COSD_DISPLAYMODE;
157
uint8_t COSD_FLAGS_MODES, COSD_FLAGS_CONFIG, COSD_FLAGS_RUNTIME, COSD_DISPLAYMODE;
157
 
158
 
158
// stats for after flight
159
// stats for after flight
159
int16_t max_Altimeter, altimeter_offset;
160
int16_t max_Altimeter, altimeter_offset;
160
uint8_t min_UBat;
161
uint8_t min_UBat;
161
 
162
 
162
uint16_t max_GroundSpeed;
163
uint16_t max_GroundSpeed;
163
int16_t max_Distance;
164
int16_t max_Distance;
164
uint16_t max_FlyingTime;
165
uint16_t max_FlyingTime;
165
 
166
 
166
// flags from last round to check for changes
167
// flags from last round to check for changes
167
uint8_t old_MKFlags;
168
uint8_t old_MKFlags;
168
 
169
 
169
const char *directions[8];
170
const char *directions[8];
170
const char *stats_item_pointers[8];
171
const char *stats_item_pointers[8];
171
 
172