5686d931 |
1 | #include <stdio.h> |
2 | #include <string.h> |
3 | #include <sys/types.h> |
4 | #include <sys/socket.h> |
5 | #include <netdb.h> |
6 | #include <unistd.h> |
7 | |
8 | #include "debug_net.h" |
9 | |
10 | static const char * const regnames[] = { |
11 | "PC", |
12 | "R0", "R1", "R2", "R3", "R4", "R5", "R6", "R7", |
13 | "R8", "R9", "R10", "R11", "R12", "R13", "R14", "SP", |
14 | "PC2", "PC3", "PR", "SR", "GBR", "VBR", "MACH", "MACL", |
15 | "MEM0", "MEM1", // mem i/o csums |
16 | }; |
17 | |
18 | int main(int argc, char *argv[]) |
19 | { |
20 | unsigned int pc_trace[5][4], pc_trace_p[5] = { 0, }; |
21 | struct addrinfo *ai, *ais, hints; |
22 | int sock = -1, sock1, sock2; |
23 | struct sockaddr_in6 sa; |
24 | packet_t packet1, packet2; |
25 | int i, ret, cnt, cpuid; |
a2b8c5a5 |
26 | int check_len_override = 0; |
5686d931 |
27 | socklen_t sal; |
28 | |
a2b8c5a5 |
29 | if (argv[1] != NULL) |
30 | check_len_override = atoi(argv[1]); |
31 | |
5686d931 |
32 | memset(&hints, 0, sizeof(hints)); |
33 | hints.ai_flags = AI_CANONNAME; |
34 | hints.ai_family = PF_UNSPEC; |
35 | hints.ai_socktype = SOCK_STREAM; |
36 | |
37 | ret = getaddrinfo("::", "1234", &hints, &ais); |
38 | if (ret != 0) |
39 | return -1; |
40 | |
41 | for (ai = ais; ai != NULL; ai = ai->ai_next) { |
42 | sock = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol); |
43 | if (sock == -1) |
44 | continue; |
45 | |
46 | ret = bind(sock, ai->ai_addr, ai->ai_addrlen); |
47 | if (ret != 0) { |
48 | close(sock); |
49 | sock = -1; |
50 | continue; |
51 | } |
52 | break; |
53 | } |
54 | freeaddrinfo(ais); |
55 | |
56 | if (sock == -1) { |
57 | perror("failed to bind"); |
58 | return -1; |
59 | } |
60 | |
61 | ret = listen(sock, SOMAXCONN); |
62 | if (ret != 0) { |
63 | perror("failed to listen"); |
64 | return -1; |
65 | } |
66 | |
67 | sal = sizeof(sa); |
68 | sock1 = accept(sock, (struct sockaddr *)&sa, &sal); |
69 | if (sock1 == -1) { |
70 | perror("failed to accept"); |
71 | return -1; |
72 | } |
73 | printf("client1 connected\n"); |
74 | |
75 | sal = sizeof(sa); |
76 | sock2 = accept(sock, (struct sockaddr *)&sa, &sal); |
77 | if (sock2 == -1) { |
78 | perror("failed to accept"); |
79 | return -1; |
80 | } |
81 | printf("client2 connected\n"); |
82 | |
83 | for (cnt = 0; ; cnt++) |
84 | { |
a2b8c5a5 |
85 | int len; |
5686d931 |
86 | #define tmp_size (4+4 + 24*4 + 2*4) |
87 | ret = recv(sock1, &packet1, tmp_size, MSG_WAITALL); |
88 | if (ret != tmp_size) { |
89 | if (ret < 0) |
90 | perror("recv1"); |
91 | else |
92 | printf("recv1 %d\n", ret); |
93 | return -1; |
94 | } |
95 | ret = recv(sock2, &packet2, tmp_size, MSG_WAITALL); |
96 | if (ret != tmp_size) { |
97 | if (ret < 0) |
98 | perror("recv2"); |
99 | else |
100 | printf("recv2 %d\n", ret); |
101 | return -1; |
102 | } |
103 | |
104 | cpuid = packet1.header.cpuid; |
a2b8c5a5 |
105 | len = sizeof(packet1.header) + packet1.header.len; |
106 | if (check_len_override > 0) |
107 | len = check_len_override; |
108 | |
109 | if (memcmp(&packet1, &packet2, len) == 0) { |
5686d931 |
110 | pc_trace[cpuid][pc_trace_p[cpuid]++ & 3] = packet1.regs[0]; |
111 | continue; |
112 | } |
113 | |
a2b8c5a5 |
114 | if (packet1.header.cpuid != packet2.header.cpuid) |
115 | printf("%d: CPU %d %d\n", packet1.header.cpuid & 0xff, packet2.header.cpuid & 0xff); |
116 | else if (*(int *)&packet1.header != *(int *)&packet2.header) |
5686d931 |
117 | printf("%d: header\n", cnt); |
118 | |
119 | // check regs (and stuff) |
120 | for (i = 0; i < 1+24+2; i++) |
121 | if (packet1.regs[i] != packet2.regs[i]) |
122 | printf("%d: %3s: %08x %08x\n", cnt, regnames[i], packet1.regs[i], packet2.regs[i]); |
123 | |
124 | break; |
125 | } |
126 | |
a2b8c5a5 |
127 | printf("--\nCPU %d\n", cpuid); |
128 | for (cpuid = 0; cpuid < 2; cpuid++) { |
129 | printf("trace%d: ", cpuid); |
130 | for (i = 0; i < 4; i++) |
131 | printf(" %08x", pc_trace[cpuid][pc_trace_p[cpuid]++ & 3]); |
132 | |
133 | if (packet1.header.cpuid == cpuid) |
134 | printf(" %08x", packet1.regs[0]); |
135 | else if (packet2.header.cpuid == cpuid) |
136 | printf(" %08x", packet2.regs[0]); |
137 | printf("\n"); |
138 | } |
5686d931 |
139 | |
140 | for (i = 0; i < 24+1; i++) |
141 | printf("%3s: %08x %08x\n", regnames[i], packet1.regs[i], packet2.regs[i]); |
142 | |
143 | return 0; |
144 | } |
145 | |