cpu/debug_net.c

   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;
  26   int check_len_override = 0;
  27   socklen_t sal;
  28
  29   if (argv[1] != NULL)
  30     check_len_override = atoi(argv[1]);
  31
  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   {
  85     int len;
  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;
 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) {
 110       pc_trace[cpuid][pc_trace_p[cpuid]++ & 3] = packet1.regs[0];
 111       continue;
 112     }
 113
 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)
 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
 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   }
 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