periodicsampleloggerp.nc

tinyos2.0版本驱动

/*
 * 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 <[e-mail]>
 * @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;}
}