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
98
99
100
101
102
103
104
105
106
107
108
|
/*
* spreadspace avr utils
*
*
* Copyright (C) 2012 Christian Pointner <equinox@spreadspace.org>
*
* This file is part of spreadspace avr utils.
*
* spreadspace avr utils 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 3 of the License, or
* any later version.
*
* spreadspace avr utils 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 spreadspace avr utils. If not, see <http://www.gnu.org/licenses/>.
*/
#include <stdint.h>
#include <ctype.h>
#include <stdio.h>
#define KEY_LEN_MAX 7
#define MAX_KEYS 128
char generate_csum(char* data)
{
uint16_t sum1 = 0xf, sum2 = 0xf, len = KEY_LEN_MAX;
do { sum2 += ( sum1 += *data++ ); } while (--len);
return sum2<<4 | sum1;
}
int main(int argc, char* argv[])
{
if(argc<2) {
fprintf(stderr, "Usage: update-keys <device>\n");
return -1;
}
FILE* dev;
dev = fopen(argv[1], "r+");
if(!dev) {
fprintf(stderr, "fopen failed!\n");
return -2;
}
fprintf(dev, "e");
char* line = NULL;
size_t len = 0;
int line_num = 0;
uint8_t key[KEY_LEN_MAX+1];
int key_num = 0;
for(;;) {
ssize_t ret = getline(&line, &len, stdin);
if(ret <= 0) break;
line_num++;
int i;
for(i=0; i<len; ++i) {
if(!isxdigit(line[i])) {
line[i] = 0;
break;
}
}
if(i & 1 || i == 0 || i > KEY_LEN_MAX*2) {
fprintf(stderr, "ignoring invalid key (odd number of digits or empty string or too long) at line %d\n", line_num);
continue;
}
uint8_t tmp[3];
int j;
tmp[2] = 0;
for(j = 0; j<(i/2); ++j) {
tmp[0] = line[j*2];
tmp[1] = line[j*2 + 1];
key[j] = (char)strtoul(tmp, NULL, 16);
}
for(j=i/2; j < KEY_LEN_MAX; ++j) {
key[j] = 0;
}
key[KEY_LEN_MAX] = generate_csum(key);
fwrite(key, KEY_LEN_MAX+1, 1, dev);
key_num++;
if(key_num > MAX_KEYS) {
fprintf(stderr, "reached maximum number of key slots (%d), will ignore remaining keys\n", MAX_KEYS);
break;
}
}
printf("read %d keys from STDIN\n", key_num);
int i;
for(i=0; i<=KEY_LEN_MAX; ++i) key[i] = 0xFF;
for(i=key_num; i < MAX_KEYS; ++i)
fwrite(key, KEY_LEN_MAX+1, 1, dev);
char tmp;
while(fread(&tmp, 1, 1, dev)) {
fwrite(&tmp, 1, 1, dev);
}
return 0;
}
|