Contiki 2.6
|
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, ®, 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