summaryrefslogtreecommitdiffstats
path: root/src/can-decoder.cpp
blob: 034713985675baacbdca53a9e64c969f1de54de9 (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
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
/*
 * Copyright (C) 2015, 2016 "IoT.bzh"
 * Author "Romain Forlot" <romain.forlot@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-decoder.hpp"
#include "canutil/read.h"

float decoder_t::parseSignalBitfield(CanSignal& signal, const can_message_t& message)
{
	 return bitfield_parse_float(message.get_data(), CAN_MESSAGE_SIZE,
			signal.bitPosition, signal.bitSize, signal.factor,
			signal.offset);
}

openxc_DynamicField decoder_t::noopDecoder(CanSignal& signal,
		const std::vector<CanSignal>& signals, float value, bool* send)
{
	openxc_DynamicField decoded_value;
	decoded_value.has_type = true;
	decoded_value.type = openxc_DynamicField_Type_NUM;
	decoded_value.has_numeric_value = true;
	decoded_value.numeric_value = value;

	return decoded_value;
}

openxc_DynamicField decoder_t::booleanDecoder(CanSignal& signal,
		const std::vector<CanSignal>& signals, float value, bool* send)
{
	openxc_DynamicField decoded_value;
	decoded_value.has_type = true;
	decoded_value.type = openxc_DynamicField_Type_BOOL;
	decoded_value.has_boolean_value = true;
	decoded_value.boolean_value = value == 0.0 ? false : true;

	return decoded_value;
}

openxc_DynamicField decoder_t::ignoreDecoder(CanSignal& signal,
		const std::vector<CanSignal>& signals, float value, bool* send)
{
	if(send)
	  *send = false;
	
	openxc_DynamicField decoded_value = {0, openxc_DynamicField_Type_BOOL, 0, "", 0, 0, 0, 0};
	
	return decoded_value;
}

openxc_DynamicField decoder_t::stateDecoder(CanSignal& signal,
		const std::vector<CanSignal>& signals, float value, bool* send)
{
	openxc_DynamicField decoded_value = {0, openxc_DynamicField_Type_BOOL, 0, "", 0, 0, 0, 0};
	decoded_value.has_type = true;
	decoded_value.type = openxc_DynamicField_Type_STRING;
	decoded_value.has_string_value = true;

	/* TODO: Handle SignalState 
	const CanSignalState* signalState = lookupSignalState(value, signal);
	if(signalState != NULL) {
		::strcpy(decoded_value.string_value, signalState->name);
	} else {
		*send = false;
	}*/
	return decoded_value;
}

openxc_DynamicField decoder_t::translateSignal(CanSignal& signal, can_message_t& message,
	const std::vector<CanSignal>& signals)
{
	if(&signal == nullptr || &message == nullptr)
	{
		openxc_DynamicField ret = {0, openxc_DynamicField_Type_BOOL, 0, "", 0, 0, 0, 0};
		return ret;
	}

	float value = parseSignalBitfield(signal, message);
	DEBUG(binder_interface, "translateSignal: Decoded message: %f", value);

	bool send = true;
	// Must call the decoders every time, regardless of if we are going to
	// decide to send the signal or not.
	openxc_DynamicField decoded_value = decodeSignal(signal,
			value, signals, &send);

	signal.received = true;
	signal.lastValue = value;
	return decoded_value;
}

openxc_DynamicField decoder_t::decodeSignal( CanSignal& signal,
		float value, const std::vector<CanSignal>& signals, bool* send)
{
	SignalDecoder decoder = signal.decoder == NULL ?
							noopDecoder : signal.decoder;
	openxc_DynamicField decoded_value = decoder(signal, signals,
			value, send);
	return decoded_value;
}

openxc_DynamicField decoder_t::decodeSignal( CanSignal& signal,
		const can_message_t& message, const std::vector<CanSignal>& signals, bool* send)
{
	float value = parseSignalBitfield(signal, message);
	return decodeSignal(signal, value, signals, send);
}