-
Notifications
You must be signed in to change notification settings - Fork 0
/
check.c
82 lines (62 loc) · 2.08 KB
/
check.c
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
#include <stdbool.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include "jtag-io.h"
void check (int pipeline)
{
printf ("Check pipeline %c\n", pipeline + 'A');
printf ("ID Code is %08x\n", read_id());
uint64_t clock1 = start_clock();
uint64_t load_clock = clock1 + FREQ / 20;
load_md5 (pipeline, load_clock, 0x01234567, 0x78abcdef, 0xfc9639da);
usleep (100000);
uint64_t sample_clock = load_clock + (FREQ / 10 / STAGES) * STAGES;
sample_md5 (pipeline, sample_clock);
usleep (100000);
uint32_t sample[3];
bool got_load = false;
bool got_sample = false;
uint64_t clock2 = read_clock();
printf ("Elapsed %lu to %lu [%lu cycles]\n",
clock1, clock2, clock2 - clock1);
printf ("Load %lu, sample %lu [%lu iterations]\n",
load_clock, sample_clock, (sample_clock - load_clock) / STAGES);
for (int i = 0; i != 256; ++i) {
printf (".");
fflush (stdout);
uint64_t clock;
uint32_t data[3];
read_result (pipeline, i, &clock, data);
if (clock1 <= clock && clock <= clock2)
printf ("\n%12lu %08x %08x %08x [%lu]\n",
clock, data[0], data[1], data[2], clock % STAGES);
if (clock == load_clock)
got_load = true;
if (clock == sample_clock) {
got_sample = true;
memcpy (sample, data, sizeof (data));
}
}
printf ("\n");
if (!got_load)
printf_exit ("Failed to load data\n");
if (!got_sample)
printf_exit ("Failed to sample data\n");
uint32_t data[3] = { 0x01234567, 0x78abcdef, 0xfc9639da };
for (uint64_t i = load_clock; i != sample_clock; i += STAGES)
transform (data, data);
printf ("Calced: %08x %08x %08x\n", data[0], data[1], data[2]);
printf ("Sample: %08x %08x %08x\n", sample[0], sample[1], sample[2]);
if (memcmp (data, sample, sizeof (data)) != 0)
printf_exit ("Mismatch\n");
}
int main()
{
open_serial();
check (0);
check (1);
jtag_reset();
return EXIT_SUCCESS;
}