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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
|
/*
* eim_peek_poke.c
* ---------------
* Read or write a 32-bit word via the EIM bus. This is mostly
* intended for use as part of the FPGA initialization sequence.
*
* Authors: Paul Selkirk, Rob Austein
* Copyright (c) 2015, NORDUnet A/S
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are
* met:
* - Redistributions of source code must retain the above copyright notice,
* this list of conditions and the following disclaimer.
*
* - Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* - Neither the name of the NORDUnet nor the names of its contributors may
* be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
* IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
* PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
* HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
* TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#include <stdio.h>
#include <stdlib.h>
#include <stdarg.h>
#include <string.h>
#include "novena-eim.h"
#define string_match(...) \
_string_match(__VA_ARGS__, NULL)
static int _string_match(const char *s1, ...)
{
const char *s2;
if (s1 == NULL)
return 0;
va_list ap;
va_start(ap, s1);
for (s2 = va_arg(ap, const char *); s2 != NULL; s2 = va_arg(ap, const char *))
if (!strcmp(s1, s2))
break;
va_end(ap);
return s2 != NULL;
}
static int parse_value(const char *s, uint32_t *value)
{
if (s == NULL || value == NULL)
return 0;
char *e;
*value = strtoul(s, &e, 0);
return *s != '\0' && *e == '\0';
}
static int parse_offset(const char *s, off_t *offset)
{
uint32_t value;
if (offset == NULL || !parse_value(s, &value))
return 0;
*offset = (off_t) value;
return 1;
}
static void usage(const int code, const char *jane)
{
FILE *f = code ? stderr : stdout;
fprintf(f, "usage: %s { --read offset | --write offset value }\n", jane);
exit(code);
}
int main(int argc, char *argv[])
{
off_t offset = 0;
uint32_t value;
if (argc == 1 || string_match(argv[1], "-?", "-h", "--help"))
usage(EXIT_SUCCESS, argv[0]);
if (eim_setup() != 0) {
fprintf(stderr, "EIM setup failed\n");
return EXIT_FAILURE;
}
if (string_match(argv[1], "r", "-r", "--read", "--peek")) {
if (argc != 3 || !parse_offset(argv[2], &offset))
usage(EXIT_FAILURE, argv[0]);
eim_read_32(offset, &value);
printf("%08x\n", value);
}
else if (string_match(argv[1], "w", "-w", "--write", "--poke")) {
if (argc != 4 || !parse_offset(argv[2], &offset) || !parse_value(argv[3], &value))
usage(EXIT_FAILURE, argv[0]);
eim_write_32(offset, &value);
exit(EXIT_SUCCESS);
}
else {
usage(EXIT_FAILURE, argv[0]);
}
return EXIT_SUCCESS;
}
|
