src/can-signals.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 "can-signals.hpp"
  19
  20 #include <fnmatch.h>
  21
  22 #include "can-decoder.hpp"
  23 #include "low-can-binding.hpp"
  24
  25 std::vector<std::vector<CanMessageDefinition>> CAN_MESSAGES = {
  26         {
  27                 {0x620, CanMessageFormat::STANDARD, {10, 0, nullptr}, false, (uint8_t)NULL},
  28                 {0x442, CanMessageFormat::STANDARD, {10, 0, nullptr}, false, (uint8_t)NULL},
  29         },
  30 };
  31
  32 /**
  33  * @brief Dumb SIGNALS array. It is composed by CanMessageSet
  34  * SIGNALS[MESSAGE_SET_ID][CanSignal]
  35  */
  36 std::vector<std::vector<CanSignal>> SIGNALS = {
  37         {
  38                 {&(CAN_MESSAGES[MESSAGE_SET_ID][0]), "can.driver_door.open", 2, 4, 1.000000, 0.000000, 0.000000, 0.000000, {10, 0, nullptr}, false, true, nullptr, 0, false, decoder_t::booleanDecoder, nullptr, false, (float)NULL},
  39                 {&(CAN_MESSAGES[MESSAGE_SET_ID][1]), "can.driver_door.close", 2, 4, 1.000000, 0.000000, 0.000000, 0.000000, {10, 0, nullptr}, false, true, nullptr, 0, false, decoder_t::booleanDecoder, nullptr, false, (float)NULL}
  40         },
  41 };
  42
  43 /**
  44  * @brief Can signal event map making access to afb_event
  45  * externaly to an openxc existing structure.
  46  *
  47  * @desc Event map is making relation between CanSignal generic name
  48  * and the afb_event struct used by application framework to pushed
  49  * to the subscriber.
  50  */
  51 std::map<std::string, struct afb_event> subscribed_signals;
  52
  53 /**
  54 * @brief Mutex allowing safe manipulation on subscribed_signals map.
  55 * @desc To ensure that the map object isn't modified when we read it, you
  56 *  have to set this mutex before use subscribed_signals map object.
  57 */
  58 std::mutex subscribed_signals_mutex;
  59
  60 std::mutex& get_subscribed_signals_mutex()
  61 {
  62         return subscribed_signals_mutex;
  63 }
  64
  65 std::map<std::string, struct afb_event>& get_subscribed_signals()
  66 {
  67         DEBUG(binder_interface, "Here are the first subscribed_signals: %s", subscribed_signals.begin()->first.c_str() );
  68         return subscribed_signals;
  69 }
  70
  71 const std::vector<CanSignal>& getSignals()
  72 {
  73         return SIGNALS[MESSAGE_SET_ID];
  74 }
  75
  76 size_t getSignalCount()
  77 {
  78         return SIGNALS[MESSAGE_SET_ID].size();
  79 }
  80
  81 std::vector<CanSignal> find_can_signals(const openxc_DynamicField &key)
  82 {
  83         std::vector<CanSignal> found_signals = {};
  84         std::vector<CanSignal> active_signals = getSignals();
  85         /* STL container my love ! Welcome to the printf debugging venerable technique !
  86          * use those DEBUG message if you need to !
  87         DEBUG(binder_interface, "We get %d signal(s) to process", (int)active_signals.size()); */
  88
  89         switch(key.type)
  90         {
  91                 case openxc_DynamicField_Type::openxc_DynamicField_Type_STRING:
  92                         for(const CanSignal& s : active_signals)
  93                         {
  94                                 //DEBUG(binder_interface, "Processing signal: %s", s.genericName);
  95                                 if(::fnmatch(key.string_value, s.genericName, FNM_CASEFOLD) == 0)
  96                                 {
  97                                         //DEBUG(binder_interface, "Matched signal: %s", s.genericName);
  98                                         found_signals.push_back(s);
  99                                 }
 100                         }
 101                         break;
 102                 case openxc_DynamicField_Type::openxc_DynamicField_Type_NUM:
 103                         for(const CanSignal& s : active_signals)
 104                         {
 105                                 CanMessageDefinition *msg_def = s.message;
 106                                 if(msg_def->id == key.numeric_value)
 107                                         found_signals.push_back(s);
 108                         }
 109                         break;
 110                 default:
 111                         ERROR(binder_interface, "find_can_signals: wrong openxc_DynamicField specified. Use openxc_DynamicField_Type_NUM or openxc_DynamicField_Type_STRING type only.");
 112                         return found_signals;
 113                         break;
 114         }
 115         DEBUG(binder_interface, "Found %d signal(s)", (int)found_signals.size());
 116         return found_signals;
 117 }
 118
 119 inline uint32_t get_CanSignal_id(const CanSignal& sig)
 120 {
 121         return sig.message->id;
 122 }