X-Git-Url: https://gerrit.automotivelinux.org/gerrit/gitweb?a=blobdiff_plain;f=low-can-binding%2Fbinding%2Fapplication.cpp;h=153821c7fc60d4b7c8b1f00c855bd30f8e577668;hb=2eb313e5330dbfa1b6eab146b3698d8ffe054347;hp=6f2310c1d848a0925425255fbe17bcdcf070aa09;hpb=6faef2305955b025c3cf1cfaf17a6aa073727c24;p=apps%2Fagl-service-can-low-level.git

diff --git a/low-can-binding/binding/application.cpp b/low-can-binding/binding/application.cpp
index 6f2310c1..153821c7 100644
--- a/low-can-binding/binding/application.cpp
+++ b/low-can-binding/binding/application.cpp
@@ -14,12 +14,17 @@
  * See the License for the specific language governing permissions and
  * limitations under the License.
  */
+#include <ctime>
+
 #include "application.hpp"
 
 #include "../utils/signals.hpp"
 #include "../utils/openxc-utils.hpp"
 #include "low-can-socket.hpp"
 
+#define MICROSECONDS_IN_SECOND	1000000
+#define ENGINE_VALUE_TIMEOUT	5
+
 /// @brief Return singleton instance of configuration object.
 application_t& application_t::instance()
 {
@@ -81,3 +86,54 @@ void application_t::set_active_message_set(uint8_t id)
 {
 	active_message_set_ = id;
 }
+
+bool application_t::isEngineOn()
+{
+	struct utils::signals_found sf;
+	openxc_DynamicField search_key = build_DynamicField("engine.speed");
+	sf = utils::signals_manager_t::instance().find_signals(search_key);
+	bool engine_on = false;
+	uint64_t last_timestamp_in_s;
+
+	if(sf.can_signals.size() == 1)
+	{
+		last_timestamp_in_s = sf.can_signals.front()->get_last_value_with_timestamp().second
+						/ MICROSECONDS_IN_SECOND;
+
+		if(sf.can_signals.front()->get_last_value_with_timestamp().first > 0 &&
+		   std::difftime(std::time(nullptr), last_timestamp_in_s) < ENGINE_VALUE_TIMEOUT)
+		{
+			engine_on = true;
+		}
+		else
+		{
+			AFB_NOTICE("is_engine_on: engine.speed CAN signal found, but engine seems off");
+		}
+	}
+	else
+	{
+		AFB_NOTICE("is_engine_on: Can't identify a useable engine.speed CAN signal");
+	}
+
+	if(sf.diagnostic_messages.size() == 1)
+	{
+		last_timestamp_in_s = sf.diagnostic_messages.front()->get_last_value_with_timestamp().second
+						/ MICROSECONDS_IN_SECOND;
+
+		if(sf.diagnostic_messages.front()->get_last_value_with_timestamp().first > 0 &&
+		   std::difftime(std::time(nullptr), last_timestamp_in_s) < ENGINE_VALUE_TIMEOUT)
+		{
+			engine_on = true;
+		}
+		else
+		{
+			AFB_NOTICE("is_engine_on: engine.speed diagnostic message found, but engine seems off");
+		}
+	}
+	else
+	{
+		AFB_NOTICE("is_engine_on: Can't identify a useable engine.speed diagnostic message");
+	}
+
+	return engine_on;
+}
\ No newline at end of file