Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-06 16:03:58 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Notify: reduce the latency in the main task of LED updates

Browse Source 
the ioctl now gets called in a IO timer callback
This commit is contained in:
Andrew Tridgell 2014-01-24 10:40:39 +11:00
parent 0d174db05b
commit 23d8bfa976
2 changed files with 29 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
libraries/AP_Notify/ToshibaLED_PX4.cpp
View File

@ -41,21 +41,37 @@ bool ToshibaLED_PX4::hw_init()
return false; return false;
} }
ioctl(_rgbled_fd, RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_ON); ioctl(_rgbled_fd, RGBLED_SET_MODE, (unsigned long)RGBLED_MODE_ON);
last.zero();
next.zero();
hal.scheduler->register_io_process(AP_HAL_MEMBERPROC(&ToshibaLED_PX4::update_timer));
return true; return true;
} }
// set_rgb - set color as a combination of red, green and blue values // set_rgb - set color as a combination of red, green and blue values
bool ToshibaLED_PX4::hw_set_rgb(uint8_t red, uint8_t green, uint8_t blue) bool ToshibaLED_PX4::hw_set_rgb(uint8_t red, uint8_t green, uint8_t blue)
{ {
rgbled_rgbset_t v; hal.scheduler->suspend_timer_procs();
next[0] = red;
v.red = red; next[1] = green;
v.green = green; next[2] = blue;
v.blue = blue; hal.scheduler->resume_timer_procs();
return true;
int ret = ioctl(_rgbled_fd, RGBLED_SET_RGB, (unsigned long)&v);
return (ret == 0);
} }
void ToshibaLED_PX4::update_timer(void)
{
if (last == next) {
return;
}
rgbled_rgbset_t v;
v.red = next[0];
v.green = next[1];
v.blue = next[2];
ioctl(_rgbled_fd, RGBLED_SET_RGB, (unsigned long)&v);
last = next;
}
#endif // CONFIG_HAL_BOARD == HAL_BOARD_PX4 #endif // CONFIG_HAL_BOARD == HAL_BOARD_PX4

5
libraries/AP_Notify/ToshibaLED_PX4.h
View File

@ -19,6 +19,8 @@
#define __TOSHIBA_LED_PX4_H__ #define __TOSHIBA_LED_PX4_H__
#include "ToshibaLED.h" #include "ToshibaLED.h"
#include "AP_Math.h"
#include "vectorN.h"
class ToshibaLED_PX4 : public ToshibaLED class ToshibaLED_PX4 : public ToshibaLED
{ {
@ -27,6 +29,9 @@ public:
bool hw_set_rgb(uint8_t r, uint8_t g, uint8_t b); bool hw_set_rgb(uint8_t r, uint8_t g, uint8_t b);
private: private:
int _rgbled_fd; int _rgbled_fd;
void update_timer(void);
VectorN<uint8_t,3> last, next;
}; };
#endif // __TOSHIBA_LED_PX4_H__ #endif // __TOSHIBA_LED_PX4_H__