Subversion Repositories Projects

Rev

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

Rev 514 Rev 523
1
/****************************************************************************
1
/****************************************************************************
2
 *   Copyright (C) 2009 by Claas Anders "CaScAdE" Rathje                    *
2
 *   Copyright (C) 2009 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
-
 
65
#define COSD_FLAG_ARTHORIZON      2
-
 
66
#define COSD_FLAG_BIGVARIO                4
-
 
67
#define COSD_FLAG_STATS                   8
-
 
68
#define COSD_FLAG_WARNINGS               16
-
 
69
#define COSD_FLAG_STROMVOLT              32
-
 
70
 
64
#define COSD_FLAG_NTSC                    1
71
#define COSD_FLAG_NTSC                    1
65
#define COSD_FLAG_HUD                     2
72
#define COSD_FLAG_GPSHEIGHT               2
66
#define COSD_FLAG_ARTHORIZON      4
-
 
67
#define COSD_FLAG_BIGVARIO                8
-
 
68
#define COSD_FLAG_STATS                  16
-
 
69
#define COSD_FLAG_WARNINGS               32
-
 
70
#define COSD_FLAG_STROMVOLT              64
-
 
71
#define COSD_FLAG_FCMODE                128
73
#define COSD_FLAG_FCMODE                  4
72
 
74
 
73
/* ##########################################################################
75
/* ##########################################################################
74
 * FLAGS only usable during runtime (not saved)
76
 * FLAGS only usable during runtime (not saved)
75
 * ##########################################################################*/
77
 * ##########################################################################*/
76
#define COSD_FLAG_STROMREC                1
78
#define COSD_FLAG_STROMREC                1
77
#define COSD_ICONS_WRITTEN                2
79
#define COSD_ICONS_WRITTEN                2
78
#define COSD_WASFLYING                    4
80
#define COSD_WASFLYING                    4
79
 
81
 
80
/* ##########################################################################
82
/* ##########################################################################
81
 * LED controll
83
 * LED controll
82
 * ##########################################################################*/
84
 * ##########################################################################*/
83
#define LED1_ON                 PORTC |=  (1 << PC0);
85
#define LED1_ON                 PORTC |=  (1 << PC0);
84
#define LED1_OFF                PORTC &= ~(1 << PC0);
86
#define LED1_OFF                PORTC &= ~(1 << PC0);
85
#define LED2_ON                 PORTC |=  (1 << PC1);
87
#define LED2_ON                 PORTC |=  (1 << PC1);
86
#define LED2_OFF                PORTC &= ~(1 << PC1);
88
#define LED2_OFF                PORTC &= ~(1 << PC1);
87
#define LED3_ON                 PORTC |=  (1 << PC2);
89
#define LED3_ON                 PORTC |=  (1 << PC2);
88
#define LED3_OFF                PORTC &= ~(1 << PC2);
90
#define LED3_OFF                PORTC &= ~(1 << PC2);
89
#define LED4_ON                 PORTC |=  (1 << PC3);
91
#define LED4_ON                 PORTC |=  (1 << PC3);
90
#define LED4_OFF                PORTC &= ~(1 << PC3);
92
#define LED4_OFF                PORTC &= ~(1 << PC3);
91
 
93
 
92
/* ##########################################################################
94
/* ##########################################################################
93
 * switch controll
95
 * switch controll
94
 * ##########################################################################*/
96
 * ##########################################################################*/
95
#define S1_PRESSED              !(PINC & (1<<PC5))
97
#define S1_PRESSED              !(PINC & (1<<PC5))
96
#define S2_PRESSED              !(PINC & (1<<PC4))
98
#define S2_PRESSED              !(PINC & (1<<PC4))
97
 
99
 
98
/* ##########################################################################
100
/* ##########################################################################
99
 * extern spi controlled vars
101
 * extern spi controlled vars
100
 * ##########################################################################*/
102
 * ##########################################################################*/
101
extern volatile uint16_t icnt;
103
extern volatile uint16_t icnt;
102
extern volatile unsigned char * iptr;
104
extern volatile unsigned char * iptr;
103
extern volatile uint8_t spi_cmd_buffer[];
105
extern volatile uint8_t spi_cmd_buffer[];
104
extern volatile uint8_t spi_ready;
106
extern volatile uint8_t spi_ready;
105
extern int16_t ampere, max_ampere, s_volt;
107
extern int16_t ampere, max_ampere, s_volt;
106
extern int32_t ampere_wasted;
108
extern int32_t ampere_wasted;
107
 
109
 
108
/* ##########################################################################
110
/* ##########################################################################
109
 * struct for displaymodes
111
 * struct for displaymodes
110
 * ##########################################################################*/
112
 * ##########################################################################*/
111
typedef struct {
113
typedef struct {
112
   int (*dfun)(void);   // function pointer
114
   int (*dfun)(void);   // function pointer
113
   char *desc;                  // description text
115
   char *desc;                  // description text
114
} displaymode_t;
116
} displaymode_t;
115
 
117
 
116
const displaymode_t ncdisplaymodes[2];
118
const displaymode_t ncdisplaymodes[2];
117
const displaymode_t fcdisplaymodes[1];
119
const displaymode_t fcdisplaymodes[1];
118
 
120
 
119
int (*osd_ncmode)(void);
121
int (*osd_ncmode)(void);
120
int (*osd_fcmode)(void);
122
int (*osd_fcmode)(void);
121
 
123
 
122
/* ##########################################################################
124
/* ##########################################################################
123
 * vars used by other parts as well
125
 * vars used by other parts as well
124
 * ##########################################################################*/
126
 * ##########################################################################*/
125
volatile uint16_t setsReceived;
127
volatile uint16_t setsReceived;
126
 
128
 
127
volatile NaviData_t naviData;
129
volatile NaviData_t naviData;
128
volatile DebugOut_t debugData;
130
volatile DebugOut_t debugData;
129
 
131
 
130
// cache old vars for blinking attribute, checkup is faster than full
132
// cache old vars for blinking attribute, checkup is faster than full
131
// attribute write each time
133
// attribute write each time
132
volatile uint8_t last_UBat;
134
volatile uint8_t last_UBat;
133
volatile uint8_t last_RC_Quality;
135
volatile uint8_t last_RC_Quality;
134
 
136
 
135
// 16bit should be enough, normal LiPos don't last that long
137
// 16bit should be enough, normal LiPos don't last that long
136
volatile uint16_t uptime;
138
volatile uint16_t uptime;
137
volatile uint16_t timer;
139
volatile uint16_t timer;
138
 
140
 
139
// remember last time data was received
141
// remember last time data was received
140
volatile uint8_t seconds_since_last_data;
142
volatile uint8_t seconds_since_last_data;
141
 
143
 
142
// general PAL|NTSC distingiusch stuff
144
// general PAL|NTSC distingiusch stuff
143
uint8_t top_line;
145
uint8_t top_line;
144
uint8_t bottom_line;
146
uint8_t bottom_line;
145
 
147
 
146
// battery voltages
148
// battery voltages
147
uint8_t min_voltage;
149
uint8_t min_voltage;
148
uint8_t max_voltage;
150
uint8_t max_voltage;
149
 
151
 
150
// Flags
152
// Flags
151
uint8_t COSD_FLAGS, COSD_FLAGS2, COSD_DISPLAYMODE;
153
uint8_t COSD_FLAGS_MODES, COSD_FLAGS_CONFIG, COSD_FLAGS_RUNTIME, COSD_DISPLAYMODE;
152
 
154
 
153
// stats for after flight
155
// stats for after flight
154
int16_t max_Altimeter;
156
int16_t max_Altimeter, altimeter_offset;
155
uint8_t min_UBat;
157
uint8_t min_UBat;
156
 
158
 
157
uint16_t max_GroundSpeed;
159
uint16_t max_GroundSpeed;
158
int16_t max_Distance;
160
int16_t max_Distance;
159
uint16_t max_FlyingTime;
161
uint16_t max_FlyingTime;
160
 
162
 
161
// flags from last round to check for changes
163
// flags from last round to check for changes
162
uint8_t old_MKFlags;
164
uint8_t old_MKFlags;
163
 
165
 
164
const char *directions[8];
166
const char *directions[8];
165
const char *stats_item_pointers[8];
167
const char *stats_item_pointers[8];
166
 
168