72 lines
1.5 KiB
C
72 lines
1.5 KiB
C
|
|
||
|
|
#include "contiki.h"
|
||
|
|
#include "sys/rtimer.h"
|
||
|
|
|
||
|
|
#include "dev/leds.h"
|
||
|
|
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
PROCESS(test_rtimer_process, "Test RT");
|
||
|
|
AUTOSTART_PROCESSES(&test_rtimer_process);
|
||
|
|
|
||
|
|
struct fade {
|
||
|
|
struct rtimer rt;
|
||
|
|
struct pt pt;
|
||
|
|
int led;
|
||
|
|
rtimer_clock_t ontime, offtime;
|
||
|
|
int addend;
|
||
|
|
};
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
static void
|
||
|
|
fade(struct rtimer *t, void *ptr)
|
||
|
|
{
|
||
|
|
struct fade *f = ptr;
|
||
|
|
|
||
|
|
PT_BEGIN(&f->pt);
|
||
|
|
|
||
|
|
while(1) {
|
||
|
|
leds_on(f->led);
|
||
|
|
rtimer_set(t, RTIMER_TIME(t) + f->ontime, 1, fade, ptr);
|
||
|
|
PT_YIELD(&f->pt);
|
||
|
|
|
||
|
|
leds_off(f->led);
|
||
|
|
rtimer_set(t, RTIMER_TIME(t) + f->offtime, 1, fade, ptr);
|
||
|
|
|
||
|
|
f->ontime += f->addend;
|
||
|
|
f->offtime -= f->addend;
|
||
|
|
if(f->offtime <= 4 || f->offtime >= 100) {
|
||
|
|
f->addend = -f->addend;
|
||
|
|
}
|
||
|
|
PT_YIELD(&f->pt);
|
||
|
|
}
|
||
|
|
|
||
|
|
PT_END(&f->pt);
|
||
|
|
}
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
static void
|
||
|
|
init_fade(struct fade *f, int led)
|
||
|
|
{
|
||
|
|
f->led = led;
|
||
|
|
f->addend = 4;
|
||
|
|
f->ontime = 4;
|
||
|
|
f->offtime = 100;
|
||
|
|
PT_INIT(&f->pt);
|
||
|
|
rtimer_set(&f->rt, RTIMER_NOW() + led, 1, fade, f);
|
||
|
|
}
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
PROCESS_THREAD(test_rtimer_process, ev, data)
|
||
|
|
{
|
||
|
|
static struct fade red;
|
||
|
|
PROCESS_BEGIN();
|
||
|
|
|
||
|
|
rtimer_init();
|
||
|
|
|
||
|
|
init_fade(&red, LEDS_RED);
|
||
|
|
|
||
|
|
while(1) {
|
||
|
|
PROCESS_WAIT_EVENT();
|
||
|
|
}
|
||
|
|
|
||
|
|
PROCESS_END();
|
||
|
|
}
|
||
|
|
/*---------------------------------------------------------------------------*/
|