2021-08-15 01:47:48 +01:00
|
|
|
#include "TargetController.hpp"
|
|
|
|
|
|
2021-04-04 21:04:12 +01:00
|
|
|
#include <thread>
|
|
|
|
|
#include <filesystem>
|
|
|
|
|
#include <typeindex>
|
2021-09-11 20:39:31 +01:00
|
|
|
#include <algorithm>
|
2021-04-04 21:04:12 +01:00
|
|
|
|
|
|
|
|
#include "src/Application.hpp"
|
2021-05-30 19:05:18 +01:00
|
|
|
#include "src/Helpers/Paths.hpp"
|
2021-10-06 21:12:31 +01:00
|
|
|
#include "src/Logger/Logger.hpp"
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2021-08-15 01:47:48 +01:00
|
|
|
#include "src/TargetController/Exceptions/DeviceFailure.hpp"
|
|
|
|
|
#include "src/TargetController/Exceptions/TargetOperationFailure.hpp"
|
|
|
|
|
#include "src/Exceptions/TargetControllerStartupFailure.hpp"
|
|
|
|
|
#include "src/Exceptions/InvalidConfig.hpp"
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
namespace Bloom
|
|
|
|
|
{
|
|
|
|
|
using namespace Bloom::Targets;
|
|
|
|
|
using namespace Bloom::Events;
|
|
|
|
|
using namespace Bloom::Exceptions;
|
|
|
|
|
|
|
|
|
|
void TargetController::run() {
|
|
|
|
|
try {
|
|
|
|
|
this->startup();
|
|
|
|
|
|
|
|
|
|
this->setThreadStateAndEmitEvent(ThreadState::READY);
|
|
|
|
|
Logger::debug("TargetController ready and waiting for events.");
|
|
|
|
|
|
|
|
|
|
while (this->getThreadState() == ThreadState::READY) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->state == TargetControllerState::ACTIVE) {
|
|
|
|
|
this->fireTargetEvents();
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->waitAndDispatch(60);
|
|
|
|
|
|
|
|
|
|
} catch (const DeviceFailure& exception) {
|
|
|
|
|
/*
|
|
|
|
|
* Upon a device failure, we assume Bloom has lost control of the debug tool. This could be the
|
|
|
|
|
* result of the user disconnecting the debug tool, or issuing a soft reset. The soft reset could
|
|
|
|
|
* have been issued via another application, without the user's knowledge.
|
|
|
|
|
* See https://github.com/navnavnav/Bloom/issues/3 for more on that.
|
|
|
|
|
*
|
|
|
|
|
* The TC will go into a suspended state and the DebugServer should terminate any active debug
|
|
|
|
|
* session. When the user attempts to start another debug session, we will try to re-connect to the
|
|
|
|
|
* debug tool.
|
|
|
|
|
*/
|
|
|
|
|
Logger::error("Device failure detected - " + exception.getMessage());
|
|
|
|
|
Logger::error("Suspending TargetController");
|
|
|
|
|
this->suspend();
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetControllerStartupFailure& exception) {
|
|
|
|
|
Logger::error("TargetController failed to startup. See below for errors:");
|
|
|
|
|
Logger::error(exception.getMessage());
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const Exception& exception) {
|
|
|
|
|
Logger::error("The TargetController encountered a fatal error. See below for errors:");
|
|
|
|
|
Logger::error(exception.getMessage());
|
|
|
|
|
|
|
|
|
|
} catch (const std::exception& exception) {
|
|
|
|
|
Logger::error("The TargetController encountered a fatal error. See below for errors:");
|
|
|
|
|
Logger::error(std::string(exception.what()));
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->shutdown();
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::startup() {
|
|
|
|
|
this->setName("TC");
|
|
|
|
|
Logger::info("Starting TargetController");
|
|
|
|
|
this->setThreadState(ThreadState::STARTING);
|
|
|
|
|
this->blockAllSignalsOnCurrentThread();
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::registerListener(this->eventListener);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
// Install Bloom's udev rules if not already installed
|
|
|
|
|
TargetController::checkUdevRules();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
// Register event handlers
|
|
|
|
|
this->eventListener->registerCallbackForEventType<Events::ReportTargetControllerState>(
|
|
|
|
|
std::bind(&TargetController::onStateReportRequest, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::ShutdownTargetController>(
|
|
|
|
|
std::bind(&TargetController::onShutdownTargetControllerEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::DebugSessionStarted>(
|
|
|
|
|
std::bind(&TargetController::onDebugSessionStartedEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->resume();
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::checkUdevRules() {
|
|
|
|
|
auto bloomRulesPath = std::string("/etc/udev/rules.d/99-bloom.rules");
|
|
|
|
|
auto latestBloomRulesPath = Paths::resourcesDirPath() + "/UDevRules/99-bloom.rules";
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!std::filesystem::exists(bloomRulesPath)) {
|
|
|
|
|
Logger::warning("Bloom udev rules missing - attempting installation");
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
// We can only install them if we're running as root
|
|
|
|
|
if (!Application::isRunningAsRoot()) {
|
|
|
|
|
Logger::error("Bloom udev rules missing - cannot install udev rules without root privileges.\n"
|
|
|
|
|
"Running Bloom once with root privileges will allow it to automatically install the udev rules. "
|
|
|
|
|
"Alternatively, instructions on manually installing the udev rules can be found "
|
|
|
|
|
"here: " + Paths::homeDomainName() + "/docs/getting-started\nBloom may fail to connect to some "
|
|
|
|
|
"debug tools until this is resolved.");
|
|
|
|
|
return;
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!std::filesystem::exists(latestBloomRulesPath)) {
|
|
|
|
|
// This shouldn't happen, but it can if someone has been messing with the installation files
|
|
|
|
|
Logger::error(
|
|
|
|
|
"Unable to install Bloom udev rules - \"" + latestBloomRulesPath + "\" does not exist."
|
|
|
|
|
);
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
std::filesystem::copy(latestBloomRulesPath, bloomRulesPath);
|
|
|
|
|
Logger::warning("Bloom udev rules installed - a reconnect of the debug tool may be required "
|
|
|
|
|
"before the new udev rules come into effect.");
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
2022-02-05 15:32:08 +00:00
|
|
|
}
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::shutdown() {
|
|
|
|
|
if (this->getThreadState() == ThreadState::STOPPED) {
|
2021-05-30 16:52:32 +01:00
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
try {
|
|
|
|
|
Logger::info("Shutting down TargetController");
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::deregisterListener(this->eventListener->getId());
|
2022-02-05 15:32:08 +00:00
|
|
|
this->releaseHardware();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const std::exception& exception) {
|
|
|
|
|
this->target.reset();
|
|
|
|
|
this->debugTool.reset();
|
|
|
|
|
Logger::error(
|
|
|
|
|
"Failed to properly shutdown TargetController. Error: " + std::string(exception.what())
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->setThreadStateAndEmitEvent(ThreadState::STOPPED);
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::suspend() {
|
|
|
|
|
if (this->getThreadState() != ThreadState::READY) {
|
|
|
|
|
return;
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::debug("Suspending TargetController");
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
try {
|
|
|
|
|
this->releaseHardware();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const std::exception& exception) {
|
|
|
|
|
Logger::error("Failed to release connected debug tool and target resources. Error: "
|
|
|
|
|
+ std::string(exception.what()));
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::DebugSessionFinished>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::ExtractTargetDescriptor>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::StopTargetExecution>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::StepTargetExecution>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::ResumeTargetExecution>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::RetrieveRegistersFromTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::WriteRegistersToTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::RetrieveMemoryFromTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::WriteMemoryToTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::SetBreakpointOnTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::RemoveBreakpointOnTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::SetProgramCounterOnTarget>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::InsightThreadStateChanged>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::RetrieveTargetPinStates>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::SetTargetPinState>();
|
|
|
|
|
this->eventListener->deregisterCallbacksForEventType<Events::RetrieveStackPointerFromTarget>();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->lastTargetState = TargetState::UNKNOWN;
|
|
|
|
|
this->cachedTargetDescriptor = std::nullopt;
|
|
|
|
|
this->registerDescriptorsByMemoryType.clear();
|
|
|
|
|
this->registerAddressRangeByMemoryType.clear();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->state = TargetControllerState::SUSPENDED;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(std::make_shared<TargetControllerStateReported>(this->state));
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::debug("TargetController suspended");
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::resume() {
|
|
|
|
|
this->acquireHardware();
|
|
|
|
|
this->loadRegisterDescriptors();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::DebugSessionFinished>(
|
|
|
|
|
std::bind(&TargetController::onDebugSessionFinishedEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::ExtractTargetDescriptor>(
|
|
|
|
|
std::bind(&TargetController::onExtractTargetDescriptor, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::StopTargetExecution>(
|
|
|
|
|
std::bind(&TargetController::onStopTargetExecutionEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::StepTargetExecution>(
|
|
|
|
|
std::bind(&TargetController::onStepTargetExecutionEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::ResumeTargetExecution>(
|
|
|
|
|
std::bind(&TargetController::onResumeTargetExecutionEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::RetrieveRegistersFromTarget>(
|
|
|
|
|
std::bind(&TargetController::onReadRegistersEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::WriteRegistersToTarget>(
|
|
|
|
|
std::bind(&TargetController::onWriteRegistersEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::RetrieveMemoryFromTarget>(
|
|
|
|
|
std::bind(&TargetController::onReadMemoryEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::WriteMemoryToTarget>(
|
|
|
|
|
std::bind(&TargetController::onWriteMemoryEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::SetBreakpointOnTarget>(
|
|
|
|
|
std::bind(&TargetController::onSetBreakpointEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-11-11 19:05:24 +00:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::RemoveBreakpointOnTarget>(
|
|
|
|
|
std::bind(&TargetController::onRemoveBreakpointEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::SetProgramCounterOnTarget>(
|
|
|
|
|
std::bind(&TargetController::onSetProgramCounterEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::InsightThreadStateChanged>(
|
|
|
|
|
std::bind(&TargetController::onInsightStateChangedEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::RetrieveTargetPinStates>(
|
|
|
|
|
std::bind(&TargetController::onRetrieveTargetPinStatesEvent, this, std::placeholders::_1)
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::SetTargetPinState>(
|
|
|
|
|
std::bind(&TargetController::onSetPinStateEvent, this, std::placeholders::_1)
|
2021-05-30 16:52:32 +01:00
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::RetrieveStackPointerFromTarget>(
|
|
|
|
|
std::bind(&TargetController::onRetrieveStackPointerEvent, this, std::placeholders::_1)
|
2021-05-30 16:52:32 +01:00
|
|
|
);
|
2022-02-05 15:32:08 +00:00
|
|
|
|
2022-04-08 22:14:01 +01:00
|
|
|
this->eventListener->registerCallbackForEventType<Events::ResetTarget>(
|
|
|
|
|
std::bind(&TargetController::onResetTarget, this, std::placeholders::_1)
|
|
|
|
|
);
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->state = TargetControllerState::ACTIVE;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(
|
2022-02-05 15:32:08 +00:00
|
|
|
std::make_shared<TargetControllerStateReported>(this->state)
|
|
|
|
|
);
|
|
|
|
|
|
|
|
|
|
if (this->target->getState() != TargetState::RUNNING) {
|
|
|
|
|
this->target->run();
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::acquireHardware() {
|
|
|
|
|
auto debugToolName = this->environmentConfig.debugToolConfig.name;
|
|
|
|
|
auto targetName = this->environmentConfig.targetConfig.name;
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto supportedDebugTools = TargetController::getSupportedDebugTools();
|
|
|
|
|
auto supportedTargets = TargetController::getSupportedTargets();
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!supportedDebugTools.contains(debugToolName)) {
|
|
|
|
|
throw Exceptions::InvalidConfig(
|
|
|
|
|
"Debug tool name (\"" + debugToolName + "\") not recognised. Please check your configuration!"
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!supportedTargets.contains(targetName)) {
|
|
|
|
|
throw Exceptions::InvalidConfig(
|
|
|
|
|
"Target name (\"" + targetName + "\") not recognised. Please check your configuration!"
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
// Initiate debug tool and target
|
|
|
|
|
this->debugTool = supportedDebugTools.at(debugToolName)();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::info("Connecting to debug tool");
|
|
|
|
|
this->debugTool->init();
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::info("Debug tool connected");
|
|
|
|
|
Logger::info("Debug tool name: " + this->debugTool->getName());
|
|
|
|
|
Logger::info("Debug tool serial: " + this->debugTool->getSerialNumber());
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target = supportedTargets.at(targetName)();
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!this->target->isDebugToolSupported(this->debugTool.get())) {
|
|
|
|
|
throw Exceptions::InvalidConfig(
|
|
|
|
|
"Debug tool (\"" + this->debugTool->getName() + "\") not supported " +
|
|
|
|
|
"by target (\"" + this->target->getName() + "\")."
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
2021-04-12 19:43:42 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->setDebugTool(this->debugTool.get());
|
|
|
|
|
this->target->preActivationConfigure(this->environmentConfig.targetConfig);
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::info("Activating target");
|
|
|
|
|
this->target->activate();
|
|
|
|
|
Logger::info("Target activated");
|
|
|
|
|
this->target->postActivationConfigure();
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
while (this->target->supportsPromotion()) {
|
|
|
|
|
auto promotedTarget = this->target->promote();
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (promotedTarget == nullptr
|
|
|
|
|
|| std::type_index(typeid(*promotedTarget)) == std::type_index(typeid(*this->target))
|
|
|
|
|
) {
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
this->target = std::move(promotedTarget);
|
|
|
|
|
this->target->postPromotionConfigure();
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::info("Target ID: " + this->target->getHumanReadableId());
|
|
|
|
|
Logger::info("Target name: " + this->target->getName());
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::releaseHardware() {
|
2022-03-17 00:00:40 +00:00
|
|
|
/*
|
|
|
|
|
* Transferring ownership of this->debugTool and this->target to this function block means if an exception is
|
|
|
|
|
* thrown, the objects will still be destroyed.
|
|
|
|
|
*/
|
|
|
|
|
auto debugTool = std::move(this->debugTool);
|
|
|
|
|
auto target = std::move(this->target);
|
2022-02-05 15:32:08 +00:00
|
|
|
|
|
|
|
|
if (debugTool != nullptr && debugTool->isInitialised()) {
|
|
|
|
|
if (target != nullptr) {
|
|
|
|
|
/*
|
|
|
|
|
* We call deactivate() without checking if the target is activated. This will address any cases
|
|
|
|
|
* where a target is only partially activated (where the call to activate() failed).
|
|
|
|
|
*/
|
|
|
|
|
Logger::info("Deactivating target");
|
|
|
|
|
target->deactivate();
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Logger::info("Closing debug tool");
|
|
|
|
|
debugTool->close();
|
|
|
|
|
}
|
|
|
|
|
}
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::loadRegisterDescriptors() {
|
|
|
|
|
auto& targetDescriptor = this->getTargetDescriptor();
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
for (const auto& [registerType, registerDescriptors] : targetDescriptor.registerDescriptorsByType) {
|
|
|
|
|
for (const auto& registerDescriptor : registerDescriptors) {
|
|
|
|
|
auto startAddress = registerDescriptor.startAddress.value_or(0);
|
|
|
|
|
auto endAddress = startAddress + (registerDescriptor.size - 1);
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!this->registerAddressRangeByMemoryType.contains(registerDescriptor.memoryType)) {
|
|
|
|
|
auto addressRange = TargetMemoryAddressRange();
|
2021-10-06 21:12:31 +01:00
|
|
|
addressRange.startAddress = startAddress;
|
|
|
|
|
addressRange.endAddress = endAddress;
|
2022-02-05 15:32:08 +00:00
|
|
|
this->registerAddressRangeByMemoryType.insert(
|
|
|
|
|
std::pair(registerDescriptor.memoryType, addressRange)
|
|
|
|
|
);
|
|
|
|
|
|
|
|
|
|
} else {
|
|
|
|
|
auto& addressRange = this->registerAddressRangeByMemoryType.at(registerDescriptor.memoryType);
|
|
|
|
|
|
|
|
|
|
if (startAddress < addressRange.startAddress) {
|
|
|
|
|
addressRange.startAddress = startAddress;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (endAddress > addressRange.endAddress) {
|
|
|
|
|
addressRange.endAddress = endAddress;
|
|
|
|
|
}
|
2021-10-06 21:12:31 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->registerDescriptorsByMemoryType[registerDescriptor.memoryType].insert(registerDescriptor);
|
|
|
|
|
}
|
2021-10-06 21:12:31 +01:00
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
TargetRegisterDescriptors TargetController::getRegisterDescriptorsWithinAddressRange(
|
|
|
|
|
std::uint32_t startAddress,
|
|
|
|
|
std::uint32_t endAddress,
|
|
|
|
|
Targets::TargetMemoryType memoryType
|
2021-10-06 21:12:31 +01:00
|
|
|
) {
|
2022-02-05 15:32:08 +00:00
|
|
|
auto output = TargetRegisterDescriptors();
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (this->registerAddressRangeByMemoryType.contains(memoryType)
|
|
|
|
|
&& this->registerDescriptorsByMemoryType.contains(memoryType)
|
2021-10-06 21:12:31 +01:00
|
|
|
) {
|
2022-02-05 15:32:08 +00:00
|
|
|
auto& registersAddressRange = this->registerAddressRangeByMemoryType.at(memoryType);
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (
|
|
|
|
|
(startAddress <= registersAddressRange.startAddress && endAddress >= registersAddressRange.startAddress)
|
|
|
|
|
|| (startAddress <= registersAddressRange.endAddress && endAddress >= registersAddressRange.startAddress)
|
|
|
|
|
) {
|
|
|
|
|
auto& registerDescriptors = this->registerDescriptorsByMemoryType.at(memoryType);
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
for (const auto& registerDescriptor : registerDescriptors) {
|
|
|
|
|
if (!registerDescriptor.startAddress.has_value() || registerDescriptor.size < 1) {
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
auto registerStartAddress = registerDescriptor.startAddress.value();
|
|
|
|
|
auto registerEndAddress = registerStartAddress + registerDescriptor.size;
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (
|
|
|
|
|
(startAddress <= registerStartAddress && endAddress >= registerStartAddress)
|
|
|
|
|
|| (startAddress <= registerEndAddress && endAddress >= registerStartAddress)
|
|
|
|
|
) {
|
|
|
|
|
output.insert(registerDescriptor);
|
|
|
|
|
}
|
2021-10-06 21:12:31 +01:00
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
return output;
|
|
|
|
|
}
|
2021-10-06 21:12:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::fireTargetEvents() {
|
|
|
|
|
auto newTargetState = this->target->getState();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (newTargetState != this->lastTargetState) {
|
|
|
|
|
this->lastTargetState = newTargetState;
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (newTargetState == TargetState::STOPPED) {
|
|
|
|
|
Logger::debug("Target state changed - STOPPED");
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(std::make_shared<TargetExecutionStopped>(
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->getProgramCounter(),
|
|
|
|
|
TargetBreakCause::UNKNOWN
|
|
|
|
|
));
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (newTargetState == TargetState::RUNNING) {
|
|
|
|
|
Logger::debug("Target state changed - RUNNING");
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(std::make_shared<TargetExecutionResumed>());
|
2022-02-05 15:32:08 +00:00
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2022-04-08 22:14:01 +01:00
|
|
|
void TargetController::resetTarget(const std::optional<int>& resetEventCorrelationId) {
|
|
|
|
|
this->target->reset();
|
|
|
|
|
|
|
|
|
|
auto targetResetEvent = std::make_shared<Events::TargetReset>();
|
|
|
|
|
targetResetEvent->correlationId = resetEventCorrelationId;
|
|
|
|
|
|
|
|
|
|
EventManager::triggerEvent(targetResetEvent);
|
|
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::emitErrorEvent(int correlationId, const std::string& errorMessage) {
|
|
|
|
|
auto errorEvent = std::make_shared<Events::TargetControllerErrorOccurred>();
|
|
|
|
|
errorEvent->correlationId = correlationId;
|
|
|
|
|
errorEvent->errorMessage = errorMessage;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(errorEvent);
|
2021-09-11 20:39:31 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
Targets::TargetDescriptor& TargetController::getTargetDescriptor() {
|
|
|
|
|
if (!this->cachedTargetDescriptor.has_value()) {
|
|
|
|
|
this->cachedTargetDescriptor = this->target->getDescriptor();
|
|
|
|
|
}
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
return this->cachedTargetDescriptor.value();
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onShutdownTargetControllerEvent(const Events::ShutdownTargetController&) {
|
|
|
|
|
this->shutdown();
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onStateReportRequest(const Events::ReportTargetControllerState& event) {
|
|
|
|
|
auto stateEvent = std::make_shared<Events::TargetControllerStateReported>(this->state);
|
|
|
|
|
stateEvent->correlationId = event.id;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(stateEvent);
|
2021-05-30 16:52:32 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onExtractTargetDescriptor(const Events::ExtractTargetDescriptor& event) {
|
|
|
|
|
auto targetDescriptorExtracted = std::make_shared<TargetDescriptorExtracted>();
|
|
|
|
|
targetDescriptorExtracted->targetDescriptor = this->getTargetDescriptor();
|
2021-05-30 16:52:32 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
targetDescriptorExtracted->correlationId = event.id;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(targetDescriptorExtracted);
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onDebugSessionStartedEvent(const Events::DebugSessionStarted&) {
|
|
|
|
|
if (this->state == TargetControllerState::SUSPENDED) {
|
|
|
|
|
Logger::debug("Waking TargetController");
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->resume();
|
|
|
|
|
this->fireTargetEvents();
|
|
|
|
|
}
|
|
|
|
|
|
2022-04-08 22:14:01 +01:00
|
|
|
this->resetTarget();
|
2021-04-04 21:04:12 +01:00
|
|
|
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->stop();
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void TargetController::onDebugSessionFinishedEvent(const DebugSessionFinished&) {
|
|
|
|
|
if (this->target->getState() != TargetState::RUNNING) {
|
|
|
|
|
this->target->run();
|
|
|
|
|
this->fireTargetEvents();
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (this->environmentConfig.debugToolConfig.releasePostDebugSession) {
|
|
|
|
|
this->suspend();
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
2022-02-05 15:32:08 +00:00
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onStopTargetExecutionEvent(const Events::StopTargetExecution& event) {
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
|
|
|
|
this->target->stop();
|
|
|
|
|
this->lastTargetState = TargetState::STOPPED;
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto executionStoppedEvent = std::make_shared<Events::TargetExecutionStopped>(
|
|
|
|
|
this->target->getProgramCounter(),
|
|
|
|
|
TargetBreakCause::UNKNOWN
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
executionStoppedEvent->correlationId = event.id;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(executionStoppedEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onStepTargetExecutionEvent(const Events::StepTargetExecution& event) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
|
|
|
|
// We can't step the target if it's already running.
|
|
|
|
|
throw TargetOperationFailure("Target is already running");
|
|
|
|
|
}
|
|
|
|
|
|
2021-06-22 03:06:20 +01:00
|
|
|
if (event.fromProgramCounter.has_value()) {
|
|
|
|
|
this->target->setProgramCounter(event.fromProgramCounter.value());
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->step();
|
2021-04-04 21:04:12 +01:00
|
|
|
this->lastTargetState = TargetState::RUNNING;
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto executionResumedEvent = std::make_shared<Events::TargetExecutionResumed>();
|
|
|
|
|
executionResumedEvent->correlationId = event.id;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(executionResumedEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to step execution on target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onResumeTargetExecutionEvent(const Events::ResumeTargetExecution& event) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->target->getState() != TargetState::RUNNING) {
|
|
|
|
|
if (event.fromProgramCounter.has_value()) {
|
|
|
|
|
this->target->setProgramCounter(event.fromProgramCounter.value());
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
this->target->run();
|
|
|
|
|
this->lastTargetState = TargetState::RUNNING;
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto executionResumedEvent = std::make_shared<Events::TargetExecutionResumed>();
|
|
|
|
|
executionResumedEvent->correlationId = event.id;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(executionResumedEvent);
|
2022-02-05 15:32:08 +00:00
|
|
|
|
|
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to resume execution on target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
2022-02-05 15:32:08 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void TargetController::onReadRegistersEvent(const Events::RetrieveRegistersFromTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
auto registers = this->target->readRegisters(event.descriptors);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (registers.size() > 0) {
|
|
|
|
|
auto registersRetrievedEvent = std::make_shared<Events::RegistersRetrievedFromTarget>();
|
|
|
|
|
registersRetrievedEvent->correlationId = event.id;
|
|
|
|
|
registersRetrievedEvent->registers = registers;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(registersRetrievedEvent);
|
2022-02-05 15:32:08 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to read registers from target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onWriteRegistersEvent(const Events::WriteRegistersToTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
this->target->writeRegisters(event.registers);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto registersWrittenEvent = std::make_shared<Events::RegistersWrittenToTarget>();
|
|
|
|
|
registersWrittenEvent->correlationId = event.id;
|
|
|
|
|
registersWrittenEvent->registers = event.registers;
|
2021-09-11 20:39:31 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(registersWrittenEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to write registers to target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onReadMemoryEvent(const Events::RetrieveMemoryFromTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
auto memoryReadEvent = std::make_shared<Events::MemoryRetrievedFromTarget>();
|
|
|
|
|
memoryReadEvent->correlationId = event.id;
|
|
|
|
|
memoryReadEvent->data = this->target->readMemory(
|
|
|
|
|
event.memoryType,
|
|
|
|
|
event.startAddress,
|
|
|
|
|
event.bytes,
|
|
|
|
|
event.excludedAddressRanges
|
|
|
|
|
);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(memoryReadEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to read memory from target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onWriteMemoryEvent(const Events::WriteMemoryToTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
const auto& buffer = event.buffer;
|
|
|
|
|
const auto bufferSize = event.buffer.size();
|
|
|
|
|
const auto bufferStartAddress = event.startAddress;
|
2021-09-12 23:25:34 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->writeMemory(event.memoryType, event.startAddress, event.buffer);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto memoryWrittenEvent = std::make_shared<Events::MemoryWrittenToTarget>();
|
|
|
|
|
memoryWrittenEvent->correlationId = event.id;
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(memoryWrittenEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
if (EventManager::isEventTypeListenedFor(Events::RegistersWrittenToTarget::type)
|
2022-02-05 15:32:08 +00:00
|
|
|
&& this->registerDescriptorsByMemoryType.contains(event.memoryType)
|
|
|
|
|
) {
|
|
|
|
|
/*
|
|
|
|
|
* The memory type we just wrote to contains some number of registers - if we've written to any address
|
|
|
|
|
* that is known to store the value of a register, trigger a RegistersWrittenToTarget event
|
|
|
|
|
*/
|
|
|
|
|
const auto bufferEndAddress = static_cast<std::uint32_t>(bufferStartAddress + (bufferSize - 1));
|
|
|
|
|
auto registerDescriptors = this->getRegisterDescriptorsWithinAddressRange(
|
|
|
|
|
bufferStartAddress,
|
|
|
|
|
bufferEndAddress,
|
|
|
|
|
event.memoryType
|
|
|
|
|
);
|
2021-09-11 20:39:31 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (!registerDescriptors.empty()) {
|
|
|
|
|
auto registersWrittenEvent = std::make_shared<Events::RegistersWrittenToTarget>();
|
|
|
|
|
registersWrittenEvent->correlationId = event.id;
|
2021-09-12 23:25:34 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
for (const auto& registerDescriptor : registerDescriptors) {
|
|
|
|
|
const auto registerSize = registerDescriptor.size;
|
|
|
|
|
const auto registerStartAddress = registerDescriptor.startAddress.value();
|
|
|
|
|
const auto registerEndAddress = registerStartAddress + (registerSize - 1);
|
2021-09-12 23:25:34 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
if (registerStartAddress < bufferStartAddress || registerEndAddress > bufferEndAddress) {
|
|
|
|
|
continue;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
const auto bufferBeginIt = buffer.begin() + (registerStartAddress - bufferStartAddress);
|
|
|
|
|
registersWrittenEvent->registers.emplace_back(TargetRegister(
|
|
|
|
|
registerDescriptor,
|
|
|
|
|
TargetMemoryBuffer(bufferBeginIt, bufferBeginIt + registerSize)
|
|
|
|
|
));
|
2021-09-12 23:25:34 +01:00
|
|
|
}
|
|
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(registersWrittenEvent);
|
2021-09-12 23:25:34 +01:00
|
|
|
}
|
2021-09-11 20:39:31 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to write memory to target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onSetBreakpointEvent(const Events::SetBreakpointOnTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
this->target->setBreakpoint(event.breakpoint.address);
|
|
|
|
|
auto breakpointSetEvent = std::make_shared<Events::BreakpointSetOnTarget>();
|
|
|
|
|
breakpointSetEvent->correlationId = event.id;
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(breakpointSetEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to set breakpoint on target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onRemoveBreakpointEvent(const Events::RemoveBreakpointOnTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
this->target->removeBreakpoint(event.breakpoint.address);
|
|
|
|
|
auto breakpointRemovedEvent = std::make_shared<Events::BreakpointRemovedOnTarget>();
|
|
|
|
|
breakpointRemovedEvent->correlationId = event.id;
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(breakpointRemovedEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to remove breakpoint on target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onSetProgramCounterEvent(const Events::SetProgramCounterOnTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
|
|
|
|
throw TargetOperationFailure(
|
|
|
|
|
"Invalid target state - target must be stopped before the program counter can be updated"
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->setProgramCounter(event.address);
|
|
|
|
|
auto programCounterSetEvent = std::make_shared<Events::ProgramCounterSetOnTarget>();
|
|
|
|
|
programCounterSetEvent->correlationId = event.id;
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(programCounterSetEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to set program counter on target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
// TODO: remove this
|
|
|
|
|
void TargetController::onInsightStateChangedEvent(const Events::InsightThreadStateChanged& event) {
|
|
|
|
|
if (event.getState() == ThreadState::READY) {
|
|
|
|
|
/*
|
|
|
|
|
* Insight has just started up.
|
|
|
|
|
*
|
|
|
|
|
* Refresh the target state and kick off a target stop/resume execution event. Setting the lastTargetState
|
|
|
|
|
* to UNKNOWN will be enough to do this. See TargetController::fireTargetEvents().
|
|
|
|
|
*/
|
|
|
|
|
this->lastTargetState = TargetState::UNKNOWN;
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onRetrieveTargetPinStatesEvent(const Events::RetrieveTargetPinStates& event) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
|
|
|
|
throw TargetOperationFailure(
|
|
|
|
|
"Invalid target state - target must be stopped before pin states can be retrieved"
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto pinStatesRetrieved = std::make_shared<Events::TargetPinStatesRetrieved>();
|
|
|
|
|
pinStatesRetrieved->correlationId = event.id;
|
|
|
|
|
pinStatesRetrieved->variantId = event.variantId;
|
|
|
|
|
pinStatesRetrieved->pinSatesByNumber = this->target->getPinStates(event.variantId);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(pinStatesRetrieved);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to retrieve target pin states - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
|
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onSetPinStateEvent(const Events::SetTargetPinState& event) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
|
|
|
|
throw TargetOperationFailure(
|
|
|
|
|
"Invalid target state - target must be stopped before pin state can be set"
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
this->target->setPinState(event.pinDescriptor, event.pinState);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto pinStatesUpdateEvent = std::make_shared<Events::TargetPinStatesRetrieved>();
|
|
|
|
|
pinStatesUpdateEvent->correlationId = event.id;
|
|
|
|
|
pinStatesUpdateEvent->variantId = event.pinDescriptor.variantId;
|
|
|
|
|
pinStatesUpdateEvent->pinSatesByNumber = {
|
|
|
|
|
{event.pinDescriptor.number, event.pinState}
|
|
|
|
|
};
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(pinStatesUpdateEvent);
|
2021-04-04 21:04:12 +01:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to set target pin state for pin " + event.pinDescriptor.name + " - "
|
|
|
|
|
+ exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-04-04 21:04:12 +01:00
|
|
|
}
|
2021-11-11 19:05:24 +00:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
void TargetController::onRetrieveStackPointerEvent(const Events::RetrieveStackPointerFromTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
if (this->target->getState() != TargetState::STOPPED) {
|
|
|
|
|
throw TargetOperationFailure(
|
|
|
|
|
"Invalid target state - target must be stopped before stack pointer can be retrieved"
|
|
|
|
|
);
|
|
|
|
|
}
|
2021-11-11 19:05:24 +00:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
auto stackPointerRetrieved = std::make_shared<Events::StackPointerRetrievedFromTarget>();
|
|
|
|
|
stackPointerRetrieved->correlationId = event.id;
|
|
|
|
|
stackPointerRetrieved->stackPointer = this->target->getStackPointer();
|
2021-11-11 19:05:24 +00:00
|
|
|
|
2022-03-20 17:37:36 +00:00
|
|
|
EventManager::triggerEvent(stackPointerRetrieved);
|
2021-11-11 19:05:24 +00:00
|
|
|
|
2022-02-05 15:32:08 +00:00
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to retrieve stack pointer value from target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
2021-11-11 19:05:24 +00:00
|
|
|
}
|
2022-04-08 22:14:01 +01:00
|
|
|
|
|
|
|
|
void TargetController::onResetTarget(const Events::ResetTarget& event) {
|
|
|
|
|
try {
|
|
|
|
|
this->resetTarget(event.id);
|
|
|
|
|
|
|
|
|
|
} catch (const TargetOperationFailure& exception) {
|
|
|
|
|
Logger::error("Failed to reset target - " + exception.getMessage());
|
|
|
|
|
this->emitErrorEvent(event.id, exception.getMessage());
|
|
|
|
|
}
|
|
|
|
|
}
|
2021-11-11 19:05:24 +00:00
|
|
|
}
|