fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-12 19:23:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

LPC11C24 abort debug code removed

Browse Source
This commit is contained in:
Pavel Kirienko
2015-10-12 23:09:57 +03:00
parent 367389f728
commit 6f782b2be2
1 changed files with 5 additions and 26 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libuavcan_drivers/lpc11c24/test_olimex_lpc_p11c24/src/main.cpp
+5 -26
View File
@@ -159,40 +159,19 @@ int main()
while (true)
{
//const int res = getNode().spin(uavcan::MonotonicDuration::fromMSec(25));
const int res = getNode().spinOnce();
const int res = getNode().spin(uavcan::MonotonicDuration::fromMSec(25));
board::setErrorLed(res < 0);
board::setStatusLed(uavcan_lpc11c24::CanDriver::instance().hadActivity());
if (uavcan_lpc11c24::CanDriver::instance().hasEmptyTx())
{
// Abort test
static unsigned value = 0;
const std::uint8_t payload[] = {
0,
0,
0,
0,
std::uint8_t(value >> 24),
std::uint8_t(value >> 16),
std::uint8_t(value >> 8),
std::uint8_t(value >> 0),
};
value++;
(void)uavcan_lpc11c24::CanDriver::instance().send(uavcan::CanFrame(123U | uavcan::CanFrame::FlagEFF,
payload, sizeof(payload)),
uavcan::MonotonicTime::getMax(),
uavcan::CanIOFlagAbortOnError);
}
const auto ts = uavcan_lpc11c24::clock::getMonotonic();
if ((ts - prev_log_at).toMSec() >= 1000)
{
prev_log_at = ts;
// CAN bus off state monitoring
board::syslog("CAN bus off: ");
board::syslog(intToString(int(uavcan_lpc11c24::CanDriver::instance().isInBusOffState())).c_str());
board::syslog("\r\n");
if (uavcan_lpc11c24::CanDriver::instance().isInBusOffState())
{
board::syslog("CAN BUS OFF\r\n");
}
// CAN error counter, for debugging purposes
board::syslog("CAN errors: ");
board::syslog(intToString(static_cast<long long>(uavcan_lpc11c24::CanDriver::instance().getErrorCount())).c_str());