X-Git-Url: https://gerrit.automotivelinux.org/gerrit/gitweb?a=blobdiff_plain;f=low-can-binding%2Fbinding%2Fapplication.cpp;h=4c9641c47217d6d428a6eb381ef806c20d5c6cd0;hb=refs%2Fchanges%2F72%2F23472%2F2;hp=d22633f993224fe64282f4002a7dab22c56b3117;hpb=6d6b880b2769add860cb0f135e0f784f8aaf5e00;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 d22633f9..4c9641c4 100644 --- a/low-can-binding/binding/application.cpp +++ b/low-can-binding/binding/application.cpp @@ -25,6 +25,11 @@ #define MICROSECONDS_IN_SECOND 1000000 #define ENGINE_VALUE_TIMEOUT 5 +application_t::application_t() + : can_bus_manager_{} + , message_set_{} +{} + /// @brief Return singleton instance of configuration object. application_t& application_t::instance() { @@ -52,6 +57,36 @@ uint8_t application_t::get_active_message_set() const return active_message_set_; } +int application_t::add_message_set(std::shared_ptr new_message_set) +{ + set_parents(new_message_set); + + for(auto old_msg_set : message_set_) + { + if(old_msg_set->get_index() == new_message_set->get_index()) + { + for(auto new_msg_def : new_message_set->get_messages_definition()) + { + if(old_msg_set->add_message_definition(new_msg_def) < 0) + return -1; + } + + if(diagnostic_manager_.is_initialized()) + { + for(auto new_diag_msg : new_message_set->get_diagnostic_messages()) + { + if(old_msg_set->add_diagnostic_message(new_diag_msg) < 0) + return -1; + } + } + return 0; + } + } + + message_set_.push_back(new_message_set); + return 0; +} + std::vector > application_t::get_message_set() { return message_set_; @@ -104,7 +139,7 @@ void application_t::set_active_message_set(uint8_t id) active_message_set_ = id; } -bool application_t::isEngineOn() +bool application_t::is_engine_on() { struct utils::signals_found sf; openxc_DynamicField search_key = build_DynamicField("engine.speed"); @@ -119,13 +154,9 @@ bool application_t::isEngineOn() if(sf.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 { @@ -139,13 +170,9 @@ bool application_t::isEngineOn() 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 { @@ -155,6 +182,22 @@ bool application_t::isEngineOn() return engine_on; } +void application_t::set_parents(std::shared_ptr new_message_set) +{ + vect_ptr_msg_def_t messages_definition = new_message_set->get_messages_definition(); + for(std::shared_ptr cmd : messages_definition) + { + cmd->set_parent(new_message_set); + std::vector> signals = cmd->get_signals(); + for(std::shared_ptr sig: signals) + sig->set_parent(cmd); + } + + std::vector> diagnostic_messages = new_message_set->get_diagnostic_messages(); + for(std::shared_ptr dm : diagnostic_messages) + dm->set_parent(new_message_set); +} + #ifdef USE_FEATURE_J1939 std::shared_ptr application_t::get_socket_address_claiming() { @@ -172,4 +215,4 @@ void application_t::set_subscription_address_claiming(std::shared_ptr