generic module AeroVaneReadP(uint16_t period) {
provides interface Notify<aerovector_t>;
uses {
-#if 0
- interface Alarm<T32khz, uint16_t>;
-#else
interface Timer<TMilli>;
-#endif
interface Read<uint16_t>;
interface StdControl as AnemometerControl;
interface AsyncGet<uint16_t> as Count;
int m_vane;
int m_sum;
- task void readVane();
-
void init()
{
m_count = 0;
init();
call AnemometerControl.start();
- /* FIXME: First alarm should be synced to top of the next second. How? */
-#if 0
- call Alarm.start(call Alarm.getNow() + period);
-#else
+ /* FIXME: How to get first Timer.fired() synced with top of hour? */
call Timer.startPeriodic(period);
-#endif
return SUCCESS;
}
command error_t Notify.disable()
{
call State.toIdle();
-#if 0
- call Alarm.stop();
-#else
call Timer.stop();
-#endif
call AnemometerControl.stop();
return SUCCESS;
}
-#if 0
- async event void Alarm.fired()
-#else
event void Timer.fired()
-#endif
- {
- //call Alarm.start(call Alarm.getAlarm() + period);
- post readVane();
- }
-
- task void readVane()
{
- //call Alarm.start(call Alarm.getAlarm() + period);
if (!(call State.isIdle()))
call Read.read();
}
norace aerovector_t vector;
/* Get speed average */
- atomic vector.speed = call Count.get();
+ atomic vector.speed = (call Count.get() * 2.25) / (period * 4 / 1024) +
+ 0.5;
/* Complete direction average */
vector.dir = m_sum / PHYS_PER_READ;