2 * Copyright (C) 2015, 2016 "IoT.bzh"
3 * Author "Romain Forlot" <romain.forlot@iot.bzh>
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at
9 * http://www.apache.org/licenses/LICENSE-2.0
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
19 #include "application.hpp"
21 #include "../utils/signals.hpp"
22 #include "../utils/openxc-utils.hpp"
23 #include "low-can-subscription.hpp"
25 #define MICROSECONDS_IN_SECOND 1000000
26 #define ENGINE_VALUE_TIMEOUT 5
28 application_t::application_t()
33 /// @brief Return singleton instance of configuration object.
34 application_t& application_t::instance()
36 static application_t config;
40 can_bus_t& application_t::get_can_bus_manager()
42 return can_bus_manager_;
45 std::map<std::string, std::shared_ptr<low_can_subscription_t> >& application_t::get_can_devices()
50 diagnostic_manager_t& application_t::get_diagnostic_manager()
52 return diagnostic_manager_;
55 uint8_t application_t::get_active_message_set() const
57 return active_message_set_;
60 int application_t::add_message_set(std::shared_ptr<message_set_t> new_message_set)
62 set_parents(new_message_set);
64 for(auto old_msg_set : message_set_)
66 if(old_msg_set->get_index() == new_message_set->get_index())
68 for(auto new_msg_def : new_message_set->get_messages_definition())
70 if(old_msg_set->add_message_definition(new_msg_def) < 0)
74 if(diagnostic_manager_.is_initialized())
76 for(auto new_diag_msg : new_message_set->get_diagnostic_messages())
78 if(old_msg_set->add_diagnostic_message(new_diag_msg) < 0)
86 message_set_.push_back(new_message_set);
90 std::vector<std::shared_ptr<message_set_t> > application_t::get_message_set()
95 vect_ptr_signal_t application_t::get_all_signals()
97 return message_set_[active_message_set_]->get_all_signals();
100 vect_ptr_diag_msg_t application_t::get_diagnostic_messages()
102 return message_set_[active_message_set_]->get_diagnostic_messages();
105 vect_ptr_msg_def_t application_t::get_messages_definition()
107 return message_set_[active_message_set_]->get_messages_definition();
111 std::shared_ptr<message_definition_t> application_t::get_message_definition(uint32_t id)
113 std::shared_ptr<message_definition_t> ret = nullptr;
114 vect_ptr_msg_def_t messages_definition = get_messages_definition();
115 for(std::shared_ptr<message_definition_t> &msg_def : messages_definition)
117 if(msg_def->get_id() == id)
127 uint32_t application_t::get_signal_id(diagnostic_message_t& sig) const
129 return sig.get_pid();
132 uint32_t application_t::get_signal_id(signal_t& sig) const
134 return sig.get_message()->get_id();
137 void application_t::set_active_message_set(uint8_t id)
139 active_message_set_ = id;
142 bool application_t::is_engine_on()
144 struct utils::signals_found sf;
145 openxc_DynamicField search_key = build_DynamicField("engine.speed");
146 sf = utils::signals_manager_t::instance().find_signals(search_key);
147 bool engine_on = false;
148 uint64_t last_timestamp_in_s;
150 if(sf.signals.size() == 1)
152 last_timestamp_in_s = sf.signals.front()->get_last_value_with_timestamp().second
153 / MICROSECONDS_IN_SECOND;
155 if(sf.signals.front()->get_last_value_with_timestamp().first > 0 &&
156 std::difftime(std::time(nullptr), last_timestamp_in_s) < ENGINE_VALUE_TIMEOUT)
162 AFB_NOTICE("is_engine_on: engine.speed CAN signal found, but engine seems off");
167 AFB_NOTICE("is_engine_on: Can't identify a useable engine.speed CAN signal");
170 if(sf.diagnostic_messages.size() == 1)
172 last_timestamp_in_s = sf.diagnostic_messages.front()->get_last_value_with_timestamp().second
173 / MICROSECONDS_IN_SECOND;
175 if(sf.diagnostic_messages.front()->get_last_value_with_timestamp().first > 0 &&
176 std::difftime(std::time(nullptr), last_timestamp_in_s) < ENGINE_VALUE_TIMEOUT)
179 AFB_NOTICE("is_engine_on: engine.speed diagnostic message found, but engine seems off");
183 AFB_NOTICE("is_engine_on: Can't identify a useable engine.speed diagnostic message");
189 void application_t::set_parents(std::shared_ptr<message_set_t> new_message_set)
191 vect_ptr_msg_def_t messages_definition = new_message_set->get_messages_definition();
192 for(std::shared_ptr<message_definition_t> cmd : messages_definition)
194 cmd->set_parent(new_message_set);
195 std::vector<std::shared_ptr<signal_t>> signals = cmd->get_signals();
196 for(std::shared_ptr<signal_t> sig: signals)
197 sig->set_parent(cmd);
200 std::vector<std::shared_ptr<diagnostic_message_t>> diagnostic_messages = new_message_set->get_diagnostic_messages();
201 for(std::shared_ptr<diagnostic_message_t> dm : diagnostic_messages)
202 dm->set_parent(new_message_set);
205 #ifdef USE_FEATURE_J1939
206 std::shared_ptr<utils::socketcan_t> application_t::get_socket_address_claiming()
208 return subscription_address_claiming_->get_socket();
211 std::shared_ptr<low_can_subscription_t> application_t::get_subscription_address_claiming()
213 return subscription_address_claiming_;
217 void application_t::set_subscription_address_claiming(std::shared_ptr<low_can_subscription_t> new_subscription)
219 subscription_address_claiming_ = new_subscription;