rusefi-1/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 "engine.h"

#if (HAL_USE_PAL && EFI_JOYSTICK)
#include "joystick.h"
#include "pin_repository.h"
#include "digital_input_exti.h"

EXTERN_ENGINE
;

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 Logging *sharedLogger;
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", CONFIG(joystickCenterPin))) {
		joyCenter++;
		button = JB_CENTER;
	} else if (channel == getHwPin("joy", CONFIG(joystickAPin))) {
		joyA++;
		button = JB_BUTTON_A;
/* not used so far
	} else if (channel == getHwPin("joy", CONFIG(joystickBPin))) {
		joyB++;
		button = JB_BUTTON_B;
	} else if (channel == getHwPin("joy", CONFIG(joystickCPin))) {
		joyC++;
		button = JB_BUTTON_C;
*/
	} else if (channel == getHwPin("joy", CONFIG(joystickDPin))) {
		joyD++;
		button = JB_BUTTON_D;
	} else {
		// unexpected channel
		return;
	}
#if EFI_HD44780_LCD
	onJoystick(button);
#else
	UNUSED(button);
#endif
}

static void joystickInfo(void) {
	scheduleMsg(sharedLogger, "total %d center=%d@%s", joyTotal, joyCenter,
			hwPortname(CONFIG(joystickCenterPin)));
	scheduleMsg(sharedLogger, "a=%d@%s", joyA, hwPortname(CONFIG(joystickAPin)));
	scheduleMsg(sharedLogger, "b=%d@%s", joyB, hwPortname(CONFIG(joystickBPin)));
	scheduleMsg(sharedLogger, "c=%d@%s", joyC, hwPortname(CONFIG(joystickCPin)));
	scheduleMsg(sharedLogger, "d=%d@%s", joyD, hwPortname(CONFIG(joystickDPin)));
}

static bool isJoystickEnabled() {
	return CONFIG(joystickCenterPin) != GPIO_UNASSIGNED ||
			CONFIG(joystickAPin) != GPIO_UNASSIGNED ||
			// not used so far			CONFIG(joystickBPin) != GPIO_UNASSIGNED ||
			// not used so far	CONFIG(joystickCPin) != GPIO_UNASSIGNED ||
			CONFIG(joystickDPin) != GPIO_UNASSIGNED;
}

void stopJoystickPins() {
	brain_pin_markUnused(activeConfiguration.joystickCenterPin);
	brain_pin_markUnused(activeConfiguration.joystickAPin);
	brain_pin_markUnused(activeConfiguration.joystickDPin);
}

void startJoystickPins() {
	// todo: extract 'configurePalInputPin() method?
	efiSetPadMode("joy center", CONFIG(joystickCenterPin), PAL_MODE_INPUT_PULLUP);
	efiSetPadMode("joy A", CONFIG(joystickAPin), PAL_MODE_INPUT_PULLUP);
	// not used so far	efiSetPadMode("joy B", CONFIG(joystickBPin), PAL_MODE_INPUT_PULLUP);
	// not used so far	efiSetPadMode("joy C", CONFIG(joystickCPin), PAL_MODE_INPUT_PULLUP);
	efiSetPadMode("joy D", CONFIG(joystickDPin), PAL_MODE_INPUT_PULLUP);
}

void initJoystick(Logging *shared) {
	int channel;
	addConsoleAction("joystickinfo", joystickInfo);
	if (!isJoystickEnabled())
		return;
	sharedLogger = shared;

	channel = getHwPin("joy", CONFIG(joystickCenterPin));
	efiExtiEnablePin("joy", CONFIG(joystickCenterPin), PAL_EVENT_MODE_RISING_EDGE, (palcallback_t)(void *)extCallback, (void *)channel);
	channel = getHwPin("joy", CONFIG(joystickAPin));
	efiExtiEnablePin("joy", CONFIG(joystickAPin), PAL_EVENT_MODE_RISING_EDGE, (palcallback_t)(void *)extCallback, (void *)channel);
// not used so far	applyPin(CONFIG(joystickBPin));
// not used so far	applyPin(CONFIG(joystickCPin));
	channel = getHwPin("joy", CONFIG(joystickDPin));
	efiExtiEnablePin("joy", CONFIG(joystickDPin), PAL_EVENT_MODE_RISING_EDGE, (palcallback_t)(void *)extCallback, (void *)channel);

	startJoystickPins();
}

#endif /* HAL_USE_PAL && EFI_JOYSTICK */