2 * Copyright (C) 2015, 2016 "IoT.bzh"
3 * Author "Romain Forlot" <romain.forlot@iot.bzh>
4 * Author "Loic Collignon" <loic.collignon@iot.bzh>
6 * Licensed under the Apache License, Version 2.0 (the "License");
7 * you may not use this file except in compliance with the License.
8 * You may obtain a copy of the License at
10 * http://www.apache.org/licenses/LICENSE-2.0
12 * Unless required by applicable law or agreed to in writing, software
13 * distributed under the License is distributed on an "AS IS" BASIS,
14 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15 * See the License for the specific language governing permissions and
16 * limitations under the License.
19 #include <linux/can.h>
20 #include <linux/can/raw.h>
22 #include <sys/timeb.h>
24 #include <afb/afb-binding.h>
26 #include "can-utils.hpp"
27 #include "can-decoder.hpp"
28 #include "openxc.pb.h"
29 #include "openxc-utils.hpp"
31 void can_decode_message(can_bus_t &can_bus)
33 can_message_t can_message;
34 std:vector <CanSignal> signals;
35 std:vector <CanSignal>::iterator signals_i;
36 openxc_VehicleMessage vehicle_message;
37 openxc_DynamicField search_key, ret;
44 if(can_message = can_bus.next_can_message())
46 /* First we have to found which CanSignal is */
47 search_key = build_DynamicField(openxc_DynamicField_Type::openxc_DynamicField_Type_NUM, (double)can_message.get_id())
49 signals = find_can_signals(search_key);
51 /* Decoding the message ! Don't kill the messenger ! */
52 for(const auto& sig : signals)
54 subscribed_signals_i = subscribed_signals.find(sig.genericName);
56 if(subscribed_signals_i != subscribed_signals.end() &&
57 afb_event_is_valid(subscribed_signals_i->second))
59 ret = decoder.decodeSignal(sig, can_message, getSignals(), &send);
61 s_message = build_SimpleMessage(sig.genericName, ret);
63 vehicle_message = build_VehicleMessage_with_SimpleMessage(openxc_DynamicField_Type::openxc_DynamicField_Type_NUM, s_message);
64 vehicle_message_q.push(vehicle_message);