static void icuperiod_RightWheelFirstSensor(ICUDriver *icup) { last_period_RightWheelFirstSensor = icuGetPeriod(icup); if (timeStampRightWheelFirstSensor > timeStampRightWheelSecondSensor) { signRight = 1; } else { signRight = -1; } sign = min(signLeft, signRight); dRight += (sign * INCREMENT_RIGHT_WHEEL); }
static void icuperiodcb(ICUDriver *icup) { palClearPad(PORT_D, PD_LED2); last_period = icuGetPeriod(icup); }
static void icuperiod_LeftWheelSecondSensor(ICUDriver *icup) { last_period_LeftWheelSecondSensor = icuGetPeriod(icup); }
static void icuperiodcb(ICUDriver *icup) { palClearPad(GPIOE, GPIOE_LED9_BLUE); last_period = icuGetPeriod(icup); }
static void icuperiodcb(ICUDriver *icup) { palClearPad(GPIOD, GPIOD_LED4); last_period = icuGetPeriod(icup); }
static void icuperiod_CH2(ICUDriver *icup) { last_period_CH2 = icuGetPeriod(icup); }
static void icuperiodcb(ICUDriver *icup) { last_period = icuGetPeriod(icup); }