1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
|
/*
* Copyright (c) 2007 Stanford University.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* - Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* - Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the
* distribution.
* - Neither the name of the Stanford University nor the names of
* its contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL STANFORD
* UNIVERSITY OR ITS CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
* OF THE POSSIBILITY OF SUCH DAMAGE.
*/
/**
* @author Kevin Klues <klueska@cs.stanford.edu>
* @date July 24, 2007
*/
generic module PeriodicSampleLoggerP(uint32_t period_ms,
uint8_t num_sensors,
typedef sensor_type_t) {
uses {
interface Boot;
interface Read<sensor_type_t> as Sensor[uint8_t];
interface Timer<TMilli> as Timer;
interface LogWrite;
interface Leds;
}
}
implementation {
#include "GenericSensorSample.h"
generic_sensor_sample_t sample[2];
generic_sensor_sample_t* current_sample;
uint8_t current_sample_id;
task void eraseTask();
task void appendTask();
void readSensors() {
int i;
for(i=0; i<num_sensors; i++)
call Sensor.read[i]();
}
void appendSample(generic_sensor_sample_t* s) {
//printf("WRITE LOC: %d\n", call LogWrite.currentOffset());
if(call LogWrite.append(s, sizeof(generic_sensor_sample_t)) != SUCCESS)
post appendTask();
}
task void eraseTask() {
if(call LogWrite.erase() != SUCCESS)
post eraseTask();
}
task void appendTask() {
appendSample(&(sample[!current_sample_id]));
}
event void Boot.booted() {
if(call LogWrite.erase() != SUCCESS)
post eraseTask();
}
event void LogWrite.eraseDone(error_t error) {
sample[0].sample_num = 0;
sample[1].sample_num = 1;
current_sample_id = 0;
current_sample = &(sample[current_sample_id]);
readSensors();
call Timer.startPeriodic(period_ms);
}
event void Timer.fired() {
call Leds.led0Toggle();
appendSample(current_sample);
current_sample_id = !current_sample_id;
current_sample = &(sample[current_sample_id]);
readSensors();
}
event void Sensor.readDone[uint8_t i](error_t result, sensor_type_t val) {
if(result == SUCCESS) {
current_sample->values[i] = val;
call Leds.led1Toggle();
}
else {
current_sample->values[i] = ((generic_sensor_sample_type_union_t)(0xFFFFFFFF)).st;
call Leds.led2Toggle();
}
}
event void LogWrite.appendDone(void* buf, storage_len_t len, bool recordsLost, error_t error){
if(error != SUCCESS)
post appendTask();
else ((generic_sensor_sample_t*)buf)->sample_num+=2;
}
event void LogWrite.syncDone(error_t error) {}
default command error_t Sensor.read[uint8_t i]() {return SUCCESS;}
}
|
