mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-04-14 10:07:39 +08:00
81 lines
2.5 KiB
C++
81 lines
2.5 KiB
C++
/*
|
|
* Copyright (C) 2015 Pavel Kirienko <pavel.kirienko@gmail.com>
|
|
*/
|
|
|
|
#include <gtest/gtest.h>
|
|
#include <uavcan/node/node.hpp>
|
|
#include <uavcan/node/sub_node.hpp>
|
|
#include <uavcan/protocol/node_status_monitor.hpp>
|
|
#include "test_node.hpp"
|
|
#include "../protocol/helpers.hpp"
|
|
|
|
static void registerTypes()
|
|
{
|
|
uavcan::GlobalDataTypeRegistry::instance().reset();
|
|
uavcan::DefaultDataTypeRegistrator<uavcan::protocol::NodeStatus> _reg2;
|
|
uavcan::DefaultDataTypeRegistrator<uavcan::protocol::GetNodeInfo> _reg4;
|
|
uavcan::DefaultDataTypeRegistrator<uavcan::protocol::GetDataTypeInfo> _reg5;
|
|
uavcan::DefaultDataTypeRegistrator<uavcan::protocol::debug::LogMessage> _reg6;
|
|
uavcan::DefaultDataTypeRegistrator<uavcan::protocol::GetTransportStats> _reg7;
|
|
uavcan::DefaultDataTypeRegistrator<uavcan::protocol::RestartNode> _reg8;
|
|
}
|
|
|
|
|
|
TEST(SubNode, Basic)
|
|
{
|
|
registerTypes();
|
|
InterlinkedTestNodesWithSysClock nodes;
|
|
|
|
uavcan::protocol::SoftwareVersion swver;
|
|
swver.major = 0;
|
|
swver.minor = 1;
|
|
swver.vcs_commit = 0xDEADBEEF;
|
|
|
|
/*
|
|
* uavcan::Node
|
|
*/
|
|
uavcan::Node<0> node1(nodes.can_a, nodes.clock_a);
|
|
node1.setName("com.example");
|
|
node1.setNodeID(1);
|
|
node1.setSoftwareVersion(swver);
|
|
|
|
/*
|
|
* uavcan::SubNode
|
|
*/
|
|
uavcan::SubNode<0> node2(nodes.can_b, nodes.clock_b);
|
|
std::cout << "sizeof(uavcan::SubNode<0>): " << sizeof(uavcan::SubNode<0>) << std::endl;
|
|
|
|
BackgroundSpinner bgspinner(node2, node1);
|
|
bgspinner.startPeriodic(uavcan::MonotonicDuration::fromMSec(10));
|
|
|
|
uavcan::NodeStatusMonitor node_status_monitor(node2);
|
|
ASSERT_LE(0, node_status_monitor.start());
|
|
|
|
/*
|
|
* Init the first node
|
|
*/
|
|
ASSERT_FALSE(node1.isStarted());
|
|
ASSERT_EQ(-uavcan::ErrNotInited, node1.spin(uavcan::MonotonicDuration::fromMSec(20)));
|
|
ASSERT_LE(0, node1.start());
|
|
ASSERT_TRUE(node1.isStarted());
|
|
|
|
ASSERT_LE(0, node1.spin(uavcan::MonotonicDuration::fromMSec(2000)));
|
|
|
|
ASSERT_EQ(1, node_status_monitor.findNodeWithWorstHealth().get());
|
|
|
|
/*
|
|
* Some logging
|
|
*/
|
|
SubscriberWithCollector<uavcan::protocol::debug::LogMessage> log_sub(node2);
|
|
ASSERT_LE(0, log_sub.start());
|
|
|
|
node1.getLogger().setLevel(uavcan::protocol::debug::LogLevel::DEBUG);
|
|
node1.logInfo("test", "6 * 9 = 42");
|
|
|
|
ASSERT_LE(0, node1.spin(uavcan::MonotonicDuration::fromMSec(20)));
|
|
ASSERT_LE(0, node2.spin(uavcan::MonotonicDuration::fromMSec(20)));
|
|
|
|
ASSERT_TRUE(log_sub.collector.msg.get());
|
|
std::cout << *log_sub.collector.msg << std::endl;
|
|
}
|