fome-fw/firmware/hw_layer/sensors/joystick.cpp

/**
 * @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 */