auto-sync
This commit is contained in:
parent
8e6d695f67
commit
ce421ea91f
|
@ -102,6 +102,8 @@ typedef enum {
|
||||||
Force_4b_engine_type = ENUM_SIZE_HACK,
|
Force_4b_engine_type = ENUM_SIZE_HACK,
|
||||||
} engine_type_e;
|
} engine_type_e;
|
||||||
|
|
||||||
|
#define DEFAULT_ENGINE_TYPE CUSTOM_ENGINE
|
||||||
|
|
||||||
typedef enum {
|
typedef enum {
|
||||||
TT_TOOTHED_WHEEL = 0,
|
TT_TOOTHED_WHEEL = 0,
|
||||||
TT_FORD_ASPIRE = 1,
|
TT_FORD_ASPIRE = 1,
|
||||||
|
|
|
@ -22,7 +22,6 @@
|
||||||
|
|
||||||
#include "engine.h"
|
#include "engine.h"
|
||||||
|
|
||||||
#define DEFAULT_ENGINE_TYPE CUSTOM_ENGINE
|
|
||||||
|
|
||||||
static bool needToWriteConfiguration = false;
|
static bool needToWriteConfiguration = false;
|
||||||
|
|
||||||
|
|
|
@ -15,7 +15,7 @@
|
||||||
* http://www.intersil.com/content/dam/Intersil/documents/an97/an9770.pdf
|
* http://www.intersil.com/content/dam/Intersil/documents/an97/an9770.pdf
|
||||||
* http://e2e.ti.com/cfs-file/__key/telligent-evolution-components-attachments/00-26-01-00-00-42-36-40/TPIC8101-Training.pdf
|
* http://e2e.ti.com/cfs-file/__key/telligent-evolution-components-attachments/00-26-01-00-00-42-36-40/TPIC8101-Training.pdf
|
||||||
*
|
*
|
||||||
* SPI frequency: 5MHz
|
* SPI frequency: 5MHz max
|
||||||
*
|
*
|
||||||
* @date Nov 27, 2013
|
* @date Nov 27, 2013
|
||||||
* @author Andrey Belomutskiy, (c) 2012-2014
|
* @author Andrey Belomutskiy, (c) 2012-2014
|
||||||
|
@ -31,9 +31,13 @@
|
||||||
|
|
||||||
#if EFI_HIP_9011 || defined(__DOXYGEN__)
|
#if EFI_HIP_9011 || defined(__DOXYGEN__)
|
||||||
|
|
||||||
|
#define HIP_DEBUG FALSE
|
||||||
|
|
||||||
extern pin_output_mode_e DEFAULT_OUTPUT;
|
extern pin_output_mode_e DEFAULT_OUTPUT;
|
||||||
|
|
||||||
static int bandIndex;
|
static int bandIndex;
|
||||||
|
static int intergratorIndex = -1;
|
||||||
|
static bool_t isHip9011Busy = false;
|
||||||
|
|
||||||
static scheduling_s startTimer[2];
|
static scheduling_s startTimer[2];
|
||||||
static scheduling_s endTimer[2];
|
static scheduling_s endTimer[2];
|
||||||
|
@ -53,7 +57,9 @@ static scheduling_s endTimer[2];
|
||||||
|
|
||||||
static Logging logger;
|
static Logging logger;
|
||||||
|
|
||||||
|
#if HIP_DEBUG
|
||||||
static THD_WORKING_AREA(htThreadStack, UTILITY_THREAD_STACK_SIZE);
|
static THD_WORKING_AREA(htThreadStack, UTILITY_THREAD_STACK_SIZE);
|
||||||
|
#endif
|
||||||
|
|
||||||
// SPI_CR1_BR_1 // 5MHz
|
// SPI_CR1_BR_1 // 5MHz
|
||||||
// SPI_CR1_CPHA Clock Phase
|
// SPI_CR1_CPHA Clock Phase
|
||||||
|
@ -69,6 +75,13 @@ SPI_CR1_MSTR |
|
||||||
static unsigned char tx_buff[1];
|
static unsigned char tx_buff[1];
|
||||||
static unsigned char rx_buff[1];
|
static unsigned char rx_buff[1];
|
||||||
|
|
||||||
|
#define SPI_SYNCHRONOUS(value) \
|
||||||
|
spiSelect(driver); \
|
||||||
|
tx_buff[0] = value; \
|
||||||
|
spiExchange(driver, 1, tx_buff, rx_buff); \
|
||||||
|
spiUnselect(driver);
|
||||||
|
|
||||||
|
// todo: make this configurable
|
||||||
static SPIDriver *driver = &SPID2;
|
static SPIDriver *driver = &SPID2;
|
||||||
|
|
||||||
static msg_t ivThread(int param) {
|
static msg_t ivThread(int param) {
|
||||||
|
@ -100,19 +113,19 @@ static msg_t ivThread(int param) {
|
||||||
// tx_buff[0] = SET_ADVANCED_MODE;
|
// tx_buff[0] = SET_ADVANCED_MODE;
|
||||||
// spiExchange(driver, 1, tx_buff, rx_buff);
|
// spiExchange(driver, 1, tx_buff, rx_buff);
|
||||||
|
|
||||||
// BAND_PASS_CMD
|
// BAND_PASS_CMD
|
||||||
tx_buff[0] = 0b00000000 | (40 & 0x3F);
|
tx_buff[0] = 0b00000000 | (40 & 0x3F);
|
||||||
spiExchange(driver, 1, tx_buff, rx_buff);
|
spiExchange(driver, 1, tx_buff, rx_buff);
|
||||||
|
|
||||||
// Set the gain
|
// Set the gain
|
||||||
tx_buff[0] = 0b10000000 | (49 & 0x3F);
|
tx_buff[0] = 0b10000000 | (49 & 0x3F);
|
||||||
spiExchange(driver, 1, tx_buff, rx_buff);
|
spiExchange(driver, 1, tx_buff, rx_buff);
|
||||||
|
|
||||||
// Set the integration time constant
|
// Set the integration time constant
|
||||||
tx_buff[0] = 0b11000000 | (31 & 0x1F);
|
tx_buff[0] = 0b11000000 | (31 & 0x1F);
|
||||||
spiExchange(driver, 1, tx_buff, rx_buff);
|
spiExchange(driver, 1, tx_buff, rx_buff);
|
||||||
|
|
||||||
// SET_ADVANCED_MODE
|
// SET_ADVANCED_MODE
|
||||||
tx_buff[0] = 0b01110001;
|
tx_buff[0] = 0b01110001;
|
||||||
spiExchange(driver, 1, tx_buff, rx_buff);
|
spiExchange(driver, 1, tx_buff, rx_buff);
|
||||||
|
|
||||||
|
@ -132,15 +145,19 @@ EXTERN_ENGINE
|
||||||
/**
|
/**
|
||||||
* These are HIP9011 magic values - integrator time constants in uS
|
* These are HIP9011 magic values - integrator time constants in uS
|
||||||
*/
|
*/
|
||||||
static const int integratorValues[INT_TIME_COUNT] = { 40, 45, 50, 55, 60, 65, 70, 75, 80, 90, 100, 110, 120, 130, 140,
|
static const int integratorValues[INT_TIME_COUNT] = { 40, 45, 50, 55, 60, 65,
|
||||||
150, 160, 180, 200, 220, 240, 260, 280, 300, 320, 360, 400, 440, 480, 520, 560, 600 };
|
70, 75, 80, 90, 100, 110, 120, 130, 140, 150, 160, 180, 200, 220, 240,
|
||||||
|
260, 280, 300, 320, 360, 400, 440, 480, 520, 560, 600 };
|
||||||
|
|
||||||
#define BAND_LOOKUP_SIZE 64
|
#define BAND_LOOKUP_SIZE 64
|
||||||
|
|
||||||
static const float bandFreqLookup[BAND_LOOKUP_SIZE] = { 1.22, 1.26, 1.31, 1.35, 1.4, 1.45, 1.51, 1.57, 1.63, 1.71, 1.78,
|
static const float bandFreqLookup[BAND_LOOKUP_SIZE] = { 1.22, 1.26, 1.31, 1.35,
|
||||||
1.87, 1.96, 2.07, 2.18, 2.31, 2.46, 2.54, 2.62, 2.71, 2.81, 2.92, 3.03, 3.15, 3.28, 3.43, 3.59, 3.76, 3.95,
|
1.4, 1.45, 1.51, 1.57, 1.63, 1.71, 1.78, 1.87, 1.96, 2.07, 2.18, 2.31,
|
||||||
4.16, 4.39, 4.66, 4.95, 5.12, 5.29, 5.48, 5.68, 5.9, 6.12, 6.37, 6.64, 6.94, 7.27, 7.63, 8.02, 8.46, 8.95, 9.5,
|
2.46, 2.54, 2.62, 2.71, 2.81, 2.92, 3.03, 3.15, 3.28, 3.43, 3.59, 3.76,
|
||||||
10.12, 10.46, 10.83, 11.22, 11.65, 12.1, 12.6, 13.14, 13.72, 14.36, 15.07, 15.84, 16.71, 17.67, 18.76, 19.98 };
|
3.95, 4.16, 4.39, 4.66, 4.95, 5.12, 5.29, 5.48, 5.68, 5.9, 6.12, 6.37,
|
||||||
|
6.64, 6.94, 7.27, 7.63, 8.02, 8.46, 8.95, 9.5, 10.12, 10.46, 10.83,
|
||||||
|
11.22, 11.65, 12.1, 12.6, 13.14, 13.72, 14.36, 15.07, 15.84, 16.71,
|
||||||
|
17.67, 18.76, 19.98 };
|
||||||
|
|
||||||
#define PIF 3.14159f
|
#define PIF 3.14159f
|
||||||
|
|
||||||
|
@ -155,26 +172,34 @@ static float rpmLookup[INT_TIME_COUNT];
|
||||||
* 2.2 volts should
|
* 2.2 volts should
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
#define DESIRED_OUTPUT_VALUE 2.2f
|
#define DESIRED_OUTPUT_VALUE 5.0f
|
||||||
static void prepareRpmLookup(engine_configuration_s *engineConfiguration) {
|
static void prepareRpmLookup(engine_configuration_s *engineConfiguration) {
|
||||||
for (int i = 0; i < INT_TIME_COUNT; i++) {
|
for (int i = 0; i < INT_TIME_COUNT; i++) {
|
||||||
float windowWidthMult = (engineConfiguration->knockDetectionWindowEnd
|
float windowWidthMult = (engineConfiguration->knockDetectionWindowEnd
|
||||||
- engineConfiguration->knockDetectionWindowStart) / 360.0f;
|
- engineConfiguration->knockDetectionWindowStart) / 360.0f;
|
||||||
// '60000000' because revolutions per MINUTE in uS conversion
|
// '60000000' because revolutions per MINUTE in uS conversion
|
||||||
|
|
||||||
rpmLookup[i] = 60000000.0f / (integratorValues[i] * 2 * PIF * DESIRED_OUTPUT_VALUE * windowWidthMult);
|
rpmLookup[i] = 60000000.0f
|
||||||
|
/ (integratorValues[i] * 2 * PIF * DESIRED_OUTPUT_VALUE
|
||||||
|
* windowWidthMult);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#define BAND(bore) (900 / (PIF * (bore) / 2))
|
#define BAND(bore) (900 / (PIF * (bore) / 2))
|
||||||
|
|
||||||
|
#define INTEGRATOR_INDEX findIndex(rpmLookup, INT_TIME_COUNT, engine->rpmCalculator.rpmValue)
|
||||||
|
|
||||||
static void showHipInfo(void) {
|
static void showHipInfo(void) {
|
||||||
printSpiState(&logger, boardConfiguration);
|
printSpiState(&logger, boardConfiguration);
|
||||||
scheduleMsg(&logger, "bore=%f freq=%f", engineConfiguration->cylinderBore, BAND(engineConfiguration->cylinderBore));
|
scheduleMsg(&logger, "bore=%f freq=%f", engineConfiguration->cylinderBore,
|
||||||
|
BAND(engineConfiguration->cylinderBore));
|
||||||
|
|
||||||
scheduleMsg(&logger, "band index=%d", bandIndex);
|
scheduleMsg(&logger, "band index=%d", bandIndex);
|
||||||
|
|
||||||
scheduleMsg(&logger, "spi= int=%s CS=%s", hwPortname(boardConfiguration->hip9011IntHoldPin),
|
scheduleMsg(&logger, "integrator index=%d", INTEGRATOR_INDEX);
|
||||||
|
|
||||||
|
scheduleMsg(&logger, "spi= int=%s CS=%s",
|
||||||
|
hwPortname(boardConfiguration->hip9011IntHoldPin),
|
||||||
hwPortname(boardConfiguration->hip9011CsPin));
|
hwPortname(boardConfiguration->hip9011CsPin));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -188,10 +213,41 @@ void setHip9011FrankensoPinout(void) {
|
||||||
boardConfiguration->is_enabled_spi_2 = true;
|
boardConfiguration->is_enabled_spi_2 = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void startIntegration(void) {
|
||||||
|
if(isHip9011Busy)
|
||||||
|
return;
|
||||||
|
|
||||||
|
|
||||||
|
turnPinHigh(HIP9011_INT_HOLD);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
static void endIntegration(void) {
|
||||||
|
|
||||||
|
turnPinLow(HIP9011_INT_HOLD);
|
||||||
|
/**
|
||||||
|
* SPI communication is only allowed while not integrading, so we initiate the exchange
|
||||||
|
* once we are done inregratng
|
||||||
|
*/
|
||||||
|
|
||||||
|
isHip9011Busy = true;
|
||||||
|
|
||||||
|
int newValue = INTEGRATOR_INDEX;
|
||||||
|
if (newValue != intergratorIndex) {
|
||||||
|
intergratorIndex = newValue;
|
||||||
|
// todo: send new value, be sure to use non-synchnonious approach!
|
||||||
|
|
||||||
|
}
|
||||||
|
// todo: move this into the end callback
|
||||||
|
isHip9011Busy = false;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Shaft Position callback used to start or finish HIP integration
|
* Shaft Position callback used to start or finish HIP integration
|
||||||
*/
|
*/
|
||||||
static void intHoldCallback(trigger_event_e ckpEventType, uint32_t index DECLARE_ENGINE_PARAMETER_S) {
|
static void intHoldCallback(trigger_event_e ckpEventType,
|
||||||
|
uint32_t index DECLARE_ENGINE_PARAMETER_S) {
|
||||||
// this callback is invoked on interrupt thread
|
// this callback is invoked on interrupt thread
|
||||||
|
|
||||||
if (index != 0)
|
if (index != 0)
|
||||||
|
@ -203,10 +259,13 @@ static void intHoldCallback(trigger_event_e ckpEventType, uint32_t index DECLARE
|
||||||
|
|
||||||
int structIndex = getRevolutionCounter() % 2;
|
int structIndex = getRevolutionCounter() % 2;
|
||||||
// todo: schedule this based on closest trigger event, same as ignition works
|
// todo: schedule this based on closest trigger event, same as ignition works
|
||||||
scheduleByAngle(rpm, &startTimer[structIndex], engineConfiguration->knockDetectionWindowStart,
|
scheduleByAngle(rpm, &startTimer[structIndex],
|
||||||
(schfunc_t) &turnPinHigh, (void*) HIP9011_INT_HOLD);
|
engineConfiguration->knockDetectionWindowStart,
|
||||||
scheduleByAngle(rpm, &endTimer[structIndex], engineConfiguration->knockDetectionWindowEnd, (schfunc_t) &turnPinLow,
|
(schfunc_t) &startIntegration, NULL);
|
||||||
(void*) HIP9011_INT_HOLD);
|
scheduleByAngle(rpm, &endTimer[structIndex],
|
||||||
|
engineConfiguration->knockDetectionWindowEnd,
|
||||||
|
(schfunc_t) &endIntegration,
|
||||||
|
NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
void initHip9011(void) {
|
void initHip9011(void) {
|
||||||
|
@ -219,15 +278,37 @@ void initHip9011(void) {
|
||||||
spicfg.ssport = getHwPort(boardConfiguration->hip9011CsPin);
|
spicfg.ssport = getHwPort(boardConfiguration->hip9011CsPin);
|
||||||
spicfg.sspad = getHwPin(boardConfiguration->hip9011CsPin);
|
spicfg.sspad = getHwPin(boardConfiguration->hip9011CsPin);
|
||||||
|
|
||||||
|
|
||||||
|
outputPinRegisterExt2("hip int/hold", HIP9011_INT_HOLD,
|
||||||
|
boardConfiguration->hip9011IntHoldPin, &DEFAULT_OUTPUT);
|
||||||
|
outputPinRegisterExt2("hip CS", SPI_CS_HIP9011,
|
||||||
|
boardConfiguration->hip9011CsPin, &DEFAULT_OUTPUT);
|
||||||
|
|
||||||
scheduleMsg(&logger, "Starting HIP9011/TPIC8101 driver");
|
scheduleMsg(&logger, "Starting HIP9011/TPIC8101 driver");
|
||||||
spiStart(driver, &spicfg);
|
spiStart(driver, &spicfg);
|
||||||
|
/**
|
||||||
|
* Here we initialize the chip in synchronous mode
|
||||||
|
*/
|
||||||
|
|
||||||
outputPinRegisterExt2("hip int/hold", HIP9011_INT_HOLD, boardConfiguration->hip9011IntHoldPin, &DEFAULT_OUTPUT);
|
|
||||||
outputPinRegisterExt2("hip CS", SPI_CS_HIP9011, boardConfiguration->hip9011CsPin, &DEFAULT_OUTPUT);
|
|
||||||
|
|
||||||
chThdCreateStatic(htThreadStack, sizeof(htThreadStack), NORMALPRIO, (tfunc_t) ivThread, NULL);
|
|
||||||
|
|
||||||
bandIndex = findIndex(bandFreqLookup, BAND_LOOKUP_SIZE, BAND(engineConfiguration->cylinderBore));
|
#if HIP_DEBUG
|
||||||
|
chThdCreateStatic(htThreadStack, sizeof(htThreadStack), NORMALPRIO,
|
||||||
|
(tfunc_t) ivThread, NULL);
|
||||||
|
#else
|
||||||
|
/**
|
||||||
|
* for runtime we are re-starting SPI in non-synchronous mode
|
||||||
|
*/
|
||||||
|
spiStop(driver);
|
||||||
|
// todo spicfg.end_cb = spiEndCallback;
|
||||||
|
spiStart(driver, &spicfg);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
bandIndex = findIndex(bandFreqLookup, BAND_LOOKUP_SIZE,
|
||||||
|
BAND(engineConfiguration->cylinderBore));
|
||||||
|
|
||||||
addTriggerEventListener(&intHoldCallback, "DD int/hold", engine);
|
addTriggerEventListener(&intHoldCallback, "DD int/hold", engine);
|
||||||
|
|
||||||
|
|
|
@ -236,7 +236,7 @@ void initHardware(Logging *logger, Engine *engine) {
|
||||||
readFromFlash();
|
readFromFlash();
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
engineConfiguration->engineType = DEFAULT_ENGINE;
|
engineConfiguration->engineType = DEFAULT_ENGINE_TYPE;
|
||||||
resetConfigurationExt(logger, engineConfiguration->engineType, engine);
|
resetConfigurationExt(logger, engineConfiguration->engineType, engine);
|
||||||
#endif /* EFI_INTERNAL_FLASH */
|
#endif /* EFI_INTERNAL_FLASH */
|
||||||
|
|
||||||
|
|
|
@ -265,5 +265,5 @@ int getRusEfiVersion(void) {
|
||||||
return 1; // this is here to make the compiler happy about the unused array
|
return 1; // this is here to make the compiler happy about the unused array
|
||||||
if (UNUSED_CCM_SIZE == 0)
|
if (UNUSED_CCM_SIZE == 0)
|
||||||
return 1; // this is here to make the compiler happy about the unused array
|
return 1; // this is here to make the compiler happy about the unused array
|
||||||
return 20141225;
|
return 20141226;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue