Contiki 2.6
|
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 "contiki.h" 00040 #include "dev/acc-sensor.h" 00041 #include "dev/sky-sensors.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);