93 lines
2.8 KiB
C++
93 lines
2.8 KiB
C++
/**
|
|
* @file controlPad.cpp
|
|
* @author Alexander Klein (alex@kleiax.de)
|
|
* @brief
|
|
* @version 0.1
|
|
* @date 2023-03-30
|
|
*
|
|
* @copyright Copyright (c) 2023
|
|
*
|
|
*/
|
|
|
|
#include "controlPad.h"
|
|
|
|
ControlPad::ControlPad() : Component(10), controlInput{0, 0, 0, 0} {}
|
|
|
|
void ControlPad::run()
|
|
{
|
|
if (!this->connected)
|
|
{
|
|
return;
|
|
}
|
|
|
|
if (millis() - this->lastMessageReceive > this->disconnectTime)
|
|
{
|
|
this->connected = false;
|
|
this->controlInput.buttons = 0;
|
|
this->controlInput.x = UINT8_MAX / 2;
|
|
this->controlInput.y = UINT8_MAX / 2;
|
|
return;
|
|
}
|
|
|
|
if (this->lastButtons != controlInput.buttons)
|
|
{
|
|
this->updated = true;
|
|
}
|
|
|
|
if (static_cast<bool>(this->menuControl) && this->controlInput.buttons > 0 && this->updated)
|
|
{
|
|
if (this->firstButtonPress)
|
|
{
|
|
this->menuControl->printMenu();
|
|
this->firstButtonPress = false;
|
|
std::cout << "ControlPad::loop - First menu print" << std::endl;
|
|
return;
|
|
}
|
|
|
|
if (ControlPadButton::isControlPadButtonPressed(&this->controlInput, ControlPadButton::PadButton::Left))
|
|
{
|
|
this->menuControl->left();
|
|
}
|
|
else if (ControlPadButton::isControlPadButtonPressed(&this->controlInput, ControlPadButton::PadButton::Right))
|
|
{
|
|
this->menuControl->right();
|
|
}
|
|
else if (ControlPadButton::isControlPadButtonPressed(&this->controlInput, ControlPadButton::PadButton::Up))
|
|
{
|
|
this->menuControl->up();
|
|
}
|
|
else if (ControlPadButton::isControlPadButtonPressed(&this->controlInput, ControlPadButton::PadButton::Down))
|
|
{
|
|
this->menuControl->down();
|
|
}
|
|
else if (ControlPadButton::isControlPadButtonPressed(&this->controlInput, ControlPadButton::PadButton::Yes))
|
|
{
|
|
this->menuControl->yes();
|
|
}
|
|
else if (ControlPadButton::isControlPadButtonPressed(&this->controlInput, ControlPadButton::PadButton::No))
|
|
{
|
|
this->menuControl->no();
|
|
}
|
|
|
|
this->updated = false;
|
|
this->lastButtons = controlInput.buttons;
|
|
}
|
|
}
|
|
|
|
void ControlPad::insertData(const uint8_t *data)
|
|
{
|
|
this->connected = true;
|
|
this->lastMessageReceive = millis();
|
|
|
|
const uint8_t lastCount = this->controlInput.counter + 1;
|
|
memcpy(&(this->controlInput), data, sizeof(this->controlInput));
|
|
if (lastCount != this->controlInput.counter)
|
|
std::cout << "ControlPad::insertData counter wrong value" << std::endl;
|
|
|
|
if (this->controlInput.x > UINT8_MAX / 2 - this->deadZoneX && this->controlInput.x < UINT8_MAX / 2 + this->deadZoneX)
|
|
this->controlInput.x = UINT8_MAX / 2;
|
|
|
|
if (this->controlInput.y > UINT8_MAX / 2 - this->deadZoneY && this->controlInput.y < UINT8_MAX / 2 + this->deadZoneY)
|
|
this->controlInput.y = UINT8_MAX / 2;
|
|
}
|