mica2-magnet.c

MANTIS是由科罗拉多大学开发的传感器网络嵌入式操作系统。 这是mantis的0.9.5版本的源码。

//  This file is part of MANTIS OS, Operating System
//  See http://mantis.cs.colorado.edu/
//
//  Copyright (C) 2003,2004,2005 University of Colorado, Boulder
//
//  This program is free software; you can redistribute it and/or
//  modify it under the terms of the mos license (see file LICENSE)

/*
  Charles Gruenwald 4-22-04

  Integrated magnetometer sensor for the mica2.  This driver
  registers with the dev layer as two different devs, but they are
  intertwined in hardware so we implement it in one file.
*/

#include "mos.h"

#if defined(PLATFORM_MICA_ANY)

#include "mica2-magnet.h"
#include "adc.h"
#include "avr-adc.h"
#include "dev.h"
#include "mutex.h"

#if defined(MICA2_MAGNET) || !defined(SCONS)

mos_mutex_t magnet_x_mutex;
mos_mutex_t magnet_y_mutex;
static uint8_t mode;

/*the following functions implement the dev interface */

/*magnetometer device functions*/
static void magnet_on(void) 
{
   MAGNET_PORT_DIRE |= MAGNET_PIN_MASK;
   MAGNET_PORT &= ~MAGNET_PIN_MASK;
   MAGNET_PORT |= MAGNET_PIN_MASK;
}

static void magnet_off(void)
{
   MAGNET_PORT_DIRE &= ~(MAGNET_PIN_MASK);
   MAGNET_PORT &= ~(MAGNET_PIN_MASK);
}

uint16_t dev_read_DEV_MICA2_MAGNET_X(void *buf, uint16_t count)
{
   if(mode == DEV_MODE_OFF)
      magnet_on();
   
   dev_open(DEV_ADC);
   
   if (count == 1)
      ((uint8_t *)buf)[0] = adc_read_channel8 (AVR_ADC_CH_5);
   else if (count == 2)
      ((uint16_t *)buf)[0] = adc_read_channel16 (AVR_ADC_CH_5);
   else
      ;

   dev_close(DEV_ADC);
   
   if(mode == DEV_MODE_OFF)
      magnet_off();
   
   return count;
}

uint16_t dev_write_DEV_MICA2_MAGNET_X(const void *buf, uint16_t count)
{
   return DEV_UNSUPPORTED;
}

uint8_t dev_mode_DEV_MICA2_MAGNET_X(uint8_t md)
{   
   switch(md) {
   case DEV_MODE_ON:
   case DEV_MODE_IDLE:
      magnet_on();
      break;

   case DEV_MODE_OFF:
      magnet_off();
      break;

   default:
      return DEV_UNSUPPORTED;
   }
   mode = md;

   return DEV_OK;
}

uint8_t dev_ioctl_DEV_MICA2_MAGNET_X(int8_t request, ...)
{
   return DEV_BAD_IOCTL;
}

uint16_t dev_read_DEV_MICA2_MAGNET_Y (void *buf, uint16_t count)
{
   if(mode == DEV_MODE_OFF)
      magnet_on();

   dev_open(DEV_ADC);
   
   if(count == 1)
      ((uint8_t *)buf)[0] = adc_read_channel8 (AVR_ADC_CH_6); 
   else if(count == 2)
      ((uint16_t *)buf)[0] = adc_read_channel16 (AVR_ADC_CH_6);
   else
      ;

   dev_close(DEV_ADC);
   
   if(mode == DEV_MODE_OFF)
      magnet_off();
  
   return count;
}

uint16_t dev_write_DEV_MICA2_MAGNET_Y(const void *buf, uint16_t count)
{
   return DEV_UNSUPPORTED;
}

uint8_t dev_mode_DEV_MICA2_MAGNET_Y(uint8_t md)
{
   switch(md) {
   case DEV_MODE_ON:
   case DEV_MODE_IDLE:
      magnet_on();
      break;
      
   case DEV_MODE_OFF:
      magnet_off();
      break;
      
   default:
      return DEV_UNSUPPORTED;
   }
   mode = md;
   
   return DEV_OK;
}

uint8_t dev_ioctl_DEV_MICA2_MAGNET_Y(int8_t request, ...)
{
   return DEV_BAD_IOCTL;
}

/*last, we have our init functions*/
void mica2_magnet_init(void)
{
   mos_mutex_init(&magnet_x_mutex);
   mos_mutex_init(&magnet_y_mutex);
   magnet_off();
}

#endif
#endif