50 lines
863 B
C++
50 lines
863 B
C++
#include "setup.h"
|
|
|
|
// local includes
|
|
#include "globals.h"
|
|
|
|
namespace setup {
|
|
bool currently_locked;
|
|
ModeInterface* oldMode;
|
|
IgnoreInputMode setup_mode{0, bobbycar::protocol::ControlType::FieldOrientedControl, bobbycar::protocol::ControlMode::Torque};
|
|
|
|
void lock()
|
|
{
|
|
if (currently_locked)
|
|
{
|
|
ESP_LOGI("setup", "already locked");
|
|
return;
|
|
}
|
|
|
|
oldMode = currentMode;
|
|
currentMode = &setup_mode;
|
|
|
|
currently_locked = true;
|
|
}
|
|
|
|
void unlock()
|
|
{
|
|
if (!currently_locked)
|
|
{
|
|
ESP_LOGI("setup", "already unlocked");
|
|
return;
|
|
}
|
|
|
|
if (currentMode == &setup_mode)
|
|
{
|
|
// to avoid crash after deconstruction
|
|
setup_mode.stop();
|
|
lastMode = nullptr;
|
|
|
|
currentMode = oldMode;
|
|
}
|
|
|
|
currently_locked = false;
|
|
}
|
|
|
|
bool isLocked()
|
|
{
|
|
return currently_locked;
|
|
}
|
|
} // namespace setup
|