wire up restoreConditionsMet #75

FOME-Tech · Jun 29, 2023 · e03b240 · e03b240
1 parent 59430df
commit e03b240
Showing 1 changed file with 11 additions and 1 deletion.
diff --git a/firmware/controllers/math/lambda_monitor.cpp b/firmware/controllers/math/lambda_monitor.cpp
@@ -87,7 +87,17 @@ bool LambdaMonitorBase::isCurrentlyGood(float rpm, float load) const {
 }
 
 bool LambdaMonitorBase::restoreConditionsMet(float rpm, float load) const {
-	// TODO #75
+	if (rpm > engineConfiguration->lambdaProtectionRestoreRpm) {
+		return false;
+	}
+
+	if (load > engineConfiguration->lambdaProtectionRestoreLoad) {
+		return false;
+	}
+
+	if (Sensor::getOrZero(SensorType::Tps1) > engineConfiguration->lambdaProtectionRestoreTps) {
+		return false;
+	}
 
 	return true;
 }