acc-sensor.c

00001 /*
00002  * Copyright (c) 2010, Swedish Institute of Computer Science.
00003  * All rights reserved.
00004  *
00005  * Redistribution and use in source and binary forms, with or without
00006  * modification, are permitted provided that the following conditions
00007  * are met:
00008  * 1. Redistributions of source code must retain the above copyright
00009  *    notice, this list of conditions and the following disclaimer.
00010  * 2. Redistributions in binary form must reproduce the above copyright
00011  *    notice, this list of conditions and the following disclaimer in the
00012  *    documentation and/or other materials provided with the distribution.
00013  * 3. Neither the name of the Institute nor the names of its contributors
00014  *    may be used to endorse or promote products derived from this software
00015  *    without specific prior written permission.
00016  *
00017  * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
00018  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
00019  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
00020  * ARE DISCLAIMED.  IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
00021  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
00022  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
00023  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
00024  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
00025  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
00026  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
00027  * SUCH DAMAGE.
00028  *
00029  * $Id: acc-sensor.c,v 1.2 2010/08/25 19:34:42 nifi Exp $
00030  *
00031  * -----------------------------------------------------------------
00032  *
00033  * Author  : Adam Dunkels, Joakim Eriksson, Niclas Finne
00034  * Created : 2005-11-01
00035  * Updated : $Date: 2010/08/25 19:34:42 $
00036  *           $Revision: 1.2 $
00037  */
00038 
00039 #include "dev/acc-sensor.h"
00040 #include "dev/sky-sensors.h"
00041 #include <io.h>
00042 
00043 /* Configure ADC12_2 to sample channel 4, 5, 6 and use */
00044 /* the Vref+ as reference (SREF_1) since it is a stable reference */
00045 #define INPUT_CHANNEL      ((1 << INCH_4) | (1 << INCH_5) | (1 << INCH_6))
00046 #define INPUT_REFERENCE     SREF_1
00047 #define ACC_MEM_X            ADC12MEM4  /* Xout */
00048 #define ACC_MEM_Y            ADC12MEM5  /* Yout */
00049 #define ACC_MEM_Z            ADC12MEM6  /* Zout */
00050 
00051 const struct sensors_sensor acc_sensor;
00052 
00053 /*---------------------------------------------------------------------------*/
00054 static int
00055 value(int type)
00056 {
00057   switch(type) {
00058   case ACC_SENSOR_X:
00059     return ACC_MEM_X;
00060   case ACC_SENSOR_Y:
00061     return ACC_MEM_Y;
00062   case ACC_SENSOR_Z:
00063     return ACC_MEM_Z;
00064   }
00065   return 0;
00066 }
00067 /*---------------------------------------------------------------------------*/
00068 static int
00069 configure(int type, int c)
00070 {
00071   if(type == SENSORS_ACTIVE) {
00072     /* Sleep Mode P2.3 */
00073     if(c) {
00074       P2OUT |= 0x08;
00075       P2DIR |= 0x08;
00076     } else {
00077       /* Sensor deactivated. Changed to sleep mode. */
00078       P2OUT &= ~0x08;
00079     }
00080   } else if(type == ACC_SENSOR_SENSITIVITY) {
00081     /* g-Select1 P2.0, g-Select2 P2.1 */
00082     P2DIR |= 0x03;
00083     P2OUT &= ~0x03;
00084     P2OUT |= c & 0x03;
00085   }
00086   return sky_sensors_configure(INPUT_CHANNEL, INPUT_REFERENCE, type, c);
00087 }
00088 /*---------------------------------------------------------------------------*/
00089 static int
00090 status(int type)
00091 {
00092   if(type == ACC_SENSOR_SENSITIVITY) {
00093     return (P2OUT & P2DIR) & 0x03;
00094   }
00095   return sky_sensors_status(INPUT_CHANNEL, type);
00096 }
00097 /*---------------------------------------------------------------------------*/
00098 SENSORS_SENSOR(acc_sensor, ACC_SENSOR, value, configure, status);

Generated on Mon Apr 11 14:23:44 2011 for Contiki 2.5 by  doxygen 1.6.1