private string WriteMemory(GDBPacket packet)
{
var parameters = packet.GetCommandParameters();
if (parameters.Length < 3)
{
return(GetErrorAnswer(Errno.ENOENT));
}
var arg1 = Convert.ToUInt32(parameters[0], 16);
var arg2 = Convert.ToUInt32(parameters[1], 16);
if (arg1 > ushort.MaxValue || arg2 > ushort.MaxValue)
{
return(GetErrorAnswer(Errno.ENOENT));
}
var addr = (ushort)arg1;
var length = (ushort)arg2;
for (var i = 0; i < length; i++)
{
var hex = parameters[2].Substring(i * 2, 2);
var value = Convert.ToByte(hex, 16);
_emulator.CPU.WRMEM((ushort)(addr + i), value);
}
return(StandartAnswers.OK);
}
private string GeneralQueryResponse(GDBPacket packet)
{
string command = packet.GetCommandParameters()[0];
if (command.StartsWith("Supported"))
{
return("PacketSize=4000");
}
if (command.StartsWith("C"))
{
return(StandartAnswers.Empty);
}
if (command.StartsWith("Attached"))
{
return("1");
}
if (command.StartsWith("TStatus"))
{
return(StandartAnswers.Empty);
}
if (command.StartsWith("Offset"))
{
return(StandartAnswers.Error);
}
return(StandartAnswers.OK);
}
private string ReadMemory(GDBPacket packet)
{
var parameters = packet.GetCommandParameters();
if (parameters.Length < 2)
{
return(GetErrorAnswer(Errno.EPERM));
}
var arg1 = Convert.ToUInt32(parameters[0], 16);
var arg2 = Convert.ToUInt32(parameters[1], 16);
if (arg1 > ushort.MaxValue || arg2 > ushort.MaxValue)
{
return(GetErrorAnswer(Errno.EPERM));
}
var addr = (ushort)arg1;
var length = (ushort)arg2;
var result = string.Empty;
for (var i = 0; i < length; i++)
{
var hex = _emulator.CPU.RDMEM((ushort)(addr + i))
.ToLowEndianHexString();
result += hex;
}
return(result);
}
private string ReadRegisters(GDBPacket packet)
{
var values = Enumerable.Range(0, RegistersCount - 1)
.Select(i => GetRegisterAsHex(i))
.ToArray();
return(String.Join("", values));
}
private string WriteRegisters(GDBPacket packet)
{
var regsData = packet.GetCommandParameters()[0];
for (int i = 0, pos = 0; i < RegistersCount; i++)
{
int currentRegisterLength = GetRegisterSize(i) == RegisterSize.Word ? 4 : 2;
SetRegister(i, regsData.Substring(pos, currentRegisterLength));
pos += currentRegisterLength;
}
return(StandartAnswers.OK);
}
private string ExecutionRequest(GDBPacket packet)
{
string command = packet.GetCommandParameters()[0];
if (command.StartsWith("Cont?"))
{
return("");
}
if (command.StartsWith("Cont"))
{
}
return(StandartAnswers.Empty);
}
private string SetRegister(GDBPacket packet)
{
var parameters = packet.GetCommandParameters()[0].Split(new char[] { '=' });
if (SetRegister(Convert.ToInt32(parameters[0], 16), parameters[1]))
{
return(StandartAnswers.OK);
}
else
{
return(StandartAnswers.Error);
}
}
private string RemoveBreakpoint(GDBPacket packet)
{
string[] parameters = packet.GetCommandParameters();
Breakpoint.BreakpointType type = Breakpoint.GetBreakpointType(int.Parse(parameters[0]));
ushort addr = Convert.ToUInt16(parameters[1], 16);
if (type == Breakpoint.BreakpointType.Execution)
{
_emulator.RemoveBreakpoint(new ZXMAK2.Engine.Entities.Breakpoint(addr));
}
else
{
_jtagDevice.RemoveBreakpoint(addr);
}
return(StandartAnswers.OK);
}
private void GDBClientConnected(object client)
{
TcpClient tcpClient = (TcpClient)client;
NetworkStream clientStream = tcpClient.GetStream();
GDBSession session = new GDBSession(_emulator, _jtagDevice);
byte[] message = new byte[0x1000];
int bytesRead;
// log = new StreamWriter("c:\\temp\\log.txt");
// log.AutoFlush = true;
_emulator.DoStop();
while (true)
{
bytesRead = 0;
try
{
bytesRead = clientStream.Read(message, 0, 4096);
}
catch (IOException iex)
{
var sex = iex.InnerException as SocketException;
if (sex == null || sex.ErrorCode != 10004)
{
Logger.Error(sex);
}
break;
}
catch (SocketException sex)
{
if (sex.ErrorCode != 10004)
{
Logger.Error(sex);
}
break;
}
catch (Exception ex)
{
Logger.Error(ex);
break;
}
if (bytesRead == 0)
{
//the client has disconnected from the server
break;
}
if (bytesRead > 0)
{
GDBPacket packet = new GDBPacket(message, bytesRead);
if (_jtagDevice.Log)
{
Logger.Info("--> {0}", packet);
}
bool isSignal;
string response = session.ParseRequest(packet, out isSignal);
if (response != null)
{
if (isSignal)
{
SendGlobal(response);
}
else
{
SendResponse(clientStream, response);
}
}
}
}
tcpClient.Close();
}
private string GetRegister(GDBPacket packet)
{
return(GetRegisterAsHex(Convert.ToInt32(packet.GetCommandParameters()[0], 16)));
}
private string GetTargetHaltedReason(GDBPacket packet)
{
return(StandartAnswers.HaltedReason);
}
public string ParseRequest(GDBPacket packet, out bool isSignal)
{
var result = StandartAnswers.Empty;
isSignal = false;
// ctrl+c is SIGINT
if (packet.GetBytes()[0] == 0x03)
{
_emulator.DoStop();
result = StandartAnswers.Interrupt;
isSignal = true;
}
try
{
switch (packet.CommandName)
{
case '\0': // Command is empty ("+" in 99.99% cases)
return(null);
case 'q':
result = GeneralQueryResponse(packet); break;
case 'Q':
result = GeneralQueryResponse(packet); break;
case '?':
result = GetTargetHaltedReason(packet); break;
case '!': // extended connection
break;
case 'g': // read registers
result = ReadRegisters(packet); break;
case 'G': // write registers
result = WriteRegisters(packet); break;
case 'm': // read memory
result = ReadMemory(packet); break;
case 'M': // write memory
result = WriteMemory(packet); break;
case 'X': // write memory binary
// Not implemented yet, client shoul use M instead
//result = StandartAnswers.OK;
break;
case 'p': // get single register
result = GetRegister(packet); break;
case 'P': // set single register
result = SetRegister(packet); break;
case 'v': // some requests, mainly vCont
result = ExecutionRequest(packet); break;
case 's': //stepi
_emulator.CPU.ExecCycle();
result = "T05";
break;
case 'z': // remove bp
result = RemoveBreakpoint(packet);
break;
case 'Z': // insert bp
result = SetBreakpoint(packet);
break;
case 'k': // Kill the target
break;
case 'H': // set thread
result = StandartAnswers.OK; // we do not have threads, so ignoring this command is OK
break;
case 'c': // continue
_emulator.DoRun();
result = null;
break;
case 'D': // Detach from client
_emulator.DoRun();
result = StandartAnswers.OK;
break;
}
}
catch (Exception ex)
{
Logger.Error(ex);
result = GetErrorAnswer(Errno.EPERM);
}
if (result == null)
{
return("+");
}
else
{
return(FormatResponse(result));
}
}
public static string FormatResponse(string response)
{
return("+$" + response + "#" + GDBPacket.CalculateCRC(response));
}
