fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-06-26 16:50:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

LPC11C24: More complete test

Browse Source
This commit is contained in:
Pavel Kirienko
2014-04-15 23:28:01 +04:00
parent 1c73f4884c
commit 09203aab1d
2 changed files with 17 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
libuavcan_drivers/lpc11c24/test_olimex_lpc_p11c24/Makefile
+1 -1
View File
@@ -42,7 +42,7 @@ BUILDDIR = build
OBJDIR = $(BUILDDIR)/obj
DEPDIR = $(BUILDDIR)/dep
DEF += -DNDEBUG -DCHIP_LPC11CXX -DCORE_M0 -DTHUMB_NO_INTERWORKING
DEF += -DNDEBUG -DCHIP_LPC11CXX -DCORE_M0 -DTHUMB_NO_INTERWORKING -U__STRICT_ANSI__
FLAGS = -mthumb -mcpu=cortex-m0 -mno-thumb-interwork
libuavcan_drivers/lpc11c24/test_olimex_lpc_p11c24/src/main.cpp
+16
View File
@@ -2,6 +2,7 @@
* Pavel Kirienko, 2014 <pavel.kirienko@gmail.com>
*/
#include <cstdio>
#include <board.hpp>
#include <chip.h>
#include <uavcan_lpc11c24/can.hpp>
@@ -22,6 +23,7 @@ int main()
uavcan_lpc11c24::clock::init();
uavcan::MonotonicTime prev_mono;
uavcan::MonotonicTime prev_time_pub_at;
while (true)
{
@@ -52,5 +54,19 @@ int main()
{
board::setStatusLed(false);
}
if ((ts_mono - prev_time_pub_at).toMSec() >= 1000)
{
prev_time_pub_at = ts_mono;
uavcan::CanFrame frm;
frm.dlc = 8;
std::fill_n(frm.data, 8, 0);
snprintf(reinterpret_cast<char*>(frm.data), 8, "%u", unsigned(ts_mono.toMSec()));
frm.id = ts_mono.toMSec() | uavcan::CanFrame::FlagEFF;
ENFORCE(1 == uavcan_lpc11c24::CanDriver::instance().send(frm, ts_mono, 0));
}
}
}