sensor.cpp

Go to the documentation of this file.

#include "pch.h"
#include "auto_generated_sensor.h"
 
// This struct represents one sensor in the registry.
// It stores whether the sensor should use a mock value,
// the value to use, and if not a pointer to the sensor that
// can provide a real value.
class SensorRegistryEntry {
public:
    const Sensor* getSensor() {
        return m_sensor;
    }
 
    void setInvalidMockValue() {
        m_useMock = true;
        m_valid = false;
    }
 
    void setMockValue(float value, bool mockRedundant) {
        m_mockValue = value;
        m_useMock = true;
        m_valid = true;
        m_mockRedundant = mockRedundant;
    }
 
    void resetMock() {
        m_useMock = false;
        m_mockValue = 0.0f;
    }
 
    void reset() {
        m_sensor = nullptr;
        resetMock();
    }
 
    bool Register(Sensor* sensor) {
        // If there's somebody already here - a consumer tried to double-register a sensor
        if (m_sensor && m_sensor != sensor) {
            // This sensor has already been registered. Don't re-register it.
            firmwareError(ObdCode::CUSTOM_OBD_26, "Duplicate registration for sensor \"%s\"", sensor->getSensorName());
            return false;
        } else {
            // Put the sensor in the registry
            m_sensor = sensor;
            return true;
        }
    }
 
    void unregister() {
        m_sensor = nullptr;
    }
 
    SensorResult get() const {
        // Check if mock
        if (m_useMock) {
            if (!m_valid) {
                return unexpected;
            }
            return m_mockValue;
        }
 
        // Get the sensor out of the entry
        const Sensor *s = m_sensor;
        if (s) {
            // If this sensor says it doesn't exist, return unexpected
            if (!s->hasSensor()) {
                return UnexpectedCode::Configuration;
            }
 
            // If we found the sensor, ask it for a result.
            return s->get();
        }
 
        // We've exhausted all valid ways to return something - sensor not found.
        return UnexpectedCode::Configuration;
    }
 
    void showInfo(const char* sensorName) const {
        if (m_useMock) {
            efiPrintf("Sensor \"%s\" mocked with value %.2f", sensorName, m_mockValue);
        } else {
            const auto sensor = m_sensor;
 
            if (sensor) {
                sensor->showInfo(sensorName);
            } else {
                efiPrintf("Sensor \"%s\" is not configured.", sensorName);
            }
        }
    }
 
    bool hasSensor() const {
        return m_useMock || (m_sensor && m_sensor->hasSensor());
    }
 
    float getRaw() const {
        const auto sensor = m_sensor;
 
        if (sensor) {
            return sensor->getRaw();
        }
 
        // We've exhausted all valid ways to return something - sensor not found.
        return 0;
    }
 
    bool isRedundant() const {
        const auto sensor = m_sensor;
 
        if (sensor) {
            return sensor->isRedundant();
        }
 
        if (m_useMock) {
            return m_mockRedundant;
        }
 
        return false;
    }
 
private:
    bool m_useMock = false;
    bool m_valid = false;
    bool m_mockRedundant = false;
    float m_mockValue;
    Sensor* m_sensor = nullptr;
};
 
static SensorRegistryEntry s_sensorRegistry[static_cast<size_t>(SensorType::PlaceholderLast)] = {};
 
bool Sensor::Register() {
    return s_sensorRegistry[getIndex()].Register(this);
}
 
void Sensor::unregister() {
    s_sensorRegistry[getIndex()].unregister();
}
 
/*static*/ void Sensor::resetRegistry() {
    // Clear all entries
    for (size_t i = 0; i < efi::size(s_sensorRegistry); i++) {
        auto &entry = s_sensorRegistry[i];
 
        entry.reset();
    }
}
 
/*static*/ SensorRegistryEntry *Sensor::getEntryForType(SensorType type) {
    size_t index = getIndex(type);
    // Check that we didn't get garbage
    if (index >= efi::size(s_sensorRegistry)) {
        return nullptr;
    }
 
    return &s_sensorRegistry[index];
}
 
/*static*/ const Sensor *Sensor::getSensorOfType(SensorType type) {
    auto entry = getEntryForType(type);
    return entry ? entry->getSensor() : nullptr;
}
 
/**
 * @returns NotNull: sensor result or UnexpectedCode::Configuration if sensor is not registered
 */
/*static*/ SensorResult Sensor::get(SensorType type) {
    const auto entry = getEntryForType(type);
 
    // Check if this is a valid sensor entry
    if (!entry) {
        return UnexpectedCode::Configuration;
    }
 
    return entry->get();
}
 
/*static*/ float Sensor::getRaw(SensorType type) {
    const auto entry = getEntryForType(type);
 
    return entry ? entry->getRaw() : 0;
}
 
/*static*/ bool Sensor::isRedundant(SensorType type) {
    const auto entry = getEntryForType(type);
 
    return entry ? entry->isRedundant() : false;
}
 
/*static*/ bool Sensor::hasSensor(SensorType type) {
    const auto entry = getEntryForType(type);
 
    return entry ? entry->hasSensor() : false;
}
 
void Sensor::setInvalidMockValue(SensorType type) {
    auto entry = getEntryForType(type);
 
    if (entry) {
        entry->setInvalidMockValue();
    }
}
 
/*static*/ void Sensor::setMockValue(SensorType type, float value, bool mockRedundant) {
    auto entry = getEntryForType(type);
 
    if (entry) {
        entry->setMockValue(value, mockRedundant);
    }
}
 
/*static*/ void Sensor::resetMockValue(SensorType type) {
    auto entry = getEntryForType(type);
 
    if (entry) {
        entry->resetMock();
    }
}
 
/*static*/ void Sensor::resetAllMocks() {
    // Reset all mocks
    for (size_t i = 0; i < efi::size(s_sensorRegistry); i++) {
        s_sensorRegistry[i].resetMock();
    }
}
 
/*static*/ const char* Sensor::getSensorName(SensorType type) {
    return getSensorType(type);
}
 
/*static*/ bool Sensor::s_inhibitSensorTimeouts = false;
 
/*static*/ void Sensor::inhibitTimeouts(bool inhibit) {
    Sensor::s_inhibitSensorTimeouts = inhibit;
}
 
// Print information about all sensors
/*static*/ void Sensor::showAllSensorInfo() {
    for (size_t i = 1; i < efi::size(s_sensorRegistry); i++) {
        auto& entry = s_sensorRegistry[i];
        const char* name = getSensorType((SensorType)i);
 
        entry.showInfo(name);
    }
}
 
// Print information about a particular sensor
/*static*/ void Sensor::showInfo(SensorType type) {
    auto entry = getEntryForType(type);
 
    if (entry) {
        entry->showInfo(getSensorName(type));
    }
}
 
/**
 * this is definitely not the fastest implementation possible but good enough for now?
 * todo: some sort of hashmap in the future?
 */
SensorType findSensorTypeByName(const char *name) {
    using namespace rusefi::stringutil;
 
    for (size_t i = 0;i < efi::size(s_sensorRegistry); i++) {
        SensorType type = (SensorType)i;
        const char *sensorName = getSensorType(type);
        if (strEqualCaseInsensitive(sensorName, name)) {
            return type;
        }
    }
 
    return SensorType::Invalid;
}