1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
|
/*
* Utility functions
*
* Copyright (c) 2013 Michael Buesch <m@bues.ch>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*/
#include "util.h"
#include <avr/wdt.h>
#include <avr/eeprom.h>
/* Bitnumber to bitmask lookup table. */
const uint8_t PROGMEM _bit_to_mask8[8] = {
0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80
};
/* Reboot the SOC. */
void reboot(void)
{
/* Disable IRQs and use the watchdog
* to trigger a watchdog reset. */
irq_disable();
wdt_enable(WDTO_15MS);
while (1);
unreachable();
}
/* A fatal error occurred. */
void panic(void)
{
//TODO: Try to get an error message out.
reboot();
}
/* Read a block of data from the EEPROM.
* This function resets the watchdog timer after each processed byte.
*/
void eeprom_read_block_wdtsafe(void *_dst, const void *_src, size_t n)
{
uint8_t *dst = _dst;
const uint8_t *src = _src;
for ( ; n; n--, dst++, src++) {
*dst = eeprom_read_byte(src);
wdt_reset();
}
}
/* Update a block of data in the EEPROM.
* This function resets the watchdog timer after each processed byte.
*/
void eeprom_update_block_wdtsafe(const void *_src, void *_dst, size_t n)
{
const uint8_t *src = _src;
uint8_t *dst = _dst;
for ( ; n; n--, dst++, src++) {
eeprom_update_byte(dst, *src);
wdt_reset();
}
}
uint8_t hexdigit_to_ascii(uint8_t digit)
{
/* Convert a hexadecimal digit (0-F) to an ASCII character */
if (digit >= 0xA)
digit += 0x41 - 0xA;
else
digit += 0x30;
return digit;
}
void long_delay_ms(uint16_t ms)
{
while (1) {
_delay_ms(50);
wdt_reset();
if (ms <= 50)
break;
ms -= 50;
}
}
|
