127 lines
4.6 KiB
C++
127 lines
4.6 KiB
C++
/**
|
|
* @file joystick.cpp
|
|
*
|
|
* See lcd_controller.cpp for more information
|
|
* See void onJoystick(joystick_button_e button)
|
|
*
|
|
* TODO: separate EXTI layer from joystick logic
|
|
* You cannot use two pins with same index for EXTI (for instance PA5 and PE5) since these would
|
|
* be using same EXTI line. See https://stm32f4-discovery.net/2014/08/stm32f4-external-interrupts-tutorial/
|
|
* See also comments in digital_input_icu.cpp
|
|
*
|
|
* @date Jan 2, 2015
|
|
* @author Andrey Belomutskiy, (c) 2012-2020
|
|
*/
|
|
|
|
#include "pch.h"
|
|
|
|
#if (HAL_USE_PAL && EFI_JOYSTICK)
|
|
#include "joystick.h"
|
|
#include "digital_input_exti.h"
|
|
|
|
static int joyTotal = 0;
|
|
static int joyCenter;
|
|
static int joyA = 0;
|
|
static int joyB = 0;
|
|
static int joyC = 0;
|
|
static int joyD = 0;
|
|
|
|
// 50ms
|
|
#define NT_EVENT_GAP US2NT(50 *1000)
|
|
|
|
static efitick_t lastEventTime = 0;
|
|
|
|
static bool isJitter() {
|
|
efitick_t now = getTimeNowNt();
|
|
if (now - lastEventTime < NT_EVENT_GAP)
|
|
return true; // two consecutive events are probably just jitter
|
|
lastEventTime = now;
|
|
return false;
|
|
}
|
|
|
|
static void extCallback(ioportmask_t channel) {
|
|
if (isJitter())
|
|
return;
|
|
joyTotal++;
|
|
joystick_button_e button;
|
|
// todo: I guess it's time to reduce code duplication and start working with an array
|
|
if (channel == getHwPin("joy", engineConfiguration->joystickCenterPin)) {
|
|
joyCenter++;
|
|
button = JB_CENTER;
|
|
} else if (channel == getHwPin("joy", engineConfiguration->joystickAPin)) {
|
|
joyA++;
|
|
button = JB_BUTTON_A;
|
|
/* not used so far
|
|
} else if (channel == getHwPin("joy", engineConfiguration->joystickBPin)) {
|
|
joyB++;
|
|
button = JB_BUTTON_B;
|
|
} else if (channel == getHwPin("joy", engineConfiguration->joystickCPin)) {
|
|
joyC++;
|
|
button = JB_BUTTON_C;
|
|
*/
|
|
} else if (channel == getHwPin("joy", engineConfiguration->joystickDPin)) {
|
|
joyD++;
|
|
button = JB_BUTTON_D;
|
|
} else {
|
|
// unexpected channel
|
|
return;
|
|
}
|
|
#if EFI_HD44780_LCD
|
|
onJoystick(button);
|
|
#else
|
|
UNUSED(button);
|
|
#endif
|
|
}
|
|
|
|
static void joystickInfo() {
|
|
efiPrintf("total %d center=%d@%s", joyTotal, joyCenter,
|
|
hwPortname(engineConfiguration->joystickCenterPin));
|
|
efiPrintf("a=%d@%s", joyA, hwPortname(engineConfiguration->joystickAPin));
|
|
efiPrintf("b=%d@%s", joyB, hwPortname(engineConfiguration->joystickBPin));
|
|
efiPrintf("c=%d@%s", joyC, hwPortname(engineConfiguration->joystickCPin));
|
|
efiPrintf("d=%d@%s", joyD, hwPortname(engineConfiguration->joystickDPin));
|
|
}
|
|
|
|
static bool isJoystickEnabled() {
|
|
return (isBrainPinValid(engineConfiguration->joystickCenterPin) &&
|
|
isBrainPinValid(engineConfiguration->joystickAPin) &&
|
|
// not used so far isBrainPinValid(engineConfiguration->joystickBPin) &&
|
|
// not used so far isBrainPinValid(engineConfiguration->joystickCPin) &&
|
|
isBrainPinValid(engineConfiguration->joystickDPin));
|
|
}
|
|
|
|
void stopJoystickPins() {
|
|
// todo: should be 'efiExtiDisablePin' or smth?
|
|
efiSetPadUnused(activeConfiguration.joystickCenterPin);
|
|
efiSetPadUnused(activeConfiguration.joystickAPin);
|
|
efiSetPadUnused(activeConfiguration.joystickDPin);
|
|
}
|
|
|
|
void startJoystickPins() {
|
|
// todo: extract 'configurePalInputPin() method?
|
|
// input capture driver would claim pin ownership so we are not using 'efiSetPadMode' here
|
|
efiSetPadModeWithoutOwnershipAcquisition("joy center", engineConfiguration->joystickCenterPin, PAL_MODE_INPUT_PULLUP);
|
|
efiSetPadModeWithoutOwnershipAcquisition("joy A", engineConfiguration->joystickAPin, PAL_MODE_INPUT_PULLUP);
|
|
// not used so far efiSetPadModeWithoutOwnershipAcquisition("joy B", engineConfiguration->joystickBPin, PAL_MODE_INPUT_PULLUP);
|
|
// not used so far efiSetPadModeWithoutOwnershipAcquisition("joy C", engineConfiguration->joystickCPin, PAL_MODE_INPUT_PULLUP);
|
|
efiSetPadModeWithoutOwnershipAcquisition("joy D", engineConfiguration->joystickDPin, PAL_MODE_INPUT_PULLUP);
|
|
}
|
|
|
|
void initJoystick() {
|
|
int channel;
|
|
addConsoleAction("joystickinfo", joystickInfo);
|
|
if (!isJoystickEnabled())
|
|
return;
|
|
|
|
channel = getHwPin("joy", engineConfiguration->joystickCenterPin);
|
|
efiExtiEnablePin("joy", engineConfiguration->joystickCenterPin, PAL_EVENT_MODE_RISING_EDGE, (palcallback_t)(void *)extCallback, (void *)channel);
|
|
channel = getHwPin("joy", engineConfiguration->joystickAPin);
|
|
efiExtiEnablePin("joy", engineConfiguration->joystickAPin, PAL_EVENT_MODE_RISING_EDGE, (palcallback_t)(void *)extCallback, (void *)channel);
|
|
// not used so far applyPin(engineConfiguration->joystickBPin);
|
|
// not used so far applyPin(engineConfiguration->joystickCPin);
|
|
channel = getHwPin("joy", engineConfiguration->joystickDPin);
|
|
efiExtiEnablePin("joy", engineConfiguration->joystickDPin, PAL_EVENT_MODE_RISING_EDGE, (palcallback_t)(void *)extCallback, (void *)channel);
|
|
}
|
|
|
|
#endif /* HAL_USE_PAL && EFI_JOYSTICK */
|