trigger_input_comp.cpp File Reference

Detailed Description

Position sensor hardware layer, Using hardware comparator.

Date

Apr 13, 2019

Author

Andrey Belomutskiy, (c) 2012-2020

andreika prome.nosp@m.theu.nosp@m.s.pcb.nosp@m.@gma.nosp@m.il.co.nosp@m.m

Definition in file trigger_input_comp.cpp.

Functions
static void	setHysteresis (COMPDriver *comp, int sign)
static void	comp_shaft_callback (COMPDriver *comp)
static void	comp_cam_callback (COMPDriver *comp)
void	onEcuStartTriggerImplementation ()
static int	getDacValue (uint8_t voltage)
void	startTriggerInputPins ()
void	stopTriggerInputPins ()

Variables
static volatile int	centeredDacValue = 127
static volatile int	toothCnt = 0
static volatile int	dacHysteresisMin = 1
static volatile int	dacHysteresisMax = 15
static volatile int	dacHysteresisDelta = dacHysteresisMin
static volatile int	hystUpdatePeriodNumEvents = 116
static volatile efitick_t	prevNt = 0
static volatile float	curVrFreqNt = 0
static volatile float	saturatedVrFreqNt = 0
static COMPConfig	comp_shaft_cfg
static bool	isCompEnabled = false

Function Documentation

comp_cam_callback()

static void comp_cam_callback ( COMPDriver *  comp )

static

Definition at line 70 of file trigger_input_comp.cpp.

                                                {
    efitick_t stamp = getTimeNowNt();
 
    hwHandleVvtCamSignal(isRising, stamp, index);
}

Here is the call graph for this function:

comp_shaft_callback()

static void comp_shaft_callback ( COMPDriver *  comp )

static

Definition at line 49 of file trigger_input_comp.cpp.

                                                  {
    efitick_t stamp = getTimeNowNt();
    
    uint32_t status = comp_lld_get_status(comp);
    int isPrimary = (comp == EFI_COMP_PRIMARY_DEVICE);
 
    if (status & COMP_IRQ_RISING) {
        hwHandleShaftSignal(isPrimary ? 0 : 1, true, stamp);
        // shift the threshold down a little bit to avoid false-triggering (threshold hysteresis)
        setHysteresis(comp, -1);
    }
 
    if (status & COMP_IRQ_FALLING) {
        hwHandleShaftSignal(isPrimary ? 0 : 1, false, stamp);
        // shift the threshold up a little bit to avoid false-triggering (threshold hysteresis)
        setHysteresis(comp, 1);
    }
}

Here is the call graph for this function:

getDacValue()

static int getDacValue ( uint8_t  voltage )

static

Definition at line 90 of file trigger_input_comp.cpp.

                                        {
    constexpr float maxDacValue = 255.0f;   // 8-bit DAC
    return (int)efiRound(maxDacValue * (float)voltage * VOLTAGE_1_BYTE_PACKING_DIV / engineConfiguration->adcVcc, 1.0f);
}

Referenced by startTriggerInputPins().

Here is the call graph for this function:

Here is the caller graph for this function:

onEcuStartTriggerImplementation()

void onEcuStartTriggerImplementation

(

)

Definition at line 85 of file trigger_input_comp.cpp.

                                       {
    compInit();
    compStart(EFI_COMP_PRIMARY_DEVICE, &comp_shaft_cfg);
}

setHysteresis()

static void setHysteresis ( COMPDriver *  comp, int  sign  )

static

Definition at line 32 of file trigger_input_comp.cpp.

                                                      {
    // update the hysteresis threshold, but not for every tooth
#ifdef EFI_TRIGGER_COMP_ADAPTIVE_HYSTERESIS
    if (toothCnt++ > hystUpdatePeriodNumEvents) {
        efitick_t nowNt = getTimeNowNt();
        curVrFreqNt = (float)toothCnt / (float)(nowNt - prevNt);
        dacHysteresisDelta = (int)efiRound(interpolateClamped(0.0f, dacHysteresisMin, saturatedVrFreqNt, dacHysteresisMax, curVrFreqNt), 1.0f);
        toothCnt = 0;
        prevNt = nowNt;
#ifdef TRIGGER_COMP_EXTREME_LOGGING
        efiPrintf("* f=%f d=%d", curVrFreqNt * 1000.0f, dacHysteresisDelta);
#endif /* TRIGGER_COMP_EXTREME_LOGGING */
    }
#endif /* EFI_TRIGGER_COMP_ADAPTIVE_HYSTERESIS */
    comp_lld_set_dac_value(comp, centeredDacValue + dacHysteresisDelta * sign);
}

Referenced by comp_shaft_callback().

Here is the call graph for this function:

Here is the caller graph for this function:

startTriggerInputPins()

void startTriggerInputPins

(

)

