Mercurial > vba-clojure

     1 #include <cstdlib>

     2 #include <cstdio>

     3 #include <cstring>

     4 #include <config.h>

     5 

     6 #ifndef WIN32

     7 # include <unistd.h>

     8 # include <sys/socket.h>

     9 # include <netdb.h>

    10 # ifdef HAVE_NETINET_IN_H

    11 #  include <netinet/in.h>

    12 # endif // HAVE_NETINET_IN_H

    13 # ifdef HAVE_ARPA_INET_H

    14 #  include <arpa/inet.h>

    15 # else // ! HAVE_ARPA_INET_H

    16 #  define socklen_t int

    17 # endif // ! HAVE_ARPA_INET_H

    18 #else // WIN32

    19 # include "../win32/stdafx.h"

    20 # include <winsock.h>

    21 # include <io.h>

    22 # define socklen_t int

    23 # define close closesocket

    24 # define read _read

    25 # define write _write

    26 #endif // WIN32

    27 

    28 #include "GBA.h"

    29 #include "GBAGlobals.h"

    30 

    31 extern bool debugger;

    32 extern void CPUUpdateCPSR();

    33 #ifdef SDL

    34 extern void (*dbgMain)();

    35 extern void (*dbgSignal)(int, int);

    36 extern void debuggerMain();

    37 extern void debuggerSignal(int, int);

    38 #endif

    39 

    40 int  remotePort         = 55555;

    41 int  remoteSignal       = 5;

    42 int  remoteSocket       = -1;

    43 int  remoteListenSocket = -1;

    44 bool remoteConnected    = false;

    45 bool remoteResumed      = false;

    46 

    47 int  (*remoteSendFnc)(char *, int) = NULL;

    48 int  (*remoteRecvFnc)(char *, int) = NULL;

    49 bool (*remoteInitFnc)()    = NULL;

    50 void (*remoteCleanUpFnc)() = NULL;

    51 

    52 #if (defined WIN32 && !defined SDL)

    53 void remoteSetSockets(SOCKET l, SOCKET r)

    54 {

    55 	remoteSocket       = r;

    56 	remoteListenSocket = l;

    57 }

    58 

    59 #endif

    60 

    61 int remoteTcpSend(char *data, int len)

    62 {

    63 	return send(remoteSocket, data, len, 0);

    64 }

    65 

    66 int remoteTcpRecv(char *data, int len)

    67 {

    68 	return recv(remoteSocket, data, len, 0);

    69 }

    70 

    71 bool remoteTcpInit()

    72 {

    73 	if (remoteSocket == -1)

    74 	{

    75 #ifdef WIN32

    76 		WSADATA wsaData;

    77 		int     error = WSAStartup(MAKEWORD(1, 1), &wsaData);

    78 #endif // WIN32

    79 		int s = socket(PF_INET, SOCK_STREAM, 0);

    80 

    81 		remoteListenSocket = s;

    82 

    83 		if (s < 0)

    84 		{

    85 			fprintf(stderr, "Error opening socket\n");

    86 			exit(-1);

    87 		}

    88 		int tmp = 1;

    89 		setsockopt(s, SOL_SOCKET, SO_REUSEADDR, (char *) &tmp, sizeof(tmp));

    90 

    91 		//    char hostname[256];

    92 		//    gethostname(hostname, 256);

    93 

    94 		//    hostent *ent = gethostbyname(hostname);

    95 		//    unsigned long a = *((unsigned long *)ent->h_addr);

    96 

    97 		sockaddr_in addr;

    98 		addr.sin_family      = AF_INET;

    99 		addr.sin_port        = htons(remotePort);

   100 		addr.sin_addr.s_addr = htonl(0);

   101 		int count = 0;

   102 		while (count < 3)

   103 		{

   104 			if (bind(s, (sockaddr *)&addr, sizeof(addr)))

   105 			{

   106 				addr.sin_port = htons(ntohs(addr.sin_port)+1);

   107 			}

   108 			else

   109 				break;

   110 		}

   111 		if (count == 3)

   112 		{

   113 			fprintf(stderr, "Error binding \n");

   114 			exit(-1);

   115 		}

   116 

   117 		fprintf(stderr, "Listening for a connection at port %d\n",

   118 		        ntohs(addr.sin_port));

   119 

   120 		if (listen(s, 1))

   121 		{

   122 			fprintf(stderr, "Error listening\n");

   123 			exit(-1);

   124 		}

   125 		socklen_t len = sizeof(addr);

   126 

   127 #ifdef WIN32

   128 		int flag = 0;

   129 		ioctlsocket(s, FIONBIO, (unsigned long *)&flag);

   130 #endif // WIN32

   131 		int s2 = accept(s, (sockaddr *)&addr, &len);

   132 		if (s2 > 0)

   133 		{

   134 			fprintf(stderr, "Got a connection from %s %d\n",

   135 			        inet_ntoa((in_addr)addr.sin_addr),

   136 			        ntohs(addr.sin_port));

   137 		}

   138 		else

   139 		{

   140 #ifdef WIN32

   141 			int error = WSAGetLastError();

   142 #endif // WIN32

   143 		}

   144 		char dummy;

   145 		recv(s2, &dummy, 1, 0);

   146 		if (dummy != '+')

   147 		{

   148 			fprintf(stderr, "ACK not received\n");

   149 			exit(-1);

   150 		}

   151 		remoteSocket = s2;

   152 		//    close(s);

   153 	}

   154 	return true;

   155 }

   156 

   157 void remoteTcpCleanUp()

   158 {

   159 	if (remoteSocket > 0)

   160 	{

   161 		fprintf(stderr, "Closing remote socket\n");

   162 		close(remoteSocket);

   163 		remoteSocket = -1;

   164 	}

   165 	if (remoteListenSocket > 0)

   166 	{

   167 		fprintf(stderr, "Closing listen socket\n");

   168 		close(remoteListenSocket);

   169 		remoteListenSocket = -1;

   170 	}

   171 }

   172 

   173 int remotePipeSend(char *data, int len)

   174 {

   175 	int res = write(1, data, len);

   176 	return res;

   177 }

   178 

   179 int remotePipeRecv(char *data, int len)

   180 {

   181 	int res = read(0, data, len);

   182 	return res;

   183 }

   184 

   185 bool remotePipeInit()

   186 {

   187 	char dummy;

   188 	read(0, &dummy, 1);

   189 	if (dummy != '+')

   190 	{

   191 		fprintf(stderr, "ACK not received\n");

   192 		exit(-1);

   193 	}

   194 

   195 	return true;

   196 }

   197 

   198 void remotePipeCleanUp()

   199 {}

   200 

   201 void remoteSetPort(int port)

   202 {

   203 	remotePort = port;

   204 }

   205 

   206 void remoteSetProtocol(int p)

   207 {

   208 	if (p == 0)

   209 	{

   210 		remoteSendFnc    = remoteTcpSend;

   211 		remoteRecvFnc    = remoteTcpRecv;

   212 		remoteInitFnc    = remoteTcpInit;

   213 		remoteCleanUpFnc = remoteTcpCleanUp;

   214 	}

   215 	else

   216 	{

   217 		remoteSendFnc    = remotePipeSend;

   218 		remoteRecvFnc    = remotePipeRecv;

   219 		remoteInitFnc    = remotePipeInit;

   220 		remoteCleanUpFnc = remotePipeCleanUp;

   221 	}

   222 }

   223 

   224 void remoteInit()

   225 {

   226 	if (remoteInitFnc)

   227 		remoteInitFnc();

   228 }

   229 

   230 void remotePutPacket(char *packet)

   231 {

   232 	char *hex = "0123456789abcdef";

   233 	char  buffer[1024];

   234 

   235 	int count = strlen(packet);

   236 

   237 	unsigned char csum = 0;

   238 

   239 	char *p = buffer;

   240 	*p++ = '$';

   241 

   242 	for (int i = 0; i < count; i++)

   243 	{

   244 		csum += packet[i];

   245 		*p++  = packet[i];

   246 	}

   247 	*p++ = '#';

   248 	*p++ = hex[csum>>4];

   249 	*p++ = hex[csum & 15];

   250 	*p++ = 0;

   251 	//  printf("Sending %s\n", buffer);

   252 	remoteSendFnc(buffer, count + 4);

   253 

   254 	char c = 0;

   255 	remoteRecvFnc(&c, 1);

   256 	/*

   257 	   if(c == '+')

   258 	   printf("ACK\n");

   259 	   else if(c=='-')

   260 	   printf("NACK\n");

   261 	 */

   262 }

   263 

   264 void remoteOutput(char *s, u32 addr)

   265 {

   266 	char buffer[16384];

   267 

   268 	char *d = buffer;

   269 	*d++ = 'O';

   270 

   271 	if (s)

   272 	{

   273 		char c = *s++;

   274 		while (c)

   275 		{

   276 			sprintf(d, "%02x", c);

   277 			d += 2;

   278 			c  = *s++;

   279 		}

   280 	}

   281 	else

   282 	{

   283 		char c = debuggerReadByte(addr);

   284 		addr++;

   285 		while (c)

   286 		{

   287 			sprintf(d, "%02x", c);

   288 			d += 2;

   289 			c  = debuggerReadByte(addr);

   290 			addr++;

   291 		}

   292 	}

   293 	remotePutPacket(buffer);

   294 	//  fprintf(stderr, "Output sent %s\n", buffer);

   295 }

   296 

   297 void remoteSendSignal()

   298 {

   299 	char buffer[1024];

   300 	sprintf(buffer, "S%02x", remoteSignal);

   301 	remotePutPacket(buffer);

   302 }

   303 

   304 void remoteSendStatus()

   305 {

   306 	char buffer[1024];

   307 	sprintf(buffer, "T%02x", remoteSignal);

   308 	char *s = buffer;

   309 	s += 3;

   310 	for (int i = 0; i < 15; i++)

   311 	{

   312 		u32 v = reg[i].I;

   313 		sprintf(s, "%02x:%02x%02x%02x%02x;", i,

   314 		        (v & 255),

   315 		        (v >> 8) & 255,

   316 		        (v >> 16) & 255,

   317 		        (v >> 24) & 255);

   318 		s += 12;

   319 	}

   320 	u32 v = armNextPC;

   321 	sprintf(s, "0f:%02x%02x%02x%02x;", (v & 255),

   322 	        (v >> 8) & 255,

   323 	        (v >> 16) & 255,

   324 	        (v >> 24) & 255);

   325 	s += 12;

   326 	CPUUpdateCPSR();

   327 	v = reg[16].I;

   328 	sprintf(s, "19:%02x%02x%02x%02x;", (v & 255),

   329 	        (v >> 8) & 255,

   330 	        (v >> 16) & 255,

   331 	        (v >> 24) & 255);

   332 	s += 12;

   333 	*s = 0;

   334 	//  printf("Sending %s\n", buffer);

   335 	remotePutPacket(buffer);

   336 }

   337 

   338 void remoteBinaryWrite(char *p)

   339 {

   340 	u32 address;

   341 	int count;

   342 	sscanf(p, "%x,%x:", &address, &count);

   343 	//  printf("Binary write for %08x %d\n", address, count);

   344 

   345 	p = strchr(p, ':');

   346 	p++;

   347 	for (int i = 0; i < count; i++)

   348 	{

   349 		u8 b = *p++;

   350 		switch (b)

   351 		{

   352 		case 0x7d:

   353 			b = *p++;

   354 			debuggerWriteByte(address, (b^0x20));

   355 			address++;

   356 			break;

   357 		default:

   358 			debuggerWriteByte(address, b);

   359 			address++;

   360 			break;

   361 		}

   362 	}

   363 	//  printf("ROM is %08x\n", debuggerReadMemory(0x8000254));

   364 	remotePutPacket("OK");

   365 }

   366 

   367 void remoteMemoryWrite(char *p)

   368 {

   369 	u32 address;

   370 	int count;

   371 	sscanf(p, "%x,%x:", &address, &count);

   372 	//  printf("Memory write for %08x %d\n", address, count);

   373 

   374 	p = strchr(p, ':');

   375 	p++;

   376 	for (int i = 0; i < count; i++)

   377 	{

   378 		u8   v = 0;

   379 		char c = *p++;

   380 		if (c <= '9')

   381 			v = (c - '0') << 4;

   382 		else

   383 			v = (c + 10 - 'a') << 4;

   384 		c = *p++;

   385 		if (c <= '9')

   386 			v += (c - '0');

   387 		else

   388 			v += (c + 10 - 'a');

   389 		debuggerWriteByte(address, v);

   390 		address++;

   391 	}

   392 	//  printf("ROM is %08x\n", debuggerReadMemory(0x8000254));

   393 	remotePutPacket("OK");

   394 }

   395 

   396 void remoteMemoryRead(char *p)

   397 {

   398 	u32 address;

   399 	int count;

   400 	sscanf(p, "%x,%x:", &address, &count);

   401 	//  printf("Memory read for %08x %d\n", address, count);

   402 

   403 	char buffer[1024];

   404 

   405 	char *s = buffer;

   406 	for (int i = 0; i < count; i++)

   407 	{

   408 		u8 b = debuggerReadByte(address);

   409 		sprintf(s, "%02x", b);

   410 		address++;

   411 		s += 2;

   412 	}

   413 	*s = 0;

   414 	remotePutPacket(buffer);

   415 }

   416 

   417 void remoteStepOverRange(char *p)

   418 {

   419 	u32 address;

   420 	u32 final;

   421 	sscanf(p, "%x,%x", &address, &final);

   422 

   423 	remotePutPacket("OK");

   424 

   425 	remoteResumed = true;

   426 	do

   427 	{

   428 		CPULoop(1);

   429 		if (debugger)

   430 			break;

   431 	}

   432 	while (armNextPC >= address && armNextPC < final);

   433 

   434 	remoteResumed = false;

   435 

   436 	remoteSendStatus();

   437 }

   438 

   439 void remoteWriteWatch(char *p, bool active)

   440 {

   441 	u32 address;

   442 	int count;

   443 	sscanf(p, ",%x,%x#", &address, &count);

   444 

   445 	fprintf(stderr, "Write watch for %08x %d\n", address, count);

   446 

   447 	if (address < 0x2000000 || address > 0x3007fff)

   448 	{

   449 		remotePutPacket("E01");

   450 		return;

   451 	}

   452 

   453 	if (address > 0x203ffff && address < 0x3000000)

   454 	{

   455 		remotePutPacket("E01");

   456 		return;

   457 	}

   458 

   459 	u32 final = address + count;

   460 

   461 	if (address < 0x2040000 && final > 0x2040000)

   462 	{

   463 		remotePutPacket("E01");

   464 		return;

   465 	}

   466 	else if (address < 0x3008000 && final > 0x3008000)

   467 	{

   468 		remotePutPacket("E01");

   469 		return;

   470 	}

   471 

   472 	for (int i = 0; i < count; i++)

   473 	{

   474 		if ((address >> 24) == 2)

   475 			freezeWorkRAM[address & 0x3ffff] = active;

   476 		else

   477 			freezeInternalRAM[address & 0x7fff] = active;

   478 		address++;

   479 	}

   480 

   481 	remotePutPacket("OK");

   482 }

   483 

   484 void remoteReadRegisters(char *p)

   485 {

   486 	char buffer[1024];

   487 

   488 	char *s = buffer;

   489 	int   i;

   490 	// regular registers

   491 	for (i = 0; i < 15; i++)

   492 	{

   493 		u32 v = reg[i].I;

   494 		sprintf(s, "%02x%02x%02x%02x",  v & 255, (v >> 8) & 255,

   495 		        (v >> 16) & 255, (v >> 24) & 255);

   496 		s += 8;

   497 	}

   498 	// PC

   499 	u32 pc = armNextPC;

   500 	sprintf(s, "%02x%02x%02x%02x", pc & 255, (pc >> 8) & 255,

   501 	        (pc >> 16) & 255, (pc >> 24) & 255);

   502 	s += 8;

   503 

   504 	// floating point registers (24-bit)

   505 	for (i = 0; i < 8; i++)

   506 	{

   507 		sprintf(s, "000000000000000000000000");

   508 		s += 24;

   509 	}

   510 

   511 	// FP status register

   512 	sprintf(s, "00000000");

   513 	s += 8;

   514 	// CPSR

   515 	CPUUpdateCPSR();

   516 	u32 v = reg[16].I;

   517 	sprintf(s, "%02x%02x%02x%02x",  v & 255, (v >> 8) & 255,

   518 	        (v >> 16) & 255, (v >> 24) & 255);

   519 	s += 8;

   520 	*s = 0;

   521 	remotePutPacket(buffer);

   522 }

   523 

   524 void remoteWriteRegister(char *p)

   525 {

   526 	int r;

   527 

   528 	sscanf(p, "%x=", &r);

   529 

   530 	p = strchr(p, '=');

   531 	p++;

   532 

   533 	char c = *p++;

   534 

   535 	u32 v = 0;

   536 

   537 	u8 data[4] = {0, 0, 0, 0};

   538 

   539 	int i = 0;

   540 

   541 	while (c != '#')

   542 	{

   543 		u8 b = 0;

   544 		if (c <= '9')

   545 			b = (c - '0') << 4;

   546 		else

   547 			b = (c + 10 - 'a') << 4;

   548 		c = *p++;

   549 		if (c <= '9')

   550 			b += (c - '0');

   551 		else

   552 			b += (c + 10 - 'a');

   553 		data[i++] = b;

   554 		c         = *p++;

   555 	}

   556 

   557 	v = data[0] | (data[1] << 8) | (data[2] << 16) | (data[3] << 24);

   558 

   559 	//  printf("Write register %d=%08x\n", r, v);

   560 	reg[r].I = v;

   561 	if (r == 15)

   562 	{

   563 		armNextPC = v;

   564 		if (armState)

   565 			reg[15].I = v + 4;

   566 		else

   567 			reg[15].I = v + 2;

   568 	}

   569 	remotePutPacket("OK");

   570 }

   571 

   572 void remoteStubMain()

   573 {

   574 	if (!debugger)

   575 		return;

   576 

   577 	if (remoteResumed)

   578 	{

   579 		remoteSendStatus();

   580 		remoteResumed = false;

   581 	}

   582 

   583 	while (true)

   584 	{

   585 		char buffer[1024];

   586 		int  res = remoteRecvFnc(buffer, 1024);

   587 

   588 		if (res == -1)

   589 		{

   590 			fprintf(stderr, "GDB connection lost\n");

   591 #ifdef SDL

   592 			dbgMain   = debuggerMain;

   593 			dbgSignal = debuggerSignal;

   594 #endif

   595 			debugger = false;

   596 			break;

   597 		}

   598 

   599 		//    fprintf(stderr, "Received %s\n", buffer);

   600 		char *p  = buffer;

   601 		char  c  = *p++;

   602 		char  pp = '+';

   603 		remoteSendFnc(&pp, 1);

   604 

   605 		if (c != '$')

   606 			continue;

   607 		c = *p++;

   608 		switch (c)

   609 		{

   610 		case '?':

   611 			remoteSendSignal();

   612 			break;

   613 		case 'D':

   614 			remotePutPacket("OK");

   615 #ifdef SDL

   616 			dbgMain   = debuggerMain;

   617 			dbgSignal = debuggerSignal;

   618 #endif

   619 			remoteResumed = true;

   620 			debugger      = false;

   621 			return;

   622 		case 'e':

   623 			remoteStepOverRange(p);

   624 			break;

   625 		case 'k':

   626 			remotePutPacket("OK");

   627 #ifdef SDL

   628 			dbgMain   = debuggerMain;

   629 			dbgSignal = debuggerSignal;

   630 #endif

   631 			debugger  = false;

   632 			emulating = false;

   633 			return;

   634 		case 'C':

   635 			remoteResumed = true;

   636 			debugger      = false;

   637 			return;

   638 		case 'c':

   639 			remoteResumed = true;

   640 			debugger      = false;

   641 			return;

   642 		case 's':

   643 			remoteResumed = true;

   644 			remoteSignal  = 5;

   645 			CPULoop(1);

   646 			if (remoteResumed)

   647 			{

   648 				remoteResumed = false;

   649 				remoteSendStatus();

   650 			}

   651 			break;

   652 		case 'g':

   653 			remoteReadRegisters(p);

   654 			break;

   655 		case 'P':

   656 			remoteWriteRegister(p);

   657 			break;

   658 		case 'M':

   659 			remoteMemoryWrite(p);

   660 			break;

   661 		case 'm':

   662 			remoteMemoryRead(p);

   663 			break;

   664 		case 'X':

   665 			remoteBinaryWrite(p);

   666 			break;

   667 		case 'H':

   668 			remotePutPacket("OK");

   669 			break;

   670 		case 'q':

   671 			remotePutPacket("");

   672 			break;

   673 		case 'Z':

   674 			if (*p++ == '2')

   675 			{

   676 				remoteWriteWatch(p, true);

   677 			}

   678 			else

   679 				remotePutPacket("");

   680 			break;

   681 		case 'z':

   682 			if (*p++ == '2')

   683 			{

   684 				remoteWriteWatch(p, false);

   685 			}

   686 			else

   687 				remotePutPacket("");

   688 			break;

   689 		default:

   690 		{

   691 			*(strchr(p, '#') + 3) = 0;

   692 			fprintf(stderr, "Unknown packet %s\n", --p);

   693 			remotePutPacket("");

   694 			break;

   695 		}

   696 		}

   697 	}

   698 }

   699 

   700 void remoteStubSignal(int sig, int number)

   701 {

   702 	remoteSignal  = sig;

   703 	remoteResumed = false;

   704 	remoteSendStatus();

   705 	debugger = true;

   706 }

   707 

   708 void remoteCleanUp()

   709 {

   710 	if (remoteCleanUpFnc)

   711 		remoteCleanUpFnc();

   712 }

   713
author	Robert McIntyre <rlm@mit.edu>
date	Sun, 11 Mar 2012 19:07:31 -0500
parents	8870086b716c
children