Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-30 04:06:33 +08:00
Code Issues Actions 9 Packages Projects Releases Wiki Activity

Fixed RGB led warnings and error handling

Browse Source
This commit is contained in:
Lorenz Meier
2013-04-06 12:00:51 +02:00
parent d1d4d1d1e2
commit c25248f1af
1 changed files with 14 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/device/rgbled/rgbled.cpp
+14 -7
View File
@@ -219,9 +219,13 @@ RGBLED::info()
ret = get(on, not_powersave, r, g, b); ret = get(on, not_powersave, r, g, b);
/* we don't care about power-save mode */ if (ret == OK) {
log("State: %s", on ? "ON" : "OFF"); /* we don't care about power-save mode */
log("Red: %d, Green: %d, Blue: %d", r, g, b); log("state: %s", on ? "ON" : "OFF");
log("red: %u, green: %u, blue: %u", (unsigned)r, (unsigned)g, (unsigned)b);
} else {
warnx("failed to read led");
}
return ret; return ret;
} }
@@ -394,6 +398,7 @@ RGBLED::get(bool &on, bool &not_powersave, uint8_t &r, uint8_t &g, uint8_t &b)
if (ret == OK) { if (ret == OK) {
on = result[0] & SETTING_ENABLE; on = result[0] & SETTING_ENABLE;
not_powersave = result[0] & SETTING_NOT_POWERSAVE; not_powersave = result[0] & SETTING_NOT_POWERSAVE;
/* XXX check, looks wrong */
r = (result[0] & 0x0f)*255/15; r = (result[0] & 0x0f)*255/15;
g = (result[1] & 0xf0)*255/15; g = (result[1] & 0xf0)*255/15;
b = (result[1] & 0x0f)*255/15; b = (result[1] & 0x0f)*255/15;
@@ -402,12 +407,14 @@ RGBLED::get(bool &on, bool &not_powersave, uint8_t &r, uint8_t &g, uint8_t &b)
return ret; return ret;
} }
void rgbled_usage();
void rgbled_usage() { void rgbled_usage() {
fprintf(stderr, "missing command: try 'start', 'systemstate', 'test', 'info', 'off'\n"); warnx("missing command: try 'start', 'systemstate', 'test', 'info', 'off'");
fprintf(stderr, "options:\n"); warnx("options:");
fprintf(stderr, "\t-b --bus i2cbus (3)\n"); warnx("\t-b --bus i2cbus (3)");
fprintf(stderr, "\t-a --ddr addr (9)\n"); warnx("\t-a --ddr addr (9)");
} }
int int