Format
[apps/agl-service-can-low-level.git] / src / configuration.cpp
1 /*
2  * Copyright (C) 2015, 2016 "IoT.bzh"
3  * Author "Romain Forlot" <romain.forlot@iot.bzh>
4  *
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
8  *
9  *       http://www.apache.org/licenses/LICENSE-2.0
10  *
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.
16  */
17
18 #include <configuration.hpp>
19
20 #define OBD2_FUNCTIONAL_BROADCAST_ID 0x7df
21
22 // Pre-defined OBD-II PIDs to query for if supported by the vehicle.
23  std::vector<obd2_signal_t> OBD2_PIDS = {
24         { 0x04, "obd2.engine.load", 0, 100, POURCENT, 5, false},
25         { 0x05, "obd2.engine.coolant.temperature", -40, 215, DEGREES_CELSIUS, 1, false},
26         { 0x0a, "obd2.fuel.pressure", 0, 765, KPA, 1, false},
27         { 0x0b, "obd2.intake.manifold.pressure", 0, 255, KPA, 1, false},
28         { 0x0c, "obd2.engine.speed", 0, 16383, RPM, 5, false},
29         { 0x0d, "obd2.vehicle.speed", 0, 255, KM_H, 5, false},
30         { 0x0f, "obd2.intake.air.temperature", -40, 215, DEGREES_CELSIUS, 1, false},
31         { 0x10, "obd2.mass.airflow", 0, 655, GRAMS_SEC, 5, false},
32         { 0x11, "obd2.throttle.position", 0, 100, POURCENT, 5, false},
33         { 0x1f, "obd2.running.time", 0, 65535, SECONDS, 1, false},
34         { 0x2d, "obd2.EGR.error", -100, 99, POURCENT, 0, false},
35         { 0x2f, "obd2.fuel.level", 0, 100, POURCENT, 1, false},
36         { 0x33, "obd2.barometric.pressure", 0, 255, KPA, 1, false},
37         { 0x4c, "obd2.commanded.throttle.position", 0, 100, POURCENT, 1, false},
38         { 0x52, "obd2.ethanol.fuel.percentage", 0, 100, POURCENT, 1, false},
39         { 0x5a, "obd2.accelerator.pedal.position", 0, 100, POURCENT, 5, false},
40         { 0x5b, "obd2.hybrid.battery-pack.remaining.life", 0, 100, POURCENT, 5, false},
41         { 0x5c, "obd2.engine.oil.temperature",-40, 210, DEGREES_CELSIUS, 1, false},
42         { 0x63, "obd2.engine.torque", 0, 65535, NM, 1, false}
43 };
44
45 // Dumb signals and message implementation. To get compile.
46 std::vector<can_message_set_t> CAN_MESSAGE_SET;
47
48 std::vector<std::vector<can_message_definition_t>> CAN_MESSAGES_DEFINTION;
49
50 std::vector<std::vector<can_signal_t>> SIGNALS;
51
52 configuration_t::configuration_t()
53         : obd2_signals_{OBD2_PIDS}, can_message_set_{CAN_MESSAGE_SET}, can_signals_{SIGNALS}, can_message_definition_{CAN_MESSAGES_DEFINTION}
54
55 configuration_t& configuration_t::get_configuration()
56
57         return *this;
58 }
59
60 can_bus_t& configuration_t::get_can_bus_manager()
61 {
62         return can_bus_manager_;
63 }
64
65 diagnostic_manager_t& configuration_t::get_diagnostic_manager() const
66 {
67         return diagnostic_manager_;
68 }
69
70 uint8_t configuration_t::get_active_message_set() const
71 {
72         return active_message_set_;
73 }
74
75 const std::vector<can_message_set_t>& configuration_t::get_can_message_set() const
76 {
77         return can_message_set_;
78 }
79
80 std::vector<can_signal_t>& configuration_t::get_can_signals() const
81 {
82         return can_signals_[active_message_set_];
83 }
84
85 const std::vector<can_message_definition_t>& configuration_t::get_can_message_definition() const
86 {
87         return can_message_definition_[active_message_set_];
88 }
89
90 std::vector<obd2_signal_t>& configuration_t::get_obd2_signals() const
91 {
92         return obd2_signals_;
93 }
94
95 uint32_t configuration_t::get_signal_id(obd2_signal_t& sig) const
96 {
97         return sig.get_pid();
98 }
99
100 uint32_t configuration_t::get_signal_id(can_signal_t& sig) const
101 {
102         return sig.get_message()->get_id();
103 }
104
105 void configuration_t::set_active_message_set(uint8_t id)
106 {
107         active_message_set_ = id;
108 }
109
110 /**
111  * @fn std::vector<std::string> find_signals(const openxc_DynamicField &key)
112  * @brief return signals name found searching through CAN_signals and OBD2 pid
113  * 
114  * @param[in] key - can contain numeric or string value in order to search against 
115  *   can signals or obd2 signals name.
116  *
117  * @return Vector of signals name found. 
118  */
119 void configuration_t::find_obd2_signals(const openxc_DynamicField &key, std::vector<obd2_signal_t*>& found_signals)
120 {
121         switch(key.type)
122         {
123                 case openxc_DynamicField_Type::openxc_DynamicField_Type_STRING:
124                                 lookup_signals_by_name(key.string_value, obd2_signals_, found_signals);
125                         break;
126                 case openxc_DynamicField_Type::openxc_DynamicField_Type_NUM:
127                                 lookup_signals_by_id(key.numeric_value, obd2_signals_, found_signals);
128                         break;
129                 default:
130                         ERROR(binder_interface, "find_signals: wrong openxc_DynamicField specified. Use openxc_DynamicField_Type_NUM or openxc_DynamicField_Type_STRING type only.");
131                         break;
132         }
133         DEBUG(binder_interface, "Found %d signal(s)", (int)found_signals.size());
134 }
135
136 /**
137  * @fn void find_can_signals(const openxc_DynamicField& key, std::vector<can_signal_t*>& found_signals)
138  * @brief return signals name found searching through CAN_signals and OBD2 pid
139  * 
140  * @param[in] key - can contain numeric or string value in order to search against 
141  *   can signals or obd2 signals name.
142  * @param[out] found_signals - provided vector to fill with ponter to signals matched.
143  *
144  */
145 void configuration_t::find_can_signals(const openxc_DynamicField& key, std::vector<can_signal_t*>& found_signals)
146 {
147         switch(key.type)
148         {
149                 case openxc_DynamicField_Type::openxc_DynamicField_Type_STRING:
150                         lookup_signals_by_name(std::string(key.string_value), can_signals_, found_signals);
151                         break;
152                 case openxc_DynamicField_Type::openxc_DynamicField_Type_NUM:
153                         lookup_signals_by_id(key.numeric_value, can_signals_ found_signals);
154                         break;
155                 default:
156                         ERROR(binder_interface, "find_signals: wrong openxc_DynamicField specified. Use openxc_DynamicField_Type_NUM or openxc_DynamicField_Type_STRING type only.");
157                         break;
158         }
159         DEBUG(binder_interface, "Found %d signal(s)", (int)found_signals.size());
160 }