X-Git-Url: https://gerrit.automotivelinux.org/gerrit/gitweb?a=blobdiff_plain;f=low-can-binding%2Fbinding%2Fapplication.cpp;h=a85b518465a978a7276d16d2d5138c8dac042210;hb=refs%2Fchanges%2F55%2F18755%2F3;hp=6e6353b88b30677e3d54226fa6547c13ae970961;hpb=32e25cbca210a359b09768537b6f443fe90a3070;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 6e6353b8..a85b5184 100644
--- a/low-can-binding/binding/application.cpp
+++ b/low-can-binding/binding/application.cpp
@@ -14,11 +14,16 @@
  * 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-subscription.hpp"
+
+#define MICROSECONDS_IN_SECOND	1000000
+#define ENGINE_VALUE_TIMEOUT	5
 
 /// @brief Return singleton instance of configuration object.
 application_t& application_t::instance()
@@ -32,6 +37,11 @@ can_bus_t& application_t::get_can_bus_manager()
 	return can_bus_manager_;
 }
 
+std::map<std::string, std::shared_ptr<low_can_subscription_t> >& application_t::get_can_devices()
+{
+	return can_devices_;
+}
+
 diagnostic_manager_t& application_t::get_diagnostic_manager()
 {
 	return diagnostic_manager_;
@@ -76,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;
+}