Try to add support for VFP registers
This commit is contained in:
		| @@ -56,6 +56,7 @@ const u32 MSG_WAITALL = 8; | ||||
| const u32 R0_REGISTER = 0; | ||||
| const u32 R15_REGISTER = 15; | ||||
| const u32 CSPR_REGISTER = 25; | ||||
| const u32 FPSCR_REGISTER = 58; | ||||
|  | ||||
| namespace GDBStub { | ||||
|  | ||||
| @@ -468,6 +469,10 @@ static void ReadRegister() { | ||||
|         IntToHex(reply, Core::g_app_core->GetReg(id)); | ||||
|     } else if (id == CSPR_REGISTER) { | ||||
|         IntToHex(reply, Core::g_app_core->GetCPSR()); | ||||
|     } else if (id > CSPR_REGISTER && id < FPSCR_REGISTER) { | ||||
|         IntToHex(reply, Core::g_app_core->GetVFPReg(id - CSPR_REGISTER - 1)); // VFP registers should start at 26, so one after CSPR_REGISTER | ||||
|     } else if (id == FPSCR_REGISTER) { | ||||
|         IntToHex(reply, Core::g_app_core->GetVFPSystemReg(VFP_FPSCR)); // Get FPSCR | ||||
|     } else { | ||||
|         return SendReply("E01"); | ||||
|     } | ||||
| @@ -481,15 +486,19 @@ static void ReadRegisters() { | ||||
|     memset(buffer, 0, sizeof(buffer)); | ||||
|  | ||||
|     u8* bufptr = buffer; | ||||
|     for (int i = 0; i <= CSPR_REGISTER; i++) { | ||||
|     for (int i = 0; i <= FPSCR_REGISTER; i++) { | ||||
|         if (i <= R15_REGISTER) { | ||||
|             IntToHex(bufptr + i * 8, Core::g_app_core->GetReg(i)); | ||||
|         } else if (i == CSPR_REGISTER) { | ||||
|             IntToHex(bufptr + i * 8, Core::g_app_core->GetCPSR()); | ||||
|         } else { | ||||
|         } else if (i < CSPR_REGISTER) { | ||||
|             IntToHex(bufptr + i * 8, 0); | ||||
|             IntToHex(bufptr + (i + 1) * 8, 0); | ||||
|             i++; // These registers seem to be all 64bit instead of 32bit, so skip two instead of one | ||||
|         } else if (i > CSPR_REGISTER && i < FPSCR_REGISTER) { | ||||
|             IntToHex(bufptr + i * 8, Core::g_app_core->GetVFPReg(i - CSPR_REGISTER - 1)); | ||||
|         } else if (i == FPSCR_REGISTER) { | ||||
|             IntToHex(bufptr + i * 8, Core::g_app_core->GetVFPSystemReg(VFP_FPSCR)); | ||||
|         } | ||||
|     } | ||||
|  | ||||
| @@ -511,6 +520,10 @@ static void WriteRegister() { | ||||
|         Core::g_app_core->SetReg(id, HexToInt(buffer_ptr)); | ||||
|     } else if (id == CSPR_REGISTER) { | ||||
|         Core::g_app_core->SetCPSR(HexToInt(buffer_ptr)); | ||||
|     } else if (id > CSPR_REGISTER && id < FPSCR_REGISTER) { | ||||
|         Core::g_app_core->SetVFPReg(id - CSPR_REGISTER - 1, HexToInt(buffer_ptr)); | ||||
|     } else if (id == FPSCR_REGISTER) { | ||||
|         Core::g_app_core->SetVFPSystemReg(VFP_FPSCR, HexToInt(buffer_ptr)); | ||||
|     } else { | ||||
|         return SendReply("E01"); | ||||
|     } | ||||
| @@ -525,13 +538,17 @@ static void WriteRegisters() { | ||||
|     if (command_buffer[0] != 'G') | ||||
|         return SendReply("E01"); | ||||
|  | ||||
|     for (int i = 0; i <= CSPR_REGISTER; i++) { | ||||
|     for (int i = 0; i <= FPSCR_REGISTER; i++) { | ||||
|         if (i <= R15_REGISTER) { | ||||
|             Core::g_app_core->SetReg(i, HexToInt(buffer_ptr + i * 8)); | ||||
|         } else if (i == CSPR_REGISTER) { | ||||
|             Core::g_app_core->SetCPSR(HexToInt(buffer_ptr + i * 8)); | ||||
|         } else { | ||||
|         } else if (i < CSPR_REGISTER) { | ||||
|             i++; // These registers seem to be all 64bit instead of 32bit, so skip two instead of one | ||||
|         } else if (i > CSPR_REGISTER && i < FPSCR_REGISTER) { | ||||
|             Core::g_app_core->SetVFPReg(i - CSPR_REGISTER - 1, HexToInt(buffer_ptr + i * 8)); | ||||
|         } else if (i == FPSCR_REGISTER) { | ||||
|             Core::g_app_core->SetVFPSystemReg(VFP_FPSCR, HexToInt(buffer_ptr + i * 8)); | ||||
|         } | ||||
|     } | ||||
|  | ||||
|   | ||||
		Reference in New Issue
	
	Block a user