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