aboutsummaryrefslogtreecommitdiffstats
path: root/low-can-binding/binding/application.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'low-can-binding/binding/application.cpp')
-rw-r--r--low-can-binding/binding/application.cpp56
1 files changed, 56 insertions, 0 deletions
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