Definition at line 95 of file trigger_input_comp.cpp.

                             {
    if (isCompEnabled) {
        efiPrintf("startTIPins(): already enabled!");
        return;
    }
 
    centeredDacValue = getDacValue(engineConfiguration->triggerCompCenterVolt); // usually 2.5V resistor divider
    
    dacHysteresisMin = getDacValue(engineConfiguration->triggerCompHystMin);    // usually ~20mV
    dacHysteresisMax = getDacValue(engineConfiguration->triggerCompHystMax);    // usually ~300mV
    dacHysteresisDelta = dacHysteresisMin;
    
    // 20 rpm (60_2) = 1000*60/((2*60)*20) = 25 ms for 1 tooth event
    float satRpm = engineConfiguration->triggerCompSensorSatRpm;
    hystUpdatePeriodNumEvents = engine->triggerCentral.triggerShape.getSize();  // = 116 for "60-2" trigger wheel
    float saturatedToothDurationUs = 60.0f * US_PER_SECOND_F / satRpm / hystUpdatePeriodNumEvents;
    saturatedVrFreqNt = 1.0f / US2NT(saturatedToothDurationUs);
    
    efiPrintf("startTIPins(): cDac=%d hystMin=%d hystMax=%d satRpm=%.0f satFreq*1k=%f period=%d", 
        centeredDacValue, dacHysteresisMin, dacHysteresisMax, satRpm, saturatedVrFreqNt * 1000.0f, hystUpdatePeriodNumEvents);
#ifdef EFI_TRIGGER_COMP_ADAPTIVE_HYSTERESIS
    efiPrintf("startTIPins(): ADAPTIVE_HYSTERESIS enabled!");
#endif /* EFI_TRIGGER_COMP_ADAPTIVE_HYSTERESIS */
        
    int channel = EFI_COMP_TRIGGER_CHANNEL; // todo: use getInputCaptureChannel(hwPin);
 
    // todo: set pin mode to default (analog/comparator)
    //palSetPadMode(comp_channel_port[channel], comp_channel_pad[channel], PAL_MODE_INPUT_ANALOG);
    
    // no generic hal support for extended COMP configuration, so we use hal_lld layer...
    osalSysLock();
    comp_lld_set_dac_value(EFI_COMP_PRIMARY_DEVICE, centeredDacValue);
    comp_lld_channel_enable(EFI_COMP_PRIMARY_DEVICE, channel);
    osalSysUnlock();
    
    compEnable(EFI_COMP_PRIMARY_DEVICE);
    isCompEnabled = true;
}

Here is the call graph for this function:

stopTriggerInputPins()

void stopTriggerInputPins

(

)

Definition at line 134 of file trigger_input_comp.cpp.

                            {
    if (!isCompEnabled) {
        efiPrintf("stopTIPins(): already disabled!");
        return;
    }
 
    efiPrintf("stopTIPins();");
 
    compDisable(EFI_COMP_PRIMARY_DEVICE);
    isCompEnabled = false;
#if 0
    for (int i = 0; i < TRIGGER_INPUT_PIN_COUNT; i++) {
        if (isConfigurationChanged(bc.triggerInputPins[i])) {
            turnOffTriggerInputPin(activeConfiguration.bc.triggerInputPins[i]);
        }
    }
    if (isConfigurationChanged(camInput)) {
        turnOffTriggerInputPin(activeConfiguration.camInput);
    }
#endif
}

Here is the call graph for this function:

Variable Documentation

centeredDacValue

volatile int centeredDacValue = 127

static

Definition at line 18 of file trigger_input_comp.cpp.

Referenced by setHysteresis(), and startTriggerInputPins().

comp_shaft_cfg

COMPConfig comp_shaft_cfg

static

Initial value:

= {
    COMP_OUTPUT_NORMAL, COMP_IRQ_BOTH,
    comp_shaft_callback,
    0
}

Definition at line 77 of file trigger_input_comp.cpp.

                                   {
    COMP_OUTPUT_NORMAL, COMP_IRQ_BOTH,
    comp_shaft_callback,
    0
};

Referenced by onEcuStartTriggerImplementation().

curVrFreqNt

volatile float curVrFreqNt = 0

static

Definition at line 26 of file trigger_input_comp.cpp.

Referenced by setHysteresis().

dacHysteresisDelta

volatile int dacHysteresisDelta = dacHysteresisMin

static

Definition at line 22 of file trigger_input_comp.cpp.

Referenced by setHysteresis(), and startTriggerInputPins().

dacHysteresisMax

volatile int dacHysteresisMax = 15

static

Definition at line 21 of file trigger_input_comp.cpp.

Referenced by setHysteresis(), and startTriggerInputPins().

dacHysteresisMin

volatile int dacHysteresisMin = 1

static

Definition at line 20 of file trigger_input_comp.cpp.

Referenced by setHysteresis(), and startTriggerInputPins().

hystUpdatePeriodNumEvents

volatile int hystUpdatePeriodNumEvents = 116

static

Definition at line 23 of file trigger_input_comp.cpp.

Referenced by setHysteresis(), and startTriggerInputPins().

isCompEnabled

bool isCompEnabled = false

static

Definition at line 83 of file trigger_input_comp.cpp.

Referenced by startTriggerInputPins(), and stopTriggerInputPins().

prevNt

volatile efitick_t prevNt = 0

static

Definition at line 24 of file trigger_input_comp.cpp.

Referenced by setHysteresis().

saturatedVrFreqNt

volatile float saturatedVrFreqNt = 0

static

Definition at line 26 of file trigger_input_comp.cpp.

Referenced by setHysteresis(), and startTriggerInputPins().

toothCnt

volatile int toothCnt = 0

static

Definition at line 19 of file trigger_input_comp.cpp.

Referenced by setHysteresis().

Go to the source code of this file.