summaryrefslogtreecommitdiffstats
path: root/src/can_decode_message.cpp
blob: 8d81f8b89c1ccf7833274cb0ed1f947fe3831d33 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
/*
 * Copyright (C) 2015, 2016 "IoT.bzh"
 * Author "Romain Forlot" <romain.forlot@iot.bzh>
 * Author "Loic Collignon" <loic.collignon@iot.bzh>
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *	 http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#include "can_decode_message.hpp"

#include "can-utils.hpp"
#include "openxc-utils.hpp"
#include "can-signals.hpp"
#include "can-decoder.hpp"

#include "can_reader.hpp"

void can_decode_message(can_bus_t &can_bus)
{
	can_message_t can_message;
	std::vector <CanSignal> signals;
	std::vector <CanSignal>::iterator signals_i;
	openxc_VehicleMessage vehicle_message;
	openxc_DynamicField search_key, ret;
	bool send = true;

	decoder_t decoder;

	while(can_bus.has_can_message())
	{
		std::unique_lock<std::mutex> can_message_lock(can_message_mutex);
		new_can_message.wait(can_message_lock);
			can_message = can_bus.next_can_message();
		can_message_mutex.unlock();

		std::lock_guard<std::mutex> decoded_can_message_lock(decoded_can_message_mutex);
			/* First we have to found which CanSignal is */
			search_key = build_DynamicField((double)can_message.get_id());
			signals = find_can_signals(search_key);
			
			/* Decoding the message ! Don't kill the messenger ! */
			for(const auto& sig : signals)
			{	
				std::map<std::string, struct afb_event> subscribed_signals = get_subscribed_signals();
				const auto& it_event = subscribed_signals.find(sig.genericName);
				
				if(it_event != subscribed_signals.end() &&
					afb_event_is_valid(it_event->second))
				{
					ret = decoder.decodeSignal(sig, can_message, getSignals(), &send);

					openxc_SimpleMessage s_message = build_SimpleMessage(sig.genericName, ret);

					vehicle_message = build_VehicleMessage_with_SimpleMessage(openxc_DynamicField_Type::openxc_DynamicField_Type_NUM, s_message);
					can_bus.push_new_vehicle_message(vehicle_message);
				}
			}
		decoded_can_message_mutex.unlock();
		new_decoded_can_message.notify_one();
	}
}