Contiki 2.6

acc-sensor.c

Go to the documentation of this file.
00001 /*
00002  * Copyright (c) 2010, STMicroelectronics.
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
00011  *    copyright notice, this list of conditions and the following
00012  *    disclaimer in the documentation and/or other materials provided
00013  *    with the distribution.
00014  * 3. The name of the author may not be used to endorse or promote
00015  *    products derived from this software without specific prior
00016  *    written permission.
00017  *
00018  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
00019  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
00020  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
00021  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
00022  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
00023  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
00024  * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
00025  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
00026  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
00027  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
00028  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
00029  *
00030  * This file is part of the Contiki OS
00031  *
00032  * $Id: acc-sensor.c,v 1.1 2010/10/25 09:03:39 salvopitru Exp $
00033  */
00034 /*---------------------------------------------------------------------------*/
00035 /**
00036 * \file
00037 *                       Accelerometer.
00038 * \author
00039 *                       Salvatore Pitrulli <salvopitru@users.sourceforge.net>
00040 */
00041 /*---------------------------------------------------------------------------*/
00042 
00043 
00044 #include "dev/acc-sensor.h"
00045 #include "sys/clock.h"
00046 #include "mems.h"
00047 
00048 #define FALSE 0
00049 #define TRUE  1
00050 
00051 /*---------------------------------------------------------------------------*/
00052 static int
00053 active(void)
00054 {
00055   int8u reg;
00056   if(!i2c_read_reg (kLIS3L02DQ_SLAVE_ADDR,CTRL_REG1, &reg, 1))
00057     return FALSE;
00058   
00059   return (reg & 0x40) ? TRUE : FALSE ;
00060 }
00061 /*---------------------------------------------------------------------------*/
00062 static int
00063 value(int type)
00064 {
00065   
00066   int8s i2c_data = 0;
00067   int8u reg_addr;
00068   
00069   switch(type) {
00070     case ACC_X_AXIS:
00071       reg_addr = OUTX_H;
00072       break;
00073       
00074     case ACC_Y_AXIS:
00075       reg_addr = OUTY_H;
00076       break;
00077       
00078     case ACC_Z_AXIS:
00079       reg_addr = OUTZ_H;
00080       break;
00081       
00082     default:
00083       return 0;    
00084   }
00085   
00086   i2c_read_reg(kLIS3L02DQ_SLAVE_ADDR, reg_addr, (int8u *)&i2c_data, 1);
00087   
00088   if(MEMS_GetFullScale()==ACC_HIGH_RANGE){
00089     return ((int16s)i2c_data)*HIGH_RANGE_SENSITIVITY;
00090   }
00091   else {
00092     return ((int16s)i2c_data)*LOW_RANGE_SENSITIVITY;
00093   }
00094 
00095 }
00096 /*---------------------------------------------------------------------------*/
00097 static int
00098 configure(int type, int value)
00099 {
00100   switch(type) {
00101     
00102     case SENSORS_HW_INIT:
00103        return Mems_Init();
00104        
00105     case SENSORS_ACTIVE:
00106       if(value){
00107           if(MEMS_On()){
00108               clock_wait(8);
00109               return 1;
00110           }
00111           return 0;
00112       }
00113       else
00114         return MEMS_Off();      
00115     
00116     case ACC_RANGE:
00117       return MEMS_SetFullScale((boolean)value);
00118       
00119     case ACC_HPF:      
00120       if(value < ACC_HPF_DISABLE){
00121         return i2c_write_reg(kLIS3L02DQ_SLAVE_ADDR, CTRL_REG2, (1<<4) | (int8u)value);
00122       }
00123       else {
00124         return i2c_write_reg(kLIS3L02DQ_SLAVE_ADDR, CTRL_REG2, 0x00);
00125       }
00126   }
00127   return 0;
00128 }
00129 /*---------------------------------------------------------------------------*/
00130 static int
00131 status(int type)
00132 {
00133   switch(type) {
00134     
00135   case SENSORS_READY:
00136     return active();
00137   }
00138   
00139   return 0;
00140 }
00141 /*---------------------------------------------------------------------------*/
00142 SENSORS_SENSOR(acc_sensor, ACC_SENSOR,
00143                value, configure, status);
00144 
00145 
00146 
00147