Subversion Repositories Projects

Rev

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

Rev 736 Rev 757
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/io.h>
21
#include <avr/io.h>
22
 
22
 
23
#include <util/delay.h>
23
#include <util/delay.h>
24
#include <avr/pgmspace.h> 
24
#include <avr/pgmspace.h> 
25
#include <string.h>
25
#include <string.h>
26
#include <stdlib.h>
26
#include <stdlib.h>
27
#include "main.h"
27
#include "main.h"
28
#include "max7456_software_spi.h"
28
#include "max7456_software_spi.h"
29
 
29
 
30
 
30
 
31
char conv_array[7]; // general array for number -> char conversation
31
char conv_array[7]; // general array for number -> char conversation
32
 
32
 
33
/* ##########################################################################
33
/* ##########################################################################
34
 * MAX7456 SPI & Display stuff
34
 * MAX7456 SPI & Display stuff
35
 * ##########################################################################*/
35
 * ##########################################################################*/
36
 
36
 
37
/**
37
/**
38
 * Send a byte through SPI
38
 * Send a byte through SPI
39
 * inline because it increases the codesize currenlty 'only' by 110byte but saves
39
 * inline because it increases the codesize currenlty 'only' by 110byte but saves
40
 * the context-change on every char and attribute which is at least done twice
40
 * the context-change on every char and attribute which is at least done twice
41
 * (address and data byte), a significant speed-bost we do not want to miss :)
41
 * (address and data byte), a significant speed-bost we do not want to miss :)
42
 */
42
 */
43
inline void spi_send(uint8_t byte) {
43
inline void spi_send(uint8_t byte) {
44
    for (int8_t i = 7; i >= 0; i--) {
44
    for (int8_t i = 7; i >= 0; i--) {
45
        if (((byte >> i) & 1)) {
45
        if (((byte >> i) & 1)) {
46
            MAX_SDIN_HIGH
46
            MAX_SDIN_HIGH
47
        } else {
47
        } else {
48
            MAX_SDIN_LOW
48
            MAX_SDIN_LOW
49
        }
49
        }
50
        MAX_SCLK_HIGH
50
        MAX_SCLK_HIGH
51
        MAX_SCLK_LOW
51
        MAX_SCLK_LOW
52
    }
52
    }
53
}
53
}
54
 
54
 
55
/**
55
/**
56
 *  Send <byte> to <address> of MAX7456
56
 *  Send <byte> to <address> of MAX7456
57
 */
57
 */
58
void spi_send_byte(uint8_t address, uint8_t byte) {
58
void spi_send_byte(uint8_t address, uint8_t byte) {
59
    // start sending
59
    // start sending
60
    MAX_CS_LOW
60
    MAX_CS_LOW
61
 
61
 
62
    spi_send(address);
62
    spi_send(address);
63
    spi_send(byte);
63
    spi_send(byte);
64
 
64
 
65
    // end sending
65
    // end sending
66
    MAX_CS_HIGH
66
    MAX_CS_HIGH
67
}
67
}
68
 
68
 
69
 
69
 
70
/**
70
/**
71
 *  write a <character> to <address> of MAX7456 display memory
71
 *  write a <character> to <address> of MAX7456 display memory
72
 */
72
 */
73
void write_char(uint16_t address, char character) {
73
void write_char(uint16_t address, char character) {
74
    spi_send_byte(0x05, (address & 0xFF00) >> 8); // DMAH
74
    spi_send_byte(0x05, (address & 0xFF00) >> 8); // DMAH
75
    spi_send_byte(0x06, (address & 0x00FF)); // DMAL
75
    spi_send_byte(0x06, (address & 0x00FF)); // DMAL
76
    spi_send_byte(0x07, character); // DMDI
76
    spi_send_byte(0x07, character); // DMDI
77
}
77
}
78
 
78
 
79
 
79
 
80
/**
80
/**
81
 *  clear display memory
81
 *  clear display memory
82
 *  (also sets 8bit mode)
82
 *  (also sets 8bit mode)
83
 */
83
 */
84
void clear(void) {
84
void clear(void) {
85
    /*uint16_t memory_address = 0;
85
    /*uint16_t memory_address = 0;
86
    for (unsigned int a = 0; a < 480; a++) {
86
    for (unsigned int a = 0; a < 480; a++) {
87
        write_char(memory_address++, 0);
87
        write_char(memory_address++, 0);
88
    }*/
88
    }*/
89
        // clear all display-mem (DMM)
89
        // clear all display-mem (DMM)
90
    spi_send_byte(0x04, 0b01000100);
90
    spi_send_byte(0x04, 0b01000100);
91
 
91
 
92
    // clearing takes 12uS according to maxim so lets wait longer
92
    // clearing takes 12uS according to maxim so lets wait longer
93
    _delay_us(20);
93
    _delay_us(20);
94
}
94
}
95
 
95
 
96
 
96
 
97
#if (ALLCHARSDEBUG|(WRITECHARS != -1))
97
#if (ALLCHARSDEBUG|(WRITECHARS != -1))
98
/**
98
/**
99
 * for testing write all chars to screen
99
 * for testing write all chars to screen
100
 */
100
 */
101
void write_all_chars() {
101
void write_all_chars() {
102
    uint16_t x = 3, y = 2, t = 0;
102
    uint16_t x = 3, y = 2, t = 0;
103
    while (t < 256) {
103
    while (t < 256) {
104
        write_char(x++ + y*30, t++);
104
        write_char(x++ + y*30, t++);
105
        if (x > 25) {
105
        if (x > 25) {
106
            y++;
106
            y++;
107
            x = 3;
107
            x = 3;
108
        }
108
        }
109
    }
109
    }
110
}
110
}
111
 
111
 
112
/**
112
/**
113
 * let the MAX7456 learn a new character at <number>
113
 * let the MAX7456 learn a new character at <number>
114
 * with <data>.
114
 * with <data>.
115
 */
115
 */
116
void learn_char(uint8_t number, unsigned char* data) {
116
void learn_char(uint8_t number, unsigned char* data) {
117
    // select character to write (CMAH)
117
    // select character to write (CMAH)
118
    spi_send_byte(0x09, number);
118
    spi_send_byte(0x09, number);
119
 
119
 
120
    for (uint8_t i = 0; i < 54; i++) {
120
    for (uint8_t i = 0; i < 54; i++) {
121
        // select 4pixel byte of char (CMAL)
121
        // select 4pixel byte of char (CMAL)
122
        spi_send_byte(0x0A, i);
122
        spi_send_byte(0x0A, i);
123
 
123
 
124
        // write 4pixel byte of char (CMDI)
124
        // write 4pixel byte of char (CMDI)
125
        spi_send_byte(0x0B, data[i]);
125
        spi_send_byte(0x0B, data[i]);
126
    }
126
    }
127
 
127
 
128
    // write to the NVM array from the shadow RAM (CMM)
128
    // write to the NVM array from the shadow RAM (CMM)
129
    spi_send_byte(0x08, 0b10100000);
129
    spi_send_byte(0x08, 0b10100000);
130
 
130
 
131
    // according to maxim writing to nvram takes about 12ms, lets wait longer
131
    // according to maxim writing to nvram takes about 12ms, lets wait longer
132
    _delay_ms(120);
132
    _delay_ms(120);
133
}
133
}
134
#endif
134
#endif
135
 
135
 
136
#if !(ALLCHARSDEBUG|(WRITECHARS != -1))
136
#if !(ALLCHARSDEBUG|(WRITECHARS != -1))
137
 
137
 
138
/**
138
/**
139
 *  write a character <attribute> to <address> of MAX7456 display memory
139
 *  write a character <attribute> to <address> of MAX7456 display memory
140
 */
140
 */
141
void write_char_att(uint16_t address, char attribute) {
141
void write_char_att(uint16_t address, char attribute) {
142
    // the only important part is that the DMAH[1] is set
142
    // the only important part is that the DMAH[1] is set
143
    // so we add 2 which binary is the 2nd lowest byte
143
    // so we add 2 which binary is the 2nd lowest byte
144
    spi_send_byte(0x05, ((address & 0xFF00) >> 8) | 2); // DMAH
144
    spi_send_byte(0x05, ((address & 0xFF00) >> 8) | 2); // DMAH
145
    spi_send_byte(0x06, (address & 0x00FF)); // DMAL
145
    spi_send_byte(0x06, (address & 0x00FF)); // DMAL
146
    spi_send_byte(0x07, attribute); // DMDI
146
    spi_send_byte(0x07, attribute); // DMDI
147
}
147
}
148
 
148
 
149
/**
149
/**
150
 *  write a <character> at <x>/<y> to MAX7456 display memory
150
 *  write a <character> at <x>/<y> to MAX7456 display memory
151
 */
151
 */
152
void write_char_xy(uint8_t x, uint8_t y, char character) {
152
void write_char_xy(uint8_t x, uint8_t y, char character) {
153
    uint16_t address = y * 30 + x;
153
    uint16_t address = y * 30 + x;
154
    write_char(address, character);
154
    write_char(address, character);
155
}
155
}
156
 
156
 
157
/**
157
/**
158
 *  write a  character <attribute> at <x>/<y> to MAX7456 display memory
158
 *  write a  character <attribute> at <x>/<y> to MAX7456 display memory
159
 */
159
 */
160
void write_char_att_xy(uint8_t x, uint8_t y, char attribute) {
160
void write_char_att_xy(uint8_t x, uint8_t y, char attribute) {
161
    uint16_t address = y * 30 + x;
161
    uint16_t address = y * 30 + x;
162
    write_char_att(address, attribute);
162
    write_char_att(address, attribute);
163
}
163
}
164
 
164
 
165
/**
165
/**
166
 *  write an ascii <character> to <address> of MAX7456 display memory
166
 *  write an ascii <character> to <address> of MAX7456 display memory
167
 */
167
 */
168
void write_ascii_char(uint16_t address, char c) {
168
void write_ascii_char(uint16_t address, char c) {
169
    if (c == 32) c = 0; // remap space
169
    if (c == 32) c = 0; // remap space
170
    else if (c > 48 && c <= 57) c -= 48; // remap numbers
170
    else if (c > 48 && c <= 57) c -= 48; // remap numbers
171
    else if (c == '0') c = 10; // remap zero
171
    else if (c == '0') c = 10; // remap zero
172
    else if (c >= 65 && c <= 90) c -= 54; // remap big letters
172
    else if (c >= 65 && c <= 90) c -= 54; // remap big letters
173
    else if (c >= 97 && c <= 122) c -= 60; // remap small letters
173
    else if (c >= 97 && c <= 122) c -= 60; // remap small letters
174
    else if (c == '(') c = 63; // remap
174
    else if (c == '(') c = 63; // remap
175
    else if (c == ')') c = 64; // remap
175
    else if (c == ')') c = 64; // remap
176
    else if (c == '.') c = 65; // remap
176
    else if (c == '.') c = 65; // remap
177
    else if (c == '-') c = 73; // remap minus
177
    else if (c == '-') c = 73; // remap minus
178
    else if (c == ';') c = 67; // remap
178
    else if (c == ';') c = 67; // remap
179
    else if (c == ':') c = 68; // remap
179
    else if (c == ':') c = 68; // remap
180
    else if (c == ',') c = 69; // remap
180
    else if (c == ',') c = 69; // remap
181
//    else if (c == '?') c = 66; // remap
181
//    else if (c == '?') c = 66; // remap
182
//    else if (c == '\'') c = 70; // remap
182
//    else if (c == '\'') c = 70; // remap
183
//    else if (c == '/') c = 71; // remap
183
    else if (c == '/') c = 71; // remap
184
//    else if (c == '"') c = 72; // remap
184
//    else if (c == '"') c = 72; // remap
185
//    else if (c == '<') c = 74; // remap
185
//    else if (c == '<') c = 74; // remap
186
//    else if (c == '>') c = 75; // remap
186
//    else if (c == '>') c = 75; // remap
187
//    else if (c == '@') c = 76; // remap
187
//    else if (c == '@') c = 76; // remap
188
    write_char(address, c);
188
    write_char(address, c);
189
}
189
}
190
 
190
 
191
/**
191
/**
192
 *  write an ascii <string> at <x>/<y> to MAX7456 display memory
192
 *  write an ascii <string> at <x>/<y> to MAX7456 display memory
193
 */
193
 */
194
void write_ascii_string(uint8_t x, uint8_t y, char *string) {
194
void write_ascii_string(uint8_t x, uint8_t y, char *string) {
195
    while (*string) {
195
    while (*string) {
196
        write_ascii_char(((x++)+(y * 30)), *string);
196
        write_ascii_char(((x++)+(y * 30)), *string);
197
        string++;
197
        string++;
198
    }
198
    }
199
}
199
}
200
 
200
 
201
/**
201
/**
202
 *  write an ascii <string> from progmen at <x>/<y> to MAX7456 display memory
202
 *  write an ascii <string> from progmen at <x>/<y> to MAX7456 display memory
203
 */
203
 */
204
void write_ascii_string_pgm(uint8_t x, uint8_t y, const char *string) {
204
void write_ascii_string_pgm(uint8_t x, uint8_t y, const char *string) {
205
        while (pgm_read_byte(string) != 0x00)
205
        while (pgm_read_byte(string) != 0x00)
206
                write_ascii_char(((x++)+(y * 30)), pgm_read_byte(string++));
206
                write_ascii_char(((x++)+(y * 30)), pgm_read_byte(string++));
207
}
207
}
208
 
208
 
209
/**
209
/**
210
 *  write an <string> from progmen at <x>/<y> downwards to MAX7456 display memory
210
 *  write an <string> from progmen at <x>/<y> downwards to MAX7456 display memory
211
 */
211
 */
212
void write_string_pgm_down(uint8_t x, uint8_t y, const char *string, uint8_t length) {
212
void write_string_pgm_down(uint8_t x, uint8_t y, const char *string, uint8_t length) {
213
        while (length--)
213
        while (length--)
214
                write_char((x+(y++ * 30)), pgm_read_byte(string++));
214
                write_char((x+(y++ * 30)), pgm_read_byte(string++));
215
}
215
}
216
 
216
 
217
/**
217
/**
218
 * Write a unsigned <number> at <x>/<y> to MAX7456 display memory
218
 * Write a unsigned <number> at <x>/<y> to MAX7456 display memory
219
 * <length> represents the length to rightbound the number
219
 * <length> represents the length to rightbound the number
220
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
220
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
221
 */
221
 */
222
void write_ndigit_number_u(uint8_t x, uint8_t y, uint16_t number, int16_t length, uint8_t pad) {
222
void write_ndigit_number_u(uint8_t x, uint8_t y, uint16_t number, int16_t length, uint8_t pad) {
223
        itoa(number, conv_array, 10 );
223
        itoa(number, conv_array, 10 );
224
        for (uint8_t i = 0; i < length - strlen(conv_array); i++) {
224
        for (uint8_t i = 0; i < length - strlen(conv_array); i++) {
225
                if (pad) write_char((x++)+(y * 30), 10);
225
                if (pad) write_char((x++)+(y * 30), 10);
226
                else write_ascii_char((x++)+(y * 30), 0);
226
                else write_ascii_char((x++)+(y * 30), 0);
227
        }
227
        }
228
        write_ascii_string(x,  y, conv_array);
228
        write_ascii_string(x,  y, conv_array);
229
}
229
}
230
 
230
 
231
/**
231
/**
232
 * Write a signed <number> at <x>/<y> to MAX7456 display memory
232
 * Write a signed <number> at <x>/<y> to MAX7456 display memory
233
 * <length> represents the length to rightbound the number
233
 * <length> represents the length to rightbound the number
234
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
234
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
235
 */
235
 */
236
void write_ndigit_number_s(uint8_t x, uint8_t y, int16_t number, int16_t length, uint8_t pad) {
236
void write_ndigit_number_s(uint8_t x, uint8_t y, int16_t number, int16_t length, uint8_t pad) {
237
        itoa(number, conv_array, 10 );
237
        itoa(number, conv_array, 10 );
238
        for (uint8_t i = 0; i < length - strlen(conv_array); i++) {
238
        for (uint8_t i = 0; i < length - strlen(conv_array); i++) {
239
                if (pad) write_char((x++)+(y * 30), 10);
239
                if (pad) write_char((x++)+(y * 30), 10);
240
                else write_ascii_char((x++)+(y * 30), 0);
240
                else write_ascii_char((x++)+(y * 30), 0);
241
        }
241
        }
242
        write_ascii_string(x,  y, conv_array);
242
        write_ascii_string(x,  y, conv_array);
243
}
243
}
244
 
244
 
245
/**
245
/**
246
 * Write a unsigned <number> at <x>/<y> to MAX7456 display memory as /10th of value
246
 * Write a unsigned <number> at <x>/<y> to MAX7456 display memory as /10th of value
247
 * <length> represents the length to rightbound the number
247
 * <length> represents the length to rightbound the number
248
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
248
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
249
 */
249
 */
250
void write_ndigit_number_u_10th(uint8_t x, uint8_t y, uint16_t number, int16_t length, uint8_t pad) {
250
void write_ndigit_number_u_10th(uint8_t x, uint8_t y, uint16_t number, int16_t length, uint8_t pad) {
251
        itoa(number, conv_array, 10 );
251
        itoa(number, conv_array, 10 );
252
        uint8_t len = strlen(conv_array);
252
        uint8_t len = strlen(conv_array);
253
        for (uint8_t i = 0; i < length - len; i++) {
253
        for (uint8_t i = 0; i < length - len; i++) {
254
                if (pad) write_char((x++)+(y * 30), 10); //  zero
254
                if (pad) write_char((x++)+(y * 30), 10); //  zero
255
                else write_char((x++)+(y * 30), 0); // blank
255
                else write_char((x++)+(y * 30), 0); // blank
256
        }
256
        }
257
        char rest = conv_array[len - 1];
257
        char rest = conv_array[len - 1];
258
        conv_array[len - 1] = 0;
258
        conv_array[len - 1] = 0;
259
        if (len == 1) {
259
        if (len == 1) {
260
                write_char((x-1)+(y * 30), 10); // zero
260
                write_char((x-1)+(y * 30), 10); // zero
261
        } else if (len == 2 && conv_array[0] == '-') {
261
        } else if (len == 2 && conv_array[0] == '-') {
262
                write_char((x-1)+(y * 30), 0x49); // minus
262
                write_char((x-1)+(y * 30), 0x49); // minus
263
                write_char((x)+(y * 30), 10); // zero
263
                write_char((x)+(y * 30), 10); // zero
264
        } else {
264
        } else {
265
                write_ascii_string(x,  y, conv_array);
265
                write_ascii_string(x,  y, conv_array);
266
        }
266
        }
267
        x += len - 1;
267
        x += len - 1;
268
        write_char((x++)+(y * 30), 65); // decimal point
268
        write_char((x++)+(y * 30), 65); // decimal point
269
        write_ascii_char((x++)+(y * 30), rest); // after dot
269
        write_ascii_char((x++)+(y * 30), rest); // after dot
270
}
270
}
271
 
271
 
272
/**
272
/**
273
 * Write a signed <number> at <x>/<y> to MAX7456 display memory as /10th of value
273
 * Write a signed <number> at <x>/<y> to MAX7456 display memory as /10th of value
274
 * <length> represents the length to rightbound the number
274
 * <length> represents the length to rightbound the number
275
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
275
 * <pad> = 1 will cause blank spaced to be filled up with zeros e.g. 007 instead of   7
276
 */
276
 */
277
void write_ndigit_number_s_10th(uint8_t x, uint8_t y, int16_t number, int16_t length, uint8_t pad) {
277
void write_ndigit_number_s_10th(uint8_t x, uint8_t y, int16_t number, int16_t length, uint8_t pad) {
278
        itoa(number, conv_array, 10 );
278
        itoa(number, conv_array, 10 );
279
        uint8_t len = strlen(conv_array);
279
        uint8_t len = strlen(conv_array);
280
        for (uint8_t i = 0; i < length - len; i++) {
280
        for (uint8_t i = 0; i < length - len; i++) {
281
                if (pad) write_char((x++)+(y * 30), 10); //  zero
281
                if (pad) write_char((x++)+(y * 30), 10); //  zero
282
                else write_char((x++)+(y * 30), 0); // blank
282
                else write_char((x++)+(y * 30), 0); // blank
283
        }
283
        }
284
        char rest = conv_array[len - 1];
284
        char rest = conv_array[len - 1];
285
        conv_array[len - 1] = 0;
285
        conv_array[len - 1] = 0;
286
        if (len == 1) {
286
        if (len == 1) {
287
                write_char((x-1)+(y * 30), 10); // zero
287
                write_char((x-1)+(y * 30), 10); // zero
288
        } else if (len == 2 && conv_array[0] == '-') {
288
        } else if (len == 2 && conv_array[0] == '-') {
289
                write_char((x-1)+(y * 30), 0x49); // minus
289
                write_char((x-1)+(y * 30), 0x49); // minus
290
                write_char((x)+(y * 30), 10); // zero
290
                write_char((x)+(y * 30), 10); // zero
291
        } else {
291
        } else {
292
                write_ascii_string(x,  y, conv_array);
292
                write_ascii_string(x,  y, conv_array);
293
        }
293
        }
294
        x += len - 1;
294
        x += len - 1;
295
        write_char((x++)+(y * 30), 65); // decimal point
295
        write_char((x++)+(y * 30), 65); // decimal point
296
        write_ascii_char((x++)+(y * 30), rest); // after dot
296
        write_ascii_char((x++)+(y * 30), rest); // after dot
297
}
297
}
298
 
298
 
299
/**
299
/**
300
 *  write <seconds> as human readable time at <x>/<y> to MAX7456 display mem
300
 *  write <seconds> as human readable time at <x>/<y> to MAX7456 display mem
301
 */
301
 */
302
void write_time(uint8_t x, uint8_t y, uint16_t seconds) {
302
void write_time(uint8_t x, uint8_t y, uint16_t seconds) {
303
    uint16_t min = seconds / 60;
303
    uint16_t min = seconds / 60;
304
    seconds -= min * 60;
304
    seconds -= min * 60;
305
    write_ndigit_number_u(x, y, min, 3, 0);
305
    write_ndigit_number_u(x, y, min, 3, 0);
306
    write_char_xy(x + 3, y, 68);
306
    write_char_xy(x + 3, y, 68);
307
    write_ndigit_number_u(x + 4, y, seconds, 2, 1);
307
    write_ndigit_number_u(x + 4, y, seconds, 2, 1);
308
}
308
}
309
 
309
 
310
/**
310
/**
311
 * wirte a <position> at <x>/<y> assuming it is a gps position for long-/latitude
311
 * wirte a <position> at <x>/<y> assuming it is a gps position for long-/latitude
312
 */
312
 */
313
void write_gps_pos(uint8_t x, uint8_t y, int32_t position) {
313
void write_gps_pos(uint8_t x, uint8_t y, int32_t position) {
314
        if (position < 0) {
314
        if (position < 0) {
315
                position ^= ~0;
315
                position ^= ~0;
316
                position++;
316
                position++;
317
                write_char_xy(x++, y, 0x49); // minus
317
                write_char_xy(x++, y, 0x49); // minus
318
        } else {
318
        } else {
319
                write_char_xy(x++, y, 0); // clear ('+' would be nice, maybe later)
319
                write_char_xy(x++, y, 0); // clear ('+' would be nice, maybe later)
320
        }
320
        }
321
        write_ndigit_number_u(x, y, (uint16_t) (position / (int32_t) 10000000), 3, 1);
321
        write_ndigit_number_u(x, y, (uint16_t) (position / (int32_t) 10000000), 3, 1);
322
        write_char_xy(x + 3, y, 65); // decimal point
322
        write_char_xy(x + 3, y, 65); // decimal point
323
        position = position - ((position / (int32_t) 10000000) * (int32_t) 10000000);
323
        position = position - ((position / (int32_t) 10000000) * (int32_t) 10000000);
324
        write_ndigit_number_u(x + 4, y, (uint16_t) (position / (int32_t) 1000), 4, 1);
324
        write_ndigit_number_u(x + 4, y, (uint16_t) (position / (int32_t) 1000), 4, 1);
325
        position = position - ((uint16_t) (position / (int32_t) 1000) * (int32_t) 1000);
325
        position = position - ((uint16_t) (position / (int32_t) 1000) * (int32_t) 1000);
326
        write_ndigit_number_u(x + 8, y, (uint16_t) position, 3, 1);
326
        write_ndigit_number_u(x + 8, y, (uint16_t) position, 3, 1);
327
        write_char_xy(x + 11, y, 0xD0); // degree symbol
327
        write_char_xy(x + 11, y, 0xD0); // degree symbol
328
}
328
}
329
 
329
 
330
#endif
330
#endif
331
 
331