hplclock.nc

无线传感器网络中的节点定位算法。详见ReadMe文件。在TinyOS上实现的节点定位算法。

// $Id: HPLClock.nc,v 1.1 2004/09/28 19:36:38 dcm Exp $

/* DCM: Modified to provide real-time clock functions */

/*									tab:4
 * "Copyright (c) 2000-2003 The Regents of the University  of California.  
 * 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 following
 * two paragraphs and the author appear in all copies of this software.
 * 
 * IN NO EVENT SHALL THE UNIVERSITY OF CALIFORNIA BE LIABLE TO ANY PARTY FOR
 * DIRECT, INDIRECT, SPECIAL, INCIDENTAL, OR CONSEQUENTIAL DAMAGES ARISING OUT
 * OF THE USE OF THIS SOFTWARE AND ITS DOCUMENTATION, EVEN IF THE UNIVERSITY OF
 * CALIFORNIA HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 * 
 * THE UNIVERSITY OF CALIFORNIA SPECIFICALLY DISCLAIMS ANY WARRANTIES,
 * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
 * AND FITNESS FOR A PARTICULAR PURPOSE.  THE SOFTWARE PROVIDED HEREUNDER IS
 * ON AN "AS IS" BASIS, AND THE UNIVERSITY OF CALIFORNIA HAS NO OBLIGATION TO
 * PROVIDE MAINTENANCE, SUPPORT, UPDATES, ENHANCEMENTS, OR MODIFICATIONS."
 *
 * Copyright (c) 2002-2003 Intel Corporation
 * All rights reserved.
 *
 * This file is distributed under the terms in the attached INTEL-LICENSE     
 * file. If you do not find these files, copies can be found by writing to
 * Intel Research Berkeley, 2150 Shattuck Avenue, Suite 1300, Berkeley, CA, 
 * 94704.  Attention:  Intel License Inquiry.
 */
/*
 *
 * Authors:		Jason Hill, David Gay, Philip Levis
 * Date last modified:  6/25/02
 *                      1/8/03 Su Ping Added StdControl interface +
 *                      some new commands in Clock interface
 *
 */

// The hardware presentation layer. See hpl.h for the C side.
// Note: there's a separate C side (hpl.h) to get access to the avr macros

// The model is that HPL is stateless. If the desired interface is as stateless
// it can be implemented here (Clock, FlashBitSPI). Otherwise you should
// create a separate component


/**
 * @author Jason Hill
 * @author David Gay
 * @author Philip Levis
 */

module HPLClock {
  provides {
      interface Clock;
      interface StdControl;
      async command uint32_t GetClock();
      async command uint32_t GetClockSec();
      async command uint16_t GetClockLow();
  }
}
implementation
{
    char clockRate, set_flag;
    norace unsigned char mscale, nextScale, minterval ;

    /* DCM: added next three functions */
    async command uint32_t GetClock()
    {
        return tos_state.tos_time / 4000;
    }

    async command uint32_t GetClockSec()
    {
        return tos_state.tos_time / 4000000;
    }

    async command uint16_t GetClockLow()
    {
        return (tos_state.tos_time / 4000) & 0xffff;
    }

    command result_t StdControl.init() {
        mscale = DEFAULT_SCALE; 
        minterval = DEFAULT_INTERVAL;
	dbg(DBG_BOOT, "HPLClock initialized.\n");
	TOSH_clock_set_rate(minterval, mscale);
        return SUCCESS;
    }

    command result_t StdControl.start() {
      TOSH_clock_set_rate(minterval, mscale);
      return SUCCESS;
    }

    command result_t StdControl.stop() {
      TOSH_clock_set_rate(minterval, 0);
      return SUCCESS;
    }


    async command void Clock.setInterval(uint8_t value) {
      TOSH_clock_set_rate(value, mscale);		
    }
    
    async command void Clock.setNextInterval(uint8_t value) {
        minterval = value;
        set_flag = 1;
    }

    async command uint8_t Clock.getInterval() {
      return TOSH_get_clock_interval();
    }

    async command uint8_t Clock.getScale() {
      return mscale;
    }

    async command void Clock.setNextScale(uint8_t scale) {
      set_flag=1;
      nextScale= scale;
    }
       

    async command result_t Clock.setIntervalAndScale(uint8_t interval, uint8_t scale) {
        
        if (scale >7) return FAIL;
        scale|=0x8;
        TOSH_clock_set_rate(interval, scale);
        return SUCCESS;
    }
        
    async command uint8_t Clock.readCounter() {
      return TOSH_get_clock0_counter();
    }

    async command void Clock.setCounter(uint8_t n) {
      TOSH_set_clock0_counter(n);
    }

    async command void Clock.intDisable() {
      TOSH_clock_int_disable();
    }
    async command void Clock.intEnable() {
      TOSH_clock_int_enable();
    }

    async command result_t Clock.setRate(char interval, char scale) {
      mscale = scale;
      minterval = interval;
      TOSH_clock_set_rate(interval, scale);
      return SUCCESS;
    }
    
    default async event result_t Clock.fire() { return SUCCESS; }
    TOS_INTERRUPT_HANDLER(SIG_OUTPUT_COMPARE2, ()) {
      if (set_flag) {
	mscale = nextScale;
	nextScale|=0x8;
	TOSH_clock_set_rate(minterval, nextScale);
	set_flag=0;
      }
      signal Clock.fire();
    }
}