testblockstoragep.nc

tinyos2.0版本驱动

/*
 * Copyright (c) 2008 Johns Hopkins University.
 * All rights reserved.
 *
 * Permission to use, copy, modify, and distribute this software and its
 * documentation for any purpose, without fee, and without written
 * agreement is hereby granted, provided that the above copyright
 * notice, the (updated) modification history and the author appear in
 * all copies of this source code.
 *
 * 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 THE COPYRIGHT HOLDERS OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, LOSS OF USE, DATA,
 * OR PROFITS) 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 Chieh-Jan Mike Liang <[e-mail]>
 */

#include "Storage.h"

module TestBlockStorageP
{
  uses {
    interface Boot;
    interface Leds;
    interface Thread as TinyThread1;
    interface BlockingBlock as BlockingBlock1;
    interface Random;
  }
}

implementation
{
  event void Boot.booted() {
    call TinyThread1.start(NULL);
  }
  
  event void TinyThread1.run(void* arg)
  {
    int i;
    error_t error;

    call Leds.set(1);

    if (call BlockingBlock1.getSize() != 1048576) {
      call Leds.set(7);
      return;
    }
    
    error = call BlockingBlock1.erase();
    if (error != SUCCESS) {
      call Leds.set(7);
      return;
    }
    
    for (i = 0; i < 20; i++) {
      storage_addr_t writeAddr = call Random.rand32() % (call BlockingBlock1.getSize() - sizeof(storage_addr_t));
      storage_len_t len = sizeof(storage_addr_t);
      storage_addr_t readBuf;
    
      error = call BlockingBlock1.write(writeAddr, &writeAddr, &len);
      if (error == SUCCESS) {
        len = sizeof(storage_addr_t);
        call BlockingBlock1.read(writeAddr, &readBuf, &len);
        if (readBuf != writeAddr) {
          call Leds.set(7);
          return;
        }
      } else {
        call Leds.set(7);
        return;
      }
    }
    
    call Leds.set(2);
  }
}