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