refactoring: time to unify digital pin API

This commit is contained in:
rusefi 2019-11-12 00:56:51 -05:00
parent 22da8a7dfe
commit 0ae6084301
6 changed files with 22 additions and 84 deletions

View File

@ -117,7 +117,7 @@ static void initWave(const char *name, int index) {
if (reader->hw != NULL) { if (reader->hw != NULL) {
reader->hw->setWidthCallback((VoidInt)(void*) waAnaWidthCallback, (void*) reader); reader->hw->setWidthCallback((VoidInt)(void*) waAnaWidthCallback, (void*) reader);
reader->hw->setPeridoCallback((VoidInt)(void*) waIcuPeriodCallback, (void*) reader); reader->hw->setPeriodCallback((VoidInt)(void*) waIcuPeriodCallback, (void*) reader);
} }
print("wave%d input on %s\r\n", index, hwPortname(brainPin)); print("wave%d input on %s\r\n", index, hwPortname(brainPin));

View File

@ -11,6 +11,6 @@ void digital_input_s::setWidthCallback(VoidInt handler, void *arg) {
widthListeners.registerCallback(handler, arg); widthListeners.registerCallback(handler, arg);
} }
void digital_input_s::setPeridoCallback(VoidInt handler, void *arg) { void digital_input_s::setPeriodCallback(VoidInt handler, void *arg) {
periodListeners.registerCallback(handler, arg); periodListeners.registerCallback(handler, arg);
} }

View File

@ -23,5 +23,5 @@ typedef struct {
// Width/Period names are historically inherited from ICU implementation, todo: migrate to better names, high/low? rise/hall? // Width/Period names are historically inherited from ICU implementation, todo: migrate to better names, high/low? rise/hall?
void setWidthCallback(VoidInt handler, void *arg); void setWidthCallback(VoidInt handler, void *arg);
void setPeridoCallback(VoidInt handler, void *arg); void setPeriodCallback(VoidInt handler, void *arg);
} digital_input_s; } digital_input_s;

View File

@ -22,6 +22,6 @@ void startTriggerInputPins(void);
void stopTriggerInputPins(void); void stopTriggerInputPins(void);
void setPrimaryChannel(brain_pin_e brainPin); void setPrimaryChannel(brain_pin_e brainPin);
void turnOffTriggerInputPin(brain_pin_e brainPin); void turnOffTriggerInputPin(brain_pin_e brainPin);
int turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft); void turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft);
#endif /* CRANK_INPUT_H_ */ #endif /* CRANK_INPUT_H_ */

View File

@ -64,7 +64,7 @@ static void cam_callback(void *arg) {
} }
} }
int turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft) { void turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft) {
brain_pin_e brainPin = isVvtShaft ? engineConfiguration->camInputs[index] : CONFIGB(triggerInputPins)[index]; brain_pin_e brainPin = isVvtShaft ? engineConfiguration->camInputs[index] : CONFIGB(triggerInputPins)[index];
scheduleMsg(logger, "turnOnTriggerInputPin(PAL) %s %s", msg, hwPortname(brainPin)); scheduleMsg(logger, "turnOnTriggerInputPin(PAL) %s %s", msg, hwPortname(brainPin));
@ -73,7 +73,7 @@ int turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft) {
* * do not set to both edges if we need only one * * do not set to both edges if we need only one
* * simplify callback in case of one edge */ * * simplify callback in case of one edge */
ioline_t pal_line = PAL_LINE(getHwPort("trg", brainPin), getHwPin("trg", brainPin)); ioline_t pal_line = PAL_LINE(getHwPort("trg", brainPin), getHwPin("trg", brainPin));
return efiExtiEnablePin(msg, brainPin, PAL_EVENT_MODE_BOTH_EDGES, isVvtShaft ? shaft_callback : cam_callback, (void *)pal_line); efiExtiEnablePin(msg, brainPin, PAL_EVENT_MODE_BOTH_EDGES, isVvtShaft ? shaft_callback : cam_callback, (void *)pal_line);
} }
void turnOffTriggerInputPin(brain_pin_e brainPin) { void turnOffTriggerInputPin(brain_pin_e brainPin) {

View File

@ -28,15 +28,13 @@ extern bool hasFirmwareErrorFlag;
static Logging *logger; static Logging *logger;
static ICUDriver *primaryCrankDriver; static void cam_icu_width_callback(void *arg) {
(void)arg;
static void cam_icu_width_callback(ICUDriver *icup) {
(void)icup;
hwHandleVvtCamSignal(TV_RISE); hwHandleVvtCamSignal(TV_RISE);
} }
static void cam_icu_period_callback(ICUDriver *icup) { static void cam_icu_period_callback(void *arg) {
(void)icup; (void)arg;
hwHandleVvtCamSignal(TV_FALL); hwHandleVvtCamSignal(TV_FALL);
} }
@ -44,7 +42,7 @@ static void cam_icu_period_callback(ICUDriver *icup) {
* that's hardware timer input capture IRQ entry point * that's hardware timer input capture IRQ entry point
* 'width' events happens before the 'period' event * 'width' events happens before the 'period' event
*/ */
static void shaft_icu_width_callback(ICUDriver *icup) { static void shaftWidthCallback(bool isPrimary) {
if (!engine->hwTriggerInputEnabled) { if (!engine->hwTriggerInputEnabled) {
return; return;
} }
@ -53,7 +51,6 @@ static void shaft_icu_width_callback(ICUDriver *icup) {
// todo: start using real event time from HW event, not just software timer? // todo: start using real event time from HW event, not just software timer?
if (hasFirmwareErrorFlag) if (hasFirmwareErrorFlag)
return; return;
int isPrimary = icup == primaryCrankDriver;
if (!isPrimary && !TRIGGER_SHAPE(needSecondTriggerInput)) { if (!isPrimary && !TRIGGER_SHAPE(needSecondTriggerInput)) {
return; return;
} }
@ -64,14 +61,13 @@ static void shaft_icu_width_callback(ICUDriver *icup) {
hwHandleShaftSignal(signal); hwHandleShaftSignal(signal);
} }
static void shaft_icu_period_callback(ICUDriver *icup) { static void shaftPeriodCallback(bool isPrimary) {
if (!engine->hwTriggerInputEnabled) { if (!engine->hwTriggerInputEnabled) {
return; return;
} }
icuWidthPeriodCounter++; icuWidthPeriodCounter++;
if (hasFirmwareErrorFlag) if (hasFirmwareErrorFlag)
return; return;
int isPrimary = icup == primaryCrankDriver;
if (!isPrimary && !TRIGGER_SHAPE(needSecondTriggerInput)) { if (!isPrimary && !TRIGGER_SHAPE(needSecondTriggerInput)) {
return; return;
} }
@ -83,89 +79,31 @@ static void shaft_icu_period_callback(ICUDriver *icup) {
hwHandleShaftSignal(signal); hwHandleShaftSignal(signal);
} }
/** void turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft) {
* the main purpose of this configuration structure is to specify the input interrupt callbacks
*/
static ICUConfig shaft_icucfg = { ICU_INPUT_ACTIVE_LOW,
100000, /* 100kHz ICU clock frequency. */
shaft_icu_width_callback,
shaft_icu_period_callback,
NULL,
ICU_CHANNEL_1,
0};
/**
* this is about VTTi and stuff kind of cam sensor
*/
static ICUConfig cam_icucfg = { ICU_INPUT_ACTIVE_LOW,
100000, /* 100kHz ICU clock frequency. */
cam_icu_width_callback,
cam_icu_period_callback,
NULL,
ICU_CHANNEL_1,
0};
int turnOnTriggerInputPin(const char *msg, int index, bool isVvtShaft) {
brain_pin_e brainPin = isVvtShaft ? engineConfiguration->camInputs[index] : CONFIGB(triggerInputPins)[index]; brain_pin_e brainPin = isVvtShaft ? engineConfiguration->camInputs[index] : CONFIGB(triggerInputPins)[index];
ICUConfig *icucfg;
if (brainPin == GPIO_UNASSIGNED) { if (brainPin == GPIO_UNASSIGNED) {
return -1; return;
} }
//digital_input_s* input = startDigitalCapture("trigger", brainPin, true); digital_input_s* input = startDigitalCapture("trigger", brainPin, true);
if (isVvtShaft) { if (isVvtShaft) {
icucfg = &shaft_icucfg; input->setWidthCallback((VoidInt)(void*)shaftWidthCallback, NULL);
input->setPeriodCallback((VoidInt)(void*)shaftPeriodCallback, NULL);
} else { } else {
icucfg = &cam_icucfg; void * arg = (void*) (index == 0);
input->setWidthCallback((VoidInt)(void*)shaftWidthCallback, arg);
input->setPeriodCallback((VoidInt)(void*)shaftPeriodCallback, arg);
} }
// configure pin
turnOnCapturePin(msg, brainPin);
icucfg->channel = getInputCaptureChannel(brainPin);
ICUDriver *driver = getInputCaptureDriver(msg, brainPin);
scheduleMsg(logger, "turnOnTriggerInputPin %s", hwPortname(brainPin));
// todo: reuse 'setWaveReaderMode' method here?
if (driver != NULL) {
// todo: once http://forum.chibios.org/phpbb/viewtopic.php?f=16&t=1757 is fixed
// bool needWidthCallback = !CONFIG(useOnlyRisingEdgeForTrigger) || TRIGGER_SHAPE(useRiseEdge);
// shaft_icucfg.width_cb = needWidthCallback ? shaft_icu_width_callback : NULL;
// bool needPeriodCallback = !CONFIG(useOnlyRisingEdgeForTrigger) || !TRIGGER_SHAPE(useRiseEdge);
// shaft_icucfg.period_cb = needPeriodCallback ? shaft_icu_period_callback : NULL;
efiIcuStart(msg, driver, icucfg);
if (driver->state == ICU_READY) {
efiAssert(CUSTOM_ERR_ASSERT, driver != NULL, "ti: driver is NULL", -1);
efiAssert(CUSTOM_ERR_ASSERT, driver->state == ICU_READY, "ti: driver not ready", -1);
icuStartCapture(driver); // this would change state from READY to WAITING
icuEnableNotifications(driver);
} else {
// we would be here for example if same pin is used for multiple input capture purposes
firmwareError(CUSTOM_ERR_ICU_STATE, "ICU unexpected state [%s]", hwPortname(brainPin));
}
}
return 0;
} }
void turnOffTriggerInputPin(brain_pin_e brainPin) { void turnOffTriggerInputPin(brain_pin_e brainPin) {
ICUDriver *driver = getInputCaptureDriver("trigger_off", brainPin); removeWaveAnalyzerDriver("trigger", brainPin);
if (driver != NULL) {
icuDisableNotifications(driver);
icuStopCapture(driver);
icuStop(driver);
scheduleMsg(logger, "turnOffTriggerInputPin %s", hwPortname(brainPin));
turnOffCapturePin(brainPin);
}
} }
void setPrimaryChannel(brain_pin_e brainPin) { void setPrimaryChannel(brain_pin_e brainPin) {
primaryCrankDriver = getInputCaptureDriver("primary", brainPin);
} }
/*==========================================================================*/ /*==========================================================================*/