Subversion Repositories Projects

Rev

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

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