Merge pull request #308 from bobbycar-graz/fix-seatbot

This commit is contained in:
CommanderRedYT
2022-04-23 15:54:14 +02:00
committed by GitHub
4 changed files with 35 additions and 23 deletions

View File

@@ -40,13 +40,13 @@ void JoystickDebugDisplay::update()
m_x = std::nullopt; m_x = std::nullopt;
else else
{ {
m_x = map_analog_stick(m_gasMitte, m_gasMin, m_gasMax, *raw_gas); m_x = map_analog_stick(m_gasMitte, m_gasMin, m_gasMax, configs.deadband.value, *raw_gas);
} }
if (!raw_brems) if (!raw_brems)
m_y = std::nullopt; m_y = std::nullopt;
else else
m_y = map_analog_stick(m_bremsMitte, m_bremsMin, m_bremsMax, *raw_brems); m_y = map_analog_stick(m_bremsMitte, m_bremsMin, m_bremsMax, configs.deadband.value, *raw_brems);
} }
void JoystickDebugDisplay::redraw() void JoystickDebugDisplay::redraw()

View File

@@ -78,13 +78,13 @@ void readPotis()
#else #else
if (raw_gas) if (raw_gas)
{ {
gas = map_analog_stick(configs.gasMitte.value, configs.gasMin.value, configs.gasMax.value, *raw_gas); gas = map_analog_stick(configs.gasMitte.value, configs.gasMin.value, configs.gasMax.value, configs.deadband.value, *raw_gas);
} }
else else
gas = std::nullopt; gas = std::nullopt;
if (raw_brems) if (raw_brems)
{ {
brems = map_analog_stick(configs.bremsMitte.value, configs.bremsMin.value, configs.bremsMax.value, *raw_brems); brems = map_analog_stick(configs.bremsMitte.value, configs.bremsMin.value, configs.bremsMax.value, configs.deadband.value, *raw_brems);
} }
else else
brems = std::nullopt; brems = std::nullopt;

View File

@@ -283,35 +283,47 @@ std::string local_clock_string()
return fmt::format("{:02d}:{:02d}:{:02d}", dt.hour, dt.minute, dt.second); return fmt::format("{:02d}:{:02d}:{:02d}", dt.hour, dt.minute, dt.second);
} }
int16_t map_analog_stick(uint16_t middle, uint16_t start, uint16_t end, uint16_t raw) int16_t map_analog_stick(uint16_t middle, uint16_t start, uint16_t end, uint16_t deadband, uint16_t raw)
{ {
if (abs(raw - middle) < configs.deadband.value) if (abs(raw - middle) < configs.deadband.value)
{ {
return 0; return 0;
} }
if (start < end)
{
if (raw < middle) if (raw < middle)
{ {
raw += configs.deadband.value; raw += configs.deadband.value;
start += configs.deadband.value; start += configs.deadband.value;
const auto return_val = map(raw, start, middle, -1000, 0); const auto return_val = cpputils::mapValueClamped<float>(raw, start, middle, -1000, 0);
if (return_val > 0)
return 0;
if (return_val < -1000)
return -1000;
return return_val; return return_val;
} }
else else
{ {
raw -= configs.deadband.value; raw -= configs.deadband.value;
end -= configs.deadband.value; end -= configs.deadband.value;
const auto return_val = map(raw, middle, end, 0, 1000); const auto return_val = cpputils::mapValueClamped<float>(raw, middle, end, 0, 1000);
if (return_val < 0)
return 0;
if (return_val > 1000)
return 1000;
return return_val; return return_val;
} }
}
else
{
if (raw < middle)
{
raw += configs.deadband.value;
end += configs.deadband.value;
const auto return_val = cpputils::mapValueClamped<float>(raw, end, middle, 1000, 0);
return return_val;
}
else
{
raw -= configs.deadband.value;
start -= configs.deadband.value;
const auto return_val = cpputils::mapValueClamped<float>(raw, middle, start, 0, -1000);
return return_val;
}
}
} }
std::string get_wifi_security_string(wifi_auth_mode_t authMode) std::string get_wifi_security_string(wifi_auth_mode_t authMode)

View File

@@ -60,7 +60,7 @@ float wattToAmpere(float watt);
float wattToMotorCurrent(float watt); float wattToMotorCurrent(float watt);
uint8_t time_to_percent(espchrono::milliseconds32 repeat, espchrono::milliseconds32 riseTime, espchrono::milliseconds32 fullTime, size_t numLeds, bool invert); uint8_t time_to_percent(espchrono::milliseconds32 repeat, espchrono::milliseconds32 riseTime, espchrono::milliseconds32 fullTime, size_t numLeds, bool invert);
std::string local_clock_string(); std::string local_clock_string();
int16_t map_analog_stick(uint16_t middle, uint16_t start, uint16_t end, uint16_t raw); int16_t map_analog_stick(uint16_t middle, uint16_t start, uint16_t end, uint16_t deadband, uint16_t raw);
inline uint32_t CRGB_TO_UINT32(CRGB crgb) inline uint32_t CRGB_TO_UINT32(CRGB crgb)
{ {