aboutsummaryrefslogtreecommitdiffstats
path: root/low-can-binding/can/message/j1939-message.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'low-can-binding/can/message/j1939-message.cpp')
-rw-r--r--low-can-binding/can/message/j1939-message.cpp163
1 files changed, 163 insertions, 0 deletions
diff --git a/low-can-binding/can/message/j1939-message.cpp b/low-can-binding/can/message/j1939-message.cpp
new file mode 100644
index 00000000..8269cbfa
--- /dev/null
+++ b/low-can-binding/can/message/j1939-message.cpp
@@ -0,0 +1,163 @@
+/*
+ * Copyright (C) 2018, 2019 "IoT.bzh"
+ * Author "Arthur Guyader" <arthur.guyader@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 "./j1939-message.hpp"
+#include <cstring>
+#include "../../binding/low-can-hat.hpp"
+
+
+///
+/// @brief Class constructor
+///
+/// j1939_message_t class constructor.
+///
+j1939_message_t::j1939_message_t():
+ message_t(),
+ name_{0},
+ pgn_{0},
+ addr_{0}
+{}
+
+j1939_message_t::j1939_message_t(uint8_t length,
+ can_message_format_t format,
+ std::vector<uint8_t>& data,
+ uint64_t timestamp,
+ name_t name,
+ pgn_t pgn,
+ uint8_t addr):
+ message_t(length, format, data, timestamp),
+ name_{name},
+ pgn_{pgn},
+ addr_{addr}
+{}
+
+///
+/// @brief Retrieve name_ member value.
+///
+/// @return name_ class member
+///
+uint64_t j1939_message_t::get_name() const {
+ return name_;
+}
+
+///
+/// @brief Retrieve pgn_ member value.
+///
+/// @return pgn_ class member
+///
+uint32_t j1939_message_t::get_pgn() const{
+ return pgn_;
+}
+
+///
+/// @brief Retrieve addr_ member value.
+///
+/// @return addr_ class member
+///
+uint8_t j1939_message_t::get_addr() const{
+ return addr_;
+}
+
+
+/// @brief Take a sockaddr_can struct and array of data to initialize class members
+///
+/// This is the preferred way to initialize class members.
+///
+/// @param[in] addr - sockaddr_can to get pgn, name and addr
+/// @param[in] data - array of data get from the j1939 socket
+/// @param[in] nbytes - size of the array of data
+/// @param[in] timestamp - timestamp of the message
+///
+/// @return A j1939_message_t object fully initialized with sockaddr_can and data values.
+std::shared_ptr<j1939_message_t> j1939_message_t::convert_from_addr(struct sockaddr_can& addr, uint8_t (&data)[128],size_t nbytes, uint64_t timestamp)
+{
+ uint8_t length = 0;
+ can_message_format_t format;
+ std::vector<uint8_t> dataVector;
+
+ if(nbytes > J1939_MAX_DLEN)
+ {
+ AFB_DEBUG("Unsupported j1939 frame");
+ format = can_message_format_t::INVALID;
+ }
+ else
+ {
+ AFB_DEBUG("Got a j1939 frame");
+ format = can_message_format_t::J1939;
+ }
+
+ length = (uint8_t) nbytes;
+ dataVector.reserve(length);
+ int i;
+ dataVector.clear();
+ for(i=0;i<length;i++)
+ {
+ dataVector.push_back(data[i]);
+ };
+
+ AFB_DEBUG("Found pgn: %X, format: %X, length: %X, data %02X%02X%02X%02X%02X%02X%02X%02X",
+ addr.can_addr.j1939.pgn, (uint8_t)format, length, data[0], data[1], data[2], data[3], data[4], data[5], data[6], data[7]);
+
+ return std::make_shared<j1939_message_t>(j1939_message_t(length, format, dataVector, timestamp,addr.can_addr.j1939.name,addr.can_addr.j1939.pgn,addr.can_addr.j1939.addr));
+}
+
+/// @brief Test if members pgn_ and length are set.
+///
+/// @return boolean - true = set - false = not set
+bool j1939_message_t::is_set()
+{
+ return (pgn_ != 0 && length_ != 0);
+}
+
+/// @brief Generate a string with informations about the message
+///
+/// @return Debug message with informations about members
+std::string j1939_message_t::get_debug_message()
+{
+ std::string ret = "";
+ ret = ret + "Here is the next j1939 message : pgn " + std::to_string(pgn_) + " length " + std::to_string(length_) + ", data ";
+ for (size_t i = 0; i < data_.size(); i++)
+ {
+ ret = ret + std::to_string(data_[i]);
+ }
+ return ret;
+}
+
+///
+/// @brief Retrieve pgn_ member value.
+///
+/// @return pgn_ class member
+///
+uint32_t j1939_message_t::get_id() const
+{
+ AFB_WARNING("Prefer method get_pgn() for j1939 messages");
+ return get_pgn();
+}
+
+
+struct bcm_msg j1939_message_t::get_bcm_msg()
+{
+ AFB_WARNING("Not implemented");
+ struct bcm_msg bcm_msg;
+ ::memset(&bcm_msg, 0, sizeof(struct bcm_msg));
+ return bcm_msg;
+}
+
+void j1939_message_t::set_bcm_msg(struct bcm_msg bcm_msg)
+{
+ AFB_WARNING("Not implemented");
+}