* limitations under the License.
*/
-#include "./j1939-message.hpp"
#include <cstring>
+#include <iomanip>
+#include <net/if.h>
#include "../../binding/low-can-hat.hpp"
+#include "../../utils/converter.hpp"
+#include "j1939-message.hpp"
-
-///
-/// @brief Class constructor
-///
-/// j1939_message_t class constructor.
-///
+/**
+ * @brief Construct a new j1939 message t::j1939 message t object
+ *
+ */
j1939_message_t::j1939_message_t():
- message_t(),
- name_{0},
- pgn_{0},
- addr_{0}
+ 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 Construct a new j1939 message t::j1939 message t object
+ *
+ * @param length The length of the message
+ * @param format The format of the message
+ * @param data The vector data of the message
+ * @param timestamp The timetamp of the message
+ * @param name The name of the message
+ * @param pgn The PGN of the message
+ * @param addr The address of the message
+ */
+j1939_message_t::j1939_message_t(uint32_t length,
+ std::vector<uint8_t>& data,
+ uint64_t timestamp,
+ name_t name,
+ pgn_t pgn,
+ uint8_t addr):
+ message_t(J1939_MAX_DLEN, length, J1939_PROTOCOL, data, timestamp),
+ name_{name},
+ pgn_{pgn},
+ addr_{addr}
{}
///
/// @return name_ class member
///
uint64_t j1939_message_t::get_name() const {
- return name_;
+ return name_;
}
///
/// @return pgn_ class member
///
uint32_t j1939_message_t::get_pgn() const{
- return pgn_;
+ return pgn_;
}
///
/// @return addr_ class member
///
uint8_t j1939_message_t::get_addr() const{
- return addr_;
+ return addr_;
}
+/**
+ * @brief Convert hex data to string
+ *
+ * @param data An array of data
+ * @param length The length of the data
+ * @return std::string The string data
+ */
+std::string to_hex( uint8_t data[], const size_t length)
+{
+ std::stringstream stream;
+ stream << std::hex << std::setfill('0');
+ for(int i = 0; i < length; i++)
+ stream << std::hex << ((int) data[i]);
+
+ return stream.str();
+}
/// @brief Take a sockaddr_can struct and array of data to initialize class members
///
/// @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)
+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));
+ int i;
+ uint32_t length = 0;
+ std::vector<uint8_t> data_vector;
+
+ if(nbytes > J1939_MAX_DLEN)
+ {
+ AFB_DEBUG("Unsupported j1939 frame");
+ return std::make_shared<j1939_message_t>(j1939_message_t());
+ }
+
+ length = (uint32_t) nbytes;
+ data_vector.reserve(length);
+
+ data_vector.clear();
+
+ std::string data_string;
+ data_string = converter_t::to_hex(data, length);
+
+ for(i=0;i<length;i++)
+ data_vector.push_back(data[i]);
+
+ AFB_DEBUG("Found pgn: %X, length: %X, data %s",
+ addr.can_addr.j1939.pgn, length, data_string.c_str());
+
+ return std::make_shared<j1939_message_t>(j1939_message_t(length, data_vector, 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.
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;
+ 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;
}
///
///
uint32_t j1939_message_t::get_id() const
{
- AFB_WARNING("Prefer method get_pgn() for j1939 messages");
+ AFB_DEBUG("Prefer method get_pgn() for j1939 messages");
return get_pgn();
}
+void j1939_message_t::set_id(const canid_t id)
+{
+ pgn_ = id;
+}
+
+
+/**
+ * @brief Return the sockname of the message
+ *
+ * @return struct sockaddr_can The sockname of the message
+ */
+struct sockaddr_can j1939_message_t::get_sockname()
+{
+ return sockname_;
+}
-struct bcm_msg j1939_message_t::get_bcm_msg()
+/**
+ * @brief Allows to set a sockname at a message to send it after
+ *
+ * @param sockname The sockname of the message
+ */
+void j1939_message_t::set_sockname(struct sockaddr_can sockname)
{
- AFB_WARNING("Not implemented");
- struct bcm_msg bcm_msg;
- ::memset(&bcm_msg, 0, sizeof(struct bcm_msg));
- return bcm_msg;
+ sockname_ = sockname;
}
-void j1939_message_t::set_bcm_msg(struct bcm_msg bcm_msg)
+/**
+ * @brief Allows to generate a sockname for the message
+ *
+ * @param pgn The pgn for the sockname
+ * @param name The name for the sockname
+ * @param addr The address for the sockname
+ */
+void j1939_message_t::set_sockname(pgn_t pgn, name_t name, uint8_t addr)
{
- AFB_WARNING("Not implemented");
+ memset(&sockname_, 0, sizeof(sockname_));
+ sockname_.can_family = AF_CAN;
+ sockname_.can_ifindex = 0;
+
+ sockname_.can_addr.j1939.addr = addr <= 0 || addr >= UINT8_MAX ?
+ J1939_NO_ADDR : addr;
+ sockname_.can_addr.j1939.name = name <= 0 || name >= UINT64_MAX ?
+ J1939_NO_NAME : name;
+ sockname_.can_addr.j1939.pgn = pgn <= 0 || pgn > J1939_PGN_MAX ?
+ J1939_NO_PGN : pgn;
}