bytm/SensorConfig.h

   1 /*
   2  * Copyright (C) 2008 The Android Open Source Project
   3  *
   4  * Licensed under the Apache License, Version 2.0 (the "License");
   5  * you may not use this file except in compliance with the License.
   6  * You may obtain a copy of the License at
   7  *
   8  *      http://www.apache.org/licenses/LICENSE-2.0
   9  *
  10  * Unless required by applicable law or agreed to in writing, software
  11  * distributed under the License is distributed on an "AS IS" BASIS,
  12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13  * See the License for the specific language governing permissions and
  14  * limitations under the License.
  15  */
  16
  17 #ifndef SENSOR_CONFIG_H
  18 #define SENSOR_CONFIG_H
  19
  20 #include <hardware/hardware.h>
  21 #include <hardware/sensors.h>
  22 #include <cmath>
  23
  24 /* Maps senor id's to the sensor list */
  25 enum {
  26     accel           = 0,
  27     gyro,
  28     compass,
  29     light,
  30     rotvec,
  31     syncompass,
  32     orientation,
  33     pressure,
  34     numSensorDrivers,
  35     numFds,
  36 };
  37
  38
  39
  40 /*****************************************************************************/
  41
  42 /* Board specific sensor configs. */
  43 #define GRAVITY 9.80665f
  44 #define EVENT_TYPE_ACCEL_X          REL_X
  45 #define EVENT_TYPE_ACCEL_Y          REL_Y
  46 #define EVENT_TYPE_ACCEL_Z          REL_Z
  47
  48 #define EVENT_TYPE_COMP_X           REL_X
  49 #define EVENT_TYPE_COMP_Y           REL_Y
  50 #define EVENT_TYPE_COMP_Z           REL_Z
  51
  52 #define EVENT_TYPE_YAW              REL_RX
  53 #define EVENT_TYPE_PITCH            REL_RY
  54 #define EVENT_TYPE_ROLL             REL_RZ
  55 #define EVENT_TYPE_ORIENT_STATUS    REL_WHEEL
  56
  57 #define EVENT_TYPE_MAGV_X           REL_DIAL
  58 #define EVENT_TYPE_MAGV_Y           REL_HWHEEL
  59 #define EVENT_TYPE_MAGV_Z           REL_MISC
  60
  61 #define EVENT_TYPE_PROXIMITY        ABS_DISTANCE
  62 #define EVENT_TYPE_LIGHT            ABS_MISC
  63
  64 #define EVENT_TYPE_GYRO_X           REL_X
  65 #define EVENT_TYPE_GYRO_Y           REL_Y
  66 #define EVENT_TYPE_GYRO_Z           REL_Z
  67
  68 #define EVENT_TYPE_PRESSURE         REL_X
  69 #define EVENT_TYPE_TEMPERATURE      REL_Y
  70
  71 // 720 LSG = 1G
  72 #define LSG                         (1024.0f)
  73 #define NUMOFACCDATA                (8.0f)
  74
  75 // conversion of acceleration data to SI units (m/s^2)
  76
  77 #define RANGE_A                     (2*GRAVITY_EARTH)
  78 #define RESOLUTION_A                (RANGE_A/(256*NUMOFACCDATA))
  79 #define CONVERT_A                   (GRAVITY_EARTH / LSG / NUMOFACCDATA)
  80 #define CONVERT_A_X(x)              ((float(x)/1000) * (GRAVITY * -1.0))
  81 #define CONVERT_A_Y(x)              ((float(x)/1000) * (GRAVITY * 1.0))
  82 #define CONVERT_A_Z(x)              ((float(x)/1000) * (GRAVITY * 1.0))
  83 // conversion of magnetic data to uT units
  84 #define RANGE_M                     (2048.0f)
  85 #define RESOLUTION_M                (0.01)
  86 #define CONVERT_M                   (1.0f/6.6f)
  87 #define CONVERT_M_X                 (-CONVERT_M)
  88 #define CONVERT_M_Y                 (-CONVERT_M)
  89 #define CONVERT_M_Z                 (CONVERT_M)
  90
  91 /* conversion of orientation data to degree units */
  92 #define CONVERT_O                   (1.0f/64.0f)
  93 #define CONVERT_O_A                 (CONVERT_O)
  94 #define CONVERT_O_P                 (CONVERT_O)
  95 #define CONVERT_O_R                 (-CONVERT_O)
  96
  97 // conversion of gyro data to SI units (radian/sec)
  98 #define RANGE_GYRO                  (2000.0f*(float)M_PI/180.0f)
  99 #define CONVERT_GYRO                ((2000.0f / 32767.0f) * ((float)M_PI / 180.0f))
 100 #define CONVERT_GYRO_X              (-CONVERT_GYRO)
 101 #define CONVERT_GYRO_Y              (-CONVERT_GYRO)
 102 #define CONVERT_GYRO_Z              (CONVERT_GYRO)
 103
 104 // conversion of pressure and temperature data
 105 #define CONVERT_PRESSURE            (1.0f/100.0f)
 106 #define CONVERT_TEMPERATURE         (1.0f/100.0f)
 107
 108 #define RESOLUTION_GYRO             (RANGE_GYRO/(2000*NUMOFACCDATA))
 109 #define SENSOR_STATE_MASK           (0x7FFF)
 110
 111 // Proximity Threshold
 112 #define PROXIMITY_THRESHOLD_GP2A  5.0f
 113
 114 //Used in timespec_to_ns calculations
 115 #define NSEC_PER_SEC    1000000000L
 116
 117 #define BIT(x) (1 << (x))
 118
 119 inline unsigned int set_bit_range(int start, int end)
 120 {
 121     int i;
 122     unsigned int value = 0;
 123
 124     for (i = start; i < end; ++i)
 125         value |= BIT(i);
 126     return value;
 127 }
 128
 129 inline float convert_from_vtf_format(int size, int exponent, unsigned int value)
 130 {
 131     int divider=1;
 132     int i;
 133     float sample;
 134     int mul = 1.0;
 135
 136     value = value & set_bit_range(0, size*8);
 137     if (value & BIT(size*8-1)) {
 138         value =  ((1LL << (size*8)) - value);
 139         mul = -1.0;
 140     }
 141     sample = value * 1.0;
 142     if (exponent < 0) {
 143         exponent = abs(exponent);
 144         for (i = 0; i < exponent; ++i) {
 145             divider = divider*10;
 146         }
 147         return mul * sample/divider;
 148     } else {
 149         return mul * sample * pow(10.0, exponent);
 150     }
 151 }
 152
 153 // Platform sensor orientatation
 154 #define DEF_ORIENT_ACCEL_X                   -1
 155 #define DEF_ORIENT_ACCEL_Y                   -1
 156 #define DEF_ORIENT_ACCEL_Z                   -1
 157
 158 #define DEF_ORIENT_GYRO_X                   -1
 159 #define DEF_ORIENT_GYRO_Y                   1
 160 #define DEF_ORIENT_GYRO_Z                   -1
 161
 162 // G to m/s2
 163 #define CONVERT_FROM_VTF16(s,d,x)      (convert_from_vtf_format(s,d,x))
 164 #define CONVERT_A_G_VTF16E14_X(s,d,x)  (DEF_ORIENT_ACCEL_X *\
 165                                         convert_from_vtf_format(s,d,x)*GRAVITY)
 166 #define CONVERT_A_G_VTF16E14_Y(s,d,x)  (DEF_ORIENT_ACCEL_Y *\
 167                                         convert_from_vtf_format(s,d,x)*GRAVITY)
 168 #define CONVERT_A_G_VTF16E14_Z(s,d,x)  (DEF_ORIENT_ACCEL_Z *\
 169                                         convert_from_vtf_format(s,d,x)*GRAVITY)
 170
 171 // Degree/sec to radian/sec
 172 #define CONVERT_G_D_VTF16E14_X(s,d,x)  (DEF_ORIENT_GYRO_X *\
 173                                         convert_from_vtf_format(s,d,x) * ((float)M_PI/180.0f))
 174 #define CONVERT_G_D_VTF16E14_Y(s,d,x)  (DEF_ORIENT_GYRO_Y *\
 175                                         convert_from_vtf_format(s,d,x) * ((float)M_PI/180.0f))
 176 #define CONVERT_G_D_VTF16E14_Z(s,d,x)  (DEF_ORIENT_GYRO_Z *\
 177                                         convert_from_vtf_format(s,d,x) * ((float)M_PI/180.0f))
 178
 179 // Milli gauss to micro tesla
 180 #define CONVERT_M_MG_VTF16E14_X(s,d,x) (convert_from_vtf_format(s,d,x)/10)
 181 #define CONVERT_M_MG_VTF16E14_Y(s,d,x) (convert_from_vtf_format(s,d,x)/10)
 182 #define CONVERT_M_MG_VTF16E14_Z(s,d,x) (convert_from_vtf_format(s,d,x)/10)
 183
 184 /* from bar to mbar(= hPA) */
 185 #define CONVERT_PR_HPA_VTF16E14(s,d,x) ((1000.0f)*convert_from_vtf_format(s,d,x))
 186
 187 /*****************************************************************************/
 188
 189 #endif  // SENSOR_CONFIG_H