dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

fix style

This commit is contained in:
Hidenori 2016-07-20 21:54:56 -04:00 committed by Lorenz Meier
parent eded7bf772
commit 5920711c20
1 changed files with 46 additions and 45 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

91
src/drivers/navio_rgbled/test/test.cpp
View File

@ -16,64 +16,65 @@ int do_test();
int do_test() int do_test()
{ {
DevHandle h; DevHandle h;
RGBLED *g_dev = nullptr; RGBLED *g_dev = nullptr;
if (Framework::initialize() < 0) { if (Framework::initialize() < 0) {
printf("Framework init failed\n"); printf("Framework init failed\n");
return -1; return -1;
} }
g_dev = new RGBLED("navio_rgbled test"); g_dev = new RGBLED("navio_rgbled test");
g_dev->start(); g_dev->start();
DevMgr::getHandle(RGBLED0_DEVICE_PATH, h); DevMgr::getHandle(RGBLED0_DEVICE_PATH, h);
if (!h.isValid()) {
printf("No RGB LED at " RGBLED0_DEVICE_PATH);
return -1;
}
printf("off\n"); if (!h.isValid()) {
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_OFF); printf("No RGB LED at " RGBLED0_DEVICE_PATH);
sleep(2); return -1;
}
printf("red\n"); printf("off\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_RED); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_OFF);
sleep(2); sleep(2);
printf("yellow\n"); printf("red\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_YELLOW); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_RED);
sleep(2); sleep(2);
printf("purple\n"); printf("yellow\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_PURPLE); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_YELLOW);
sleep(2); sleep(2);
printf("green\n"); printf("purple\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_GREEN); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_PURPLE);
sleep(2); sleep(2);
printf("blue\n"); printf("green\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_BLUE); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_GREEN);
sleep(2); sleep(2);
printf("blue blink slow\n"); printf("blue\n");
h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BLINK_SLOW); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_BLUE);
sleep(10); sleep(2);
printf("green blink normal\n"); printf("blue blink slow\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_GREEN); h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BLINK_SLOW);
h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BLINK_NORMAL); sleep(10);
sleep(10);
printf("red blink fast\n"); printf("green blink normal\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_RED); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_GREEN);
h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BLINK_FAST); h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BLINK_NORMAL);
sleep(10); sleep(10);
printf("blue breathe (bogus)\n"); printf("red blink fast\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_BLUE); h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_RED);
h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BREATHE); h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BLINK_FAST);
sleep(10); sleep(10);
printf("blue breathe (bogus)\n");
h.ioctl(RGBLED_SET_COLOR, (unsigned long)RGBLED_COLOR_BLUE);
h.ioctl(RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_BREATHE);
sleep(10);
return 0; return 0;
} }