Fix: Wrong set up of vector.
[apps/agl-service-can-low-level.git] / 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> signals = {};
84
85         switch(key.type)
86         {
87                 case openxc_DynamicField_Type::openxc_DynamicField_Type_STRING:
88                         for(const CanSignal& s : getSignals())
89                         {
90                                 if(fnmatch(key.string_value, s.genericName, FNM_CASEFOLD) == 0)
91                                         signals.push_back(s);
92                         }
93                         break;
94                 case openxc_DynamicField_Type::openxc_DynamicField_Type_NUM:
95                         for(const CanSignal& s : getSignals())
96                         {
97                                 CanMessageDefinition *msg_def = s.message;
98                                 if(msg_def->id == key.numeric_value)
99                                         signals.push_back(s);
100                         }
101                         break;
102                 default:
103                         ERROR(binder_interface, "find_can_signals: wrong openxc_DynamicField specified. Use openxc_DynamicField_Type_NUM or openxc_DynamicField_Type_STRING type only.");
104                         return signals;
105                         break;
106         }
107         return signals;
108 }
109
110 inline uint32_t get_CanSignal_id(const CanSignal& sig)
111 {
112         return sig.message->id;
113 }