mirror of https://github.com/rusefi/rusefi-1.git
87 lines
2.0 KiB
C++
87 lines
2.0 KiB
C++
/*
|
|
* @file tooth_logger.cpp
|
|
*
|
|
* @date Jul 7, 2019
|
|
* @author Matthew Kennedy
|
|
*/
|
|
|
|
#include "tooth_logger.h"
|
|
|
|
#include "global.h"
|
|
|
|
#if EFI_TOOTH_LOGGER
|
|
|
|
#include <cstddef>
|
|
#include "efitime.h"
|
|
#include "efilib.h"
|
|
#include "tunerstudio_configuration.h"
|
|
|
|
static uint16_t buffer[1000] CCM_OPTIONAL;
|
|
static size_t NextIdx = 0;
|
|
static volatile bool ToothLoggerEnabled = false;
|
|
|
|
static uint32_t lastEdgeTimestamp = 0;
|
|
|
|
void SetNextEntry(uint16_t entry) {
|
|
// TS uses big endian, grumble
|
|
buffer[NextIdx] = SWAP_UINT16(entry);
|
|
NextIdx++;
|
|
|
|
// If we hit the end, loop
|
|
if (NextIdx >= sizeof(buffer) / sizeof(buffer[0])) {
|
|
NextIdx = 0;
|
|
}
|
|
}
|
|
|
|
void LogTriggerTooth(trigger_event_e tooth) {
|
|
// bail if we aren't enabled
|
|
if (!ToothLoggerEnabled) {
|
|
return;
|
|
}
|
|
|
|
// We currently only support the primary trigger falling edge
|
|
// (this is the edge that VR sensors are accurate on)
|
|
// Since VR sensors are the most useful case here, this is okay for now.
|
|
if (tooth != SHAFT_PRIMARY_FALLING) {
|
|
return;
|
|
}
|
|
|
|
uint32_t nowUs = NT2US(getTimeNowNt());
|
|
// 10us per LSB - this gives plenty of accuracy, yet fits 655.35 ms in to a uint16
|
|
uint16_t delta = static_cast<uint16_t>((nowUs - lastEdgeTimestamp) / 10);
|
|
lastEdgeTimestamp = nowUs;
|
|
|
|
SetNextEntry(delta);
|
|
}
|
|
|
|
void EnableToothLogger() {
|
|
// Clear the buffer
|
|
memset(buffer, 0, sizeof(buffer));
|
|
|
|
// Reset the last edge to now - this prevents the first edge logged from being bogus
|
|
lastEdgeTimestamp = NT2US(getTimeNowNt());
|
|
|
|
// Reset write index
|
|
NextIdx = 0;
|
|
|
|
// Enable logging of edges as they come
|
|
ToothLoggerEnabled = true;
|
|
|
|
// Tell TS that we're ready for it to read out the log
|
|
// nb: this is a lie, as we may not have written anything
|
|
// yet. However, we can let it continuously read out the buffer
|
|
// as we update it, which looks pretty nice.
|
|
tsOutputChannels.toothLogReady = true;
|
|
}
|
|
|
|
void DisableToothLogger() {
|
|
ToothLoggerEnabled = false;
|
|
tsOutputChannels.toothLogReady = false;
|
|
}
|
|
|
|
ToothLoggerBuffer GetToothLoggerBuffer() {
|
|
return { reinterpret_cast<uint8_t*>(buffer), sizeof(buffer) };
|
|
}
|
|
|
|
#endif /* EFI_TOOTH_LOGGER */
|