summaryrefslogtreecommitdiffstats
path: root/hid/firmware/util.c
blob: b5c16d77483e8556f63c908eafb572f81957b360 (plain)
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;
	}
}
bues.ch cgit interface