summaryrefslogtreecommitdiffstats
path: root/src/can-decoder.cpp
blob: b222bc62f97e97de3a93667b5ed878293e2bb395 (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
/*
 * 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.
 */

#pragma once

#include "can-decoder.hpp"

float decoder_t::parseSignalBitfield(const CanSignal& signal, const CanMessage& message)
{
	 return bitfield_parse_float(message->data, CAN_MESSAGE_SIZE,
			signal->bitPosition, signal->bitSize, signal->factor,
			signal->offset);
}

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

openxc_DynamicField decoder_t::booleanDecoder(const CanSignal& signal,
		const CanSignal& signals, float value, bool* send)
{
	decoded_value = { .has_type = true,
					.type = openxc_DynamicField_Type_BOOL,
					.has_boolean_value = true,
					.numeric_value = value == 0.0 ? false : true };
	return decoded_value;
}

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

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

	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)
	{
		return {NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL};
	}

	float value = parseSignalBitfield(signal, message);

	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(const 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(const 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);
}