142 lines
3.6 KiB
C++
142 lines
3.6 KiB
C++
/**
|
|
* @file tests/can_reassemble.cpp
|
|
* @brief brief
|
|
* @date Aug 25, 2015
|
|
* @author rheijden
|
|
* @copyright 2015 Dual Inventive Technology Centre B.V.
|
|
*
|
|
* descr
|
|
*/
|
|
#include "fixtures/CANTest.hpp"
|
|
|
|
#include <di/can.h>
|
|
#include <di/can/frame.h>
|
|
|
|
static void test_dup_buf(struct di_can_msg *msg)
|
|
{
|
|
size_t lines = msg->size / 16;
|
|
|
|
for (size_t i = 0; i < lines; i++) {
|
|
printf("%04zx : ", i * 16);
|
|
for (size_t n = 0; n < 16; n++)
|
|
printf("%02x ", *(((uint8_t *)msg->buf->data) + n + (i * 16)));
|
|
for (size_t n = 0; n < 16; n++) {
|
|
if (isgraph(*(((uint8_t *)msg->buf->data) + n + (i * 16))))
|
|
putc(*(((uint8_t *)msg->buf->data) + n + (i * 16)), stdout);
|
|
else
|
|
putc('.', stdout);
|
|
}
|
|
printf("\n");
|
|
}
|
|
}
|
|
|
|
void test_msg_dump(struct di_can_msg *msg)
|
|
{
|
|
printf(" size: %zu\n", msg->size);
|
|
test_dup_buf(msg);
|
|
}
|
|
|
|
/**
|
|
* Null frames (canid == 0, size == 0) should not crash the stack
|
|
*/
|
|
static di_errno_t recv_cb_reassemble_null_frames(struct di_can_frame_rx *frame)
|
|
{
|
|
frame->canid = 0;
|
|
frame->size = 0;
|
|
return DNOK;
|
|
}
|
|
|
|
TEST_F(DI_CAN, reassemble_null_frames) {
|
|
di_can_callback_set_recv(&_ctx, recv_cb_reassemble_null_frames);
|
|
|
|
for (size_t n = 0; n < 8; n++)
|
|
di_can_lowlevel_recv(&_ctx);
|
|
|
|
di_can_reassemble(&_ctx);
|
|
}
|
|
|
|
/**
|
|
* Check if SFT message is correctly reassembled
|
|
*/
|
|
static di_errno_t recv_cb_sft_frame(struct di_can_frame_rx *frame)
|
|
{
|
|
uint8_t data[8] = {0xde, 0xad, 0xbe, 0xef, 0xca, 0xfe, 0xba, 0xbe};
|
|
|
|
frame->canid = 0x01230001;
|
|
frame->size = sizeof(data);
|
|
memcpy(frame->buf, &data, sizeof(data));
|
|
|
|
return DNOK;
|
|
}
|
|
|
|
TEST_F(DI_CAN, reassemble_sft) {
|
|
struct di_can_msg *msg;
|
|
|
|
di_can_callback_set_recv(&_ctx, recv_cb_sft_frame);
|
|
di_can_lowlevel_recv(&_ctx);
|
|
di_can_reassemble(&_ctx);
|
|
|
|
msg = di_can_recv(&_ctx, DI_CAN_MSGTYPE_RAW);
|
|
ASSERT_NE((void *)NULL, msg);
|
|
|
|
test_msg_dump(msg);
|
|
|
|
ASSERT_EQ(0x01230000, msg->canid);
|
|
ASSERT_EQ(0U, msg->size);
|
|
ASSERT_EQ((void *)NULL, msg->msg);
|
|
ASSERT_EQ(0xdeadbeef, msg->src_id);
|
|
ASSERT_EQ(0xcafebabe, msg->dst_id);
|
|
|
|
di_can_msg_free(&msg);
|
|
}
|
|
|
|
/**
|
|
* Check if MFT message is correctly reassembled
|
|
*/
|
|
static di_errno_t recv_cb_mft_frame(struct di_can_frame_rx *frame)
|
|
{
|
|
/* Msgtype : DI_CAN_MSGTYPE_RPC
|
|
* Transfertype : DI_CAN_TRANSFERTYPE_PUBLISH
|
|
* di_rpc_types : DI_RPC_TYPE_LOG_INFO
|
|
* Source Node ID : 0x00000000
|
|
* Destination Node ID : 0xffffffff (DI_CAN_NODEID_BROADCAST)
|
|
* Payload type : 0x0f (DI_CAN_PTYPE_MSGPACK)
|
|
* Payload size : 0x21
|
|
* Payload CRC : 0x508d
|
|
* Payload : "msg" : "Hello from DI-Net CAN 1337!"
|
|
*/
|
|
static unsigned int idx = 0;
|
|
static const struct di_can_frame_rx tvs[] = {
|
|
{ 0, 0, 8, 0x09e3c000, {0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff}, NULL },
|
|
{ 0, 0, 8, 0x09e3c020, {0x0f, 0x00, 0x21, 0x8d, 0x50, 0xff, 0xff, 0xff}, NULL },
|
|
{ 0, 0, 8, 0x09e3c040, {0x81, 0xa3, 0x6d, 0x73, 0x67, 0xbb, 0x48, 0x65}, NULL },
|
|
{ 0, 0, 8, 0x09e3c060, {0x6c, 0x6c, 0x6f, 0x20, 0x66, 0x72, 0x6f, 0x6d}, NULL },
|
|
{ 0, 0, 8, 0x09e3c080, {0x20, 0x44, 0x49, 0x2d, 0x4e, 0x65, 0x74, 0x20}, NULL },
|
|
{ 0, 0, 8, 0x09e3c0a0, {0x43, 0x41, 0x4e, 0x20, 0x31, 0x33, 0x33, 0x37}, NULL },
|
|
{ 0, 0, 1, 0x09e3c0c1, {0x21 }, NULL }
|
|
};
|
|
|
|
memcpy(frame, &tvs[idx], sizeof(tvs[0]));
|
|
idx++;
|
|
if (idx >= DI_ARRAY_SIZE(tvs))
|
|
idx = 0;
|
|
|
|
return DNOK;
|
|
}
|
|
|
|
TEST_F(DI_CAN, reassemble_mft) {
|
|
struct di_can_msg *msg;
|
|
|
|
di_can_callback_set_recv(&_ctx, recv_cb_mft_frame);
|
|
for (size_t n = 0; n < 7; n++)
|
|
di_can_lowlevel_recv(&_ctx);
|
|
di_can_reassemble(&_ctx);
|
|
|
|
msg = di_can_recv(&_ctx, DI_CAN_MSGTYPE_RPC);
|
|
ASSERT_NE((void *)NULL, msg);
|
|
|
|
test_msg_dump(msg);
|
|
|
|
di_can_msg_free(&msg);
|
|
}
|