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   socklen_t sal;
  27
  28   memset(&hints, 0, sizeof(hints));
  29   hints.ai_flags = AI_CANONNAME;
  30   hints.ai_family = PF_UNSPEC;
  31   hints.ai_socktype = SOCK_STREAM;
  32
  33   ret = getaddrinfo("::", "1234", &hints, &ais);
  34   if (ret != 0)
  35     return -1;
  36
  37   for (ai = ais; ai != NULL; ai = ai->ai_next) {
  38     sock = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol);
  39     if (sock == -1)
  40       continue;
  41
  42     ret = bind(sock, ai->ai_addr, ai->ai_addrlen);
  43     if (ret != 0) {
  44       close(sock);
  45       sock = -1;
  46       continue;
  47     }
  48     break;
  49   }
  50   freeaddrinfo(ais);
  51
  52   if (sock == -1) {
  53     perror("failed to bind");
  54     return -1;
  55   }
  56
  57   ret = listen(sock, SOMAXCONN);
  58   if (ret != 0) {
  59     perror("failed to listen");
  60     return -1;
  61   }
  62
  63   sal = sizeof(sa);
  64   sock1 = accept(sock, (struct sockaddr *)&sa, &sal);
  65   if (sock1 == -1) {
  66     perror("failed to accept");
  67     return -1;
  68   }
  69   printf("client1 connected\n");
  70
  71   sal = sizeof(sa);
  72   sock2 = accept(sock, (struct sockaddr *)&sa, &sal);
  73   if (sock2 == -1) {
  74     perror("failed to accept");
  75     return -1;
  76   }
  77   printf("client2 connected\n");
  78
  79   for (cnt = 0; ; cnt++)
  80   {
  81 #define tmp_size (4+4 + 24*4 + 2*4)
  82     ret = recv(sock1, &packet1, tmp_size, MSG_WAITALL);
  83     if (ret != tmp_size) {
  84       if (ret < 0)
  85         perror("recv1");
  86       else
  87         printf("recv1 %d\n", ret);
  88       return -1;
  89     }
  90     ret = recv(sock2, &packet2, tmp_size, MSG_WAITALL);
  91     if (ret != tmp_size) {
  92       if (ret < 0)
  93         perror("recv2");
  94       else
  95         printf("recv2 %d\n", ret);
  96       return -1;
  97     }
  98
  99     cpuid = packet1.header.cpuid;
 100     if (memcmp(&packet1, &packet2, sizeof(packet1.header) + packet1.header.len) == 0) {
 101       pc_trace[cpuid][pc_trace_p[cpuid]++ & 3] = packet1.regs[0];
 102       continue;
 103     }
 104
 105     if (*(int *)&packet1.header != *(int *)&packet2.header)
 106       printf("%d: header\n", cnt);
 107
 108     // check regs (and stuff)
 109     for (i = 0; i < 1+24+2; i++)
 110       if (packet1.regs[i] != packet2.regs[i])
 111         printf("%d: %3s: %08x %08x\n", cnt, regnames[i], packet1.regs[i], packet2.regs[i]);
 112
 113     break;
 114   }
 115
 116   printf("--\nCPU %d, trace:", cpuid);
 117   for (i = 0; i < 4; i++)
 118     printf(" %08x", pc_trace[cpuid][pc_trace_p[cpuid]++ & 3]);
 119   printf(" %08x\n", packet1.regs[0]);
 120
 121   for (i = 0; i < 24+1; i++)
 122     printf("%3s: %08x %08x\n", regnames[i], packet1.regs[i], packet2.regs[i]);
 123
 124   return 0;
 125 }
 126