skyeye2gdb.c

skyeye-1.2-RC7-3的源代码

	*buf++ = tohex (nib);
	nib = signo & 0x0f;
	*buf++ = tohex (nib);

	if (status == 'T') {
		buf = outreg (PC_REGNUM, buf);
		buf = outreg (FP_REGNUM, buf);
		buf = outreg (SP_REGNUM, buf);

	}
	/* For W and X, we're done.  */
	*buf++ = 0;
}

void
decode_m_packet (char *from, CORE_ADDR * mem_addr_ptr, unsigned int *len_ptr)
{
	int i = 0, j = 0;
	char ch;
	*mem_addr_ptr = *len_ptr = 0;

	while ((ch = from[i++]) != ',') {
		*mem_addr_ptr = *mem_addr_ptr << 4;
		*mem_addr_ptr |= fromhex (ch) & 0x0f;
	}

	for (j = 0; j < 4; j++) {
		if ((ch = from[i++]) == 0)
			break;
		*len_ptr = *len_ptr << 4;
		*len_ptr |= fromhex (ch) & 0x0f;
	}
}

void
decode_M_packet (char *from, CORE_ADDR * mem_addr_ptr, unsigned int *len_ptr,
		 char *to)
{
	int i = 0;
	char ch;
	*mem_addr_ptr = *len_ptr = 0;

	while ((ch = from[i++]) != ',') {
		*mem_addr_ptr = *mem_addr_ptr << 4;
		*mem_addr_ptr |= fromhex (ch) & 0x0f;
	}

	while ((ch = from[i++]) != ':') {
		*len_ptr = *len_ptr << 4;
		*len_ptr |= fromhex (ch) & 0x0f;
	}

	convert_ascii_to_int (&from[i++], to, *len_ptr);
}




void
fetch_inferior_registers (int regno, unsigned char *memory)
{
//koodailar add for mingw 2005.12.20--------------------------------------
#ifndef __MINGW32__
	if (regno == -1 || regno == 0)
		for (regno = 0; regno < NUM_REGS; regno++)
			sim_fetch_register (regno,
					    &(memory[REGISTER_BYTE (regno)]));
	else
		sim_fetch_register (regno, &(memory[REGISTER_BYTE (regno)]));
#endif
//end koodailar ----------------------------------------------------------
}

void
store_inferior_registers (int regno, unsigned char *memory)
{
//koodailar add for mingw 2005.12.20--------------------------------------
#ifndef __MINGW32__	
	if (regno == -1 || regno == 0)
		for (regno = 0; regno < NUM_REGS; regno++)
			sim_store_register (regno,
					    &(memory[REGISTER_BYTE (regno)]));
	else
		sim_store_register (regno, &(memory[REGISTER_BYTE (regno)]));
#endif
//end koodailar ----------------------------------------------------------		
}
int
sim_debug ()
{
//koodailar add for mingw 2005.12.20--------------------------------------
#ifndef __MINGW32__		
	static char own_buf[8000], mem_buf[8000];
	char *p;
	char ch, status;
	int i = 0;
	unsigned char signal;
	unsigned int len,addr;
	CORE_ADDR mem_addr;
	int type,size;

	//chy 2006-04-12 init skyeye_ice
	skyeye_ice.num_bps=0;

	if (setjmp (toplevel)) {
		fprintf (stderr, "Exiting\n");
		skyeye_exit (1);
	}
	while (1) {
		remote_open ("host:12345");

	      restart:
		setjmp (toplevel);
		while (getpkt (own_buf) > 0) {
			unsigned char sig;
			i = 0;
			ch = own_buf[i++];
			switch (ch) {
			case 'd':
				remote_debug = !remote_debug;
				break;
#if 0				// chy 2005-07-30
			case '!':
				extended_protocol = 1;
				prepare_resume_reply (own_buf, status,
						      signal);
				break;
#endif //chy
			case '?':
				status = 'S';
				signal = 1;
				prepare_resume_reply (own_buf, status,
						      signal);
				break;
#if 0				// chy 2005-07-30
			case 'H':
				switch (own_buf[1]) {
				case 'g':
					general_thread =
						strtol (&own_buf[2], NULL,
							16);
					write_ok (own_buf);
					fetch_inferior_registers (0);
					break;
				case 'c':
					cont_thread =
						strtol (&own_buf[2], NULL,
							16);
					write_ok (own_buf);
					break;
				default:
					/* Silently ignore it so that gdb can extend the protocol
					   without compatibility headaches.  */
					own_buf[0] = '\0';
					break;
				}
				break;
#endif //chy 2005-07-30
			case 'g':
				fetch_inferior_registers (0, registers);
				convert_int_to_ascii (registers, own_buf,
						      REGISTER_BYTES);
				break;
			case 'G':
				convert_ascii_to_int (&own_buf[1], registers,
						      REGISTER_BYTES);
				store_inferior_registers (-1, registers);
				write_ok (own_buf);
				break;
			case 'm':
				decode_m_packet (&own_buf[1], &mem_addr,
						 &len);
				size=sim_read (mem_addr, mem_buf, len);
				if(size!=-1)
					convert_int_to_ascii (mem_buf, own_buf, len);
				else 
					write_enn (own_buf);
				break;
			case 'M':
				decode_M_packet (&own_buf[1], &mem_addr, &len,
						 mem_buf);
				//chy 2005-07-30  ARM_BREAKPOINT          0xe7ffdefe
				//bp_opcode_conv( (unsigned long) mem_addr, (unsigned long*)mem_buf );                    
				//chy 2006-04-12 debug
				//printf("SKYEYE, debugger M  addr 0x%x, word 0x%x, len 0x%x\n", mem_addr, *((unsigned long *)mem_buf), len);  
				if (sim_write (mem_addr, mem_buf, len) == len)
					write_ok (own_buf);
				else
					write_enn (own_buf);
				break;
				/* chy 2005-07-28
				   case 'q':
				   switch (own_buf[1]) {
				   case 'C':
				   own_buf[0] = '\0';
				   break;
				   case 'O':
				   send_area(own_buf);
				   break;
				   default:
				   own_buf[0] = '\0';
				   break;
				   }
				   break;
				   case 'C':
				   convert_ascii_to_int (own_buf + 1, &sig, 1);
				   myresume (0, sig);
				   signal = mywait (&status);
				   prepare_resume_reply (own_buf, status, signal);
				   break;
				   case 'S':
				   convert_ascii_to_int (own_buf + 1, &sig, 1);
				   myresume (1, sig);
				   signal = mywait (&status);
				   prepare_resume_reply (own_buf, status, signal);
				   break;
				   chy */
			case 'c':
				//chy 2005-07-30
				//ARMul_DoProg (state);
				//sim_resume(0);
				gdbserver_cont();
				prepare_resume_reply (own_buf, status,
						      signal);
				break;
			case 's':
				//chy 2005-07-30
				//sim_resume(1);
				//sim_step_debug();
				//myresume (1, 0);
				//signal = mywait (&status);
				gdbserver_step();
				prepare_resume_reply (own_buf, status,
						      signal);
				break;
			case 'z':
				{
					p=&(own_buf[1]);
					type = strtoul(p, (char **)&p, 16);
					if (*p == ',')
					p++;
					addr = strtoul(p, (char **)&p, 16);
					if (*p == ',')
					p++;
					len = strtoul(p, (char **)&p, 16);
					//printf("SKYEYE:gdbserver z, type %d, addr %x, len %x\n",type, addr,len); 
					if (type == 0 || type == 1) {
					       if (sim_ice_breakpoint_remove(addr) < 0)
					                    goto remove_breakpoint_error;
					       write_ok(own_buf);
					} else {
					   remove_breakpoint_error:
						write_enn(own_buf);
					}
				}
				break;
			case 'Z':
				{
					p=&(own_buf[1]);
					type = strtoul(p, (char **)&p, 16);
					if (*p == ',')
					p++;
					addr = strtoul(p, (char **)&p, 16);
					if (*p == ',')
					p++;
					len = strtoul(p, (char **)&p, 16);
					//printf("SKYEYE:gdbserver Z, type %d, addr %x, len %x\n",type, addr,len); 
					if (type == 0 || type == 1) {
					       if (sim_ice_breakpoint_insert(addr) < 0)
					                    goto insert_breakpoint_error;
					       write_ok(own_buf);
					} else {
					   insert_breakpoint_error:
						write_enn(own_buf);
					}
				}
				break;
#if 0				// chy 2005-07-30
			case 'k':
				fprintf (stderr, "Killing inferior\n");
				kill_inferior ();
				/* When using the extended protocol, we start up a new
				   debugging session.   The traditional protocol will
				   exit instead.  */
				if (extended_protocol) {
					write_ok (own_buf);
					fprintf (stderr,
						 "GDBserver restarting\n");

					/* Wait till we are at 1st instruction in prog.  */
					//chy 20050729 go to restart
					//signal = start_inferior (&argv[2], &status);
					goto restart;
					break;
				}
				else {
					exit (0);
					break;
				}
			case 'T':
				if (mythread_alive
				    (strtol (&own_buf[1], NULL, 16)))
					write_ok (own_buf);
				else
					write_enn (own_buf);
				break;
			case 'R':
				/* Restarting the inferior is only supported in the
				   extended protocol.  */
				if (extended_protocol) {
					kill_inferior ();
					write_ok (own_buf);
					fprintf (stderr,
						 "GDBserver restarting\n");

					/* Wait till we are at 1st instruction in prog.  */
					//chy 20050729 go to restart
					//signal = start_inferior (&argv[2], &status);
					goto restart;
					break;
				}
				else {
					/* It is a request we don't understand.  Respond with an
					   empty packet so that gdb knows that we don't support this
					   request.  */
					own_buf[0] = '\0';
					break;
				}
#endif //chy 2005-07-30
			default:
				/* It is a request we don't understand.  Respond with an
				   empty packet so that gdb knows that we don't support this
				   request.  */
				DBG_RDI(stderr,"unknown command: %c\n",ch);
				own_buf[0] = '\0';
				break;
			}

			putpkt (own_buf);

			if (status == 'W')
				fprintf (stderr,
					 "\nChild exited with status %d\n",
					 sig);
			if (status == 'X')
				fprintf (stderr,
					 "\nChild terminated with signal = 0x%x\n",
					 sig);
			if (status == 'W' || status == 'X') {
				if (extended_protocol) {
					//chy 2005-07-30
					fprintf (stderr,
						 "CHY SkyEye: not Killing inferior\n");
					//kill_inferior ();
					write_ok (own_buf);
					fprintf (stderr,
						 "GDBserver restarting\n");

					/* Wait till we are at 1st instruction in prog.  */
					//chy 20050729 go to restart
					//signal = start_inferior (&argv[2], &status);
					goto restart;
					break;
				}
				else {
					fprintf (stderr,
						 "GDBserver exiting\n");
					skyeye_exit (0);
				}
			}
		}

		/* We come here when getpkt fails.

		   For the extended remote protocol we exit (and this is the only
		   way we gracefully exit!).

		   For the traditional remote protocol close the connection,
		   and re-open it at the top of the loop.  */
		if (extended_protocol) {
			remote_close ();
			skyeye_exit (0);
		}
		else {
			fprintf (stderr,
				 "Remote side has terminated connection.  GDBserver will reopen the connection.\n");

			remote_close ();
		}
	}
#else
	return 0;
#endif
//end koodailar ----------------------------------------------------------		
}
//added by linxz:
int remote_interrupt()
{
       static fd_set rfds;
       static struct timeval tv;

       tv.tv_sec = 0;
       tv.tv_usec = 0;
       FD_ZERO( &rfds );
       FD_SET( remote_desc, &rfds );

       if ( select( remote_desc+1, &rfds, NULL, NULL, &tv ) == 1 )
       {
               int n;
               static char buf[100];

               n = read( remote_desc, buf, sizeof(buf) );
               if ( n>0 )
                       DBG_RDI("Got async char");
               if ( buf[0] == '\003' )
                       DBG_RDI(":Ctrl+C, interrupted.\n");
               return 1;
       }
       return 0;
}