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     numSensorDrivers,
  34     numFds,
  35 };
  36
  37
  38
  39 /*****************************************************************************/
  40
  41 /* Board specific sensor configs. */
  42 #define GRAVITY 9.80665f
  43 #define EVENT_TYPE_ACCEL_X          REL_X
  44 #define EVENT_TYPE_ACCEL_Y          REL_Y
  45 #define EVENT_TYPE_ACCEL_Z          REL_Z
  46
  47 #define EVENT_TYPE_COMP_X           REL_X
  48 #define EVENT_TYPE_COMP_Y           REL_Y
  49 #define EVENT_TYPE_COMP_Z           REL_Z
  50
  51 #define EVENT_TYPE_YAW              REL_RX
  52 #define EVENT_TYPE_PITCH            REL_RY
  53 #define EVENT_TYPE_ROLL             REL_RZ
  54 #define EVENT_TYPE_ORIENT_STATUS    REL_WHEEL
  55
  56 #define EVENT_TYPE_MAGV_X           REL_DIAL
  57 #define EVENT_TYPE_MAGV_Y           REL_HWHEEL
  58 #define EVENT_TYPE_MAGV_Z           REL_MISC
  59
  60 #define EVENT_TYPE_PROXIMITY        ABS_DISTANCE
  61 #define EVENT_TYPE_LIGHT            ABS_MISC
  62
  63 #define EVENT_TYPE_GYRO_X           REL_X
  64 #define EVENT_TYPE_GYRO_Y           REL_Y
  65 #define EVENT_TYPE_GYRO_Z           REL_Z
  66
  67 #define EVENT_TYPE_PRESSURE         REL_X
  68 #define EVENT_TYPE_TEMPERATURE      REL_Y
  69
  70 // 720 LSG = 1G
  71 #define LSG                         (1024.0f)
  72 #define NUMOFACCDATA                (8.0f)
  73
  74 // conversion of acceleration data to SI units (m/s^2)
  75
  76 #define RANGE_A                     (2*GRAVITY_EARTH)
  77 #define RESOLUTION_A                (RANGE_A/(256*NUMOFACCDATA))
  78 #define CONVERT_A                   (GRAVITY_EARTH / LSG / NUMOFACCDATA)
  79 #define CONVERT_A_X(x)              ((float(x)/1000) * (GRAVITY * -1.0))
  80 #define CONVERT_A_Y(x)              ((float(x)/1000) * (GRAVITY * 1.0))
  81 #define CONVERT_A_Z(x)              ((float(x)/1000) * (GRAVITY * 1.0))
  82 // conversion of magnetic data to uT units
  83 #define RANGE_M                     (2048.0f)
  84 #define RESOLUTION_M                (0.01)
  85 #define CONVERT_M                   (1.0f/6.6f)
  86 #define CONVERT_M_X                 (-CONVERT_M)
  87 #define CONVERT_M_Y                 (-CONVERT_M)
  88 #define CONVERT_M_Z                 (CONVERT_M)
  89
  90 /* conversion of orientation data to degree units */
  91 #define CONVERT_O                   (1.0f/64.0f)
  92 #define CONVERT_O_A                 (CONVERT_O)
  93 #define CONVERT_O_P                 (CONVERT_O)
  94 #define CONVERT_O_R                 (-CONVERT_O)
  95
  96 // conversion of gyro data to SI units (radian/sec)
  97 #define RANGE_GYRO                  (2000.0f*(float)M_PI/180.0f)
  98 #define CONVERT_GYRO                ((2000.0f / 32767.0f) * ((float)M_PI / 180.0f))
  99 #define CONVERT_GYRO_X              (-CONVERT_GYRO)
 100 #define CONVERT_GYRO_Y              (-CONVERT_GYRO)
 101 #define CONVERT_GYRO_Z              (CONVERT_GYRO)
 102
 103 // conversion of pressure and temperature data
 104 #define CONVERT_PRESSURE            (1.0f/100.0f)
 105 #define CONVERT_TEMPERATURE         (1.0f/100.0f)
 106
 107 #define RESOLUTION_GYRO             (RANGE_GYRO/(2000*NUMOFACCDATA))
 108 #define SENSOR_STATE_MASK           (0x7FFF)
 109
 110 // Proximity Threshold
 111 #define PROXIMITY_THRESHOLD_GP2A  5.0f
 112
 113 //Used in timespec_to_ns calculations
 114 #define NSEC_PER_SEC    1000000000L
 115
 116 #define BIT(x) (1 << (x))
 117
 118 inline unsigned int set_bit_range(int start, int end)
 119 {
 120     int i;
 121     unsigned int value = 0;
 122
 123     for (i = start; i < end; ++i)
 124         value |= BIT(i);
 125     return value;
 126 }
 127
 128 inline float convert_from_vtf_format(int size, int exponent, unsigned int value)
 129 {
 130     int divider=1;
 131     int i;
 132     float sample;
 133     int mul = 1.0;
 134
 135     value = value & set_bit_range(0, size*8);
 136     if (value & BIT(size*8-1)) {
 137         value =  ((1LL << (size*8)) - value);
 138         mul = -1.0;
 139     }
 140     sample = value * 1.0;
 141     if (exponent < 0) {
 142         exponent = abs(exponent);
 143         for (i = 0; i < exponent; ++i) {
 144             divider = divider*10;
 145         }
 146         return mul * sample/divider;
 147     } else {
 148         return mul * sample * pow(10.0, exponent);
 149     }
 150 }
 151
 152 // Platform sensor orientatation
 153 #define DEF_ORIENT_ACCEL_X                   -1
 154 #define DEF_ORIENT_ACCEL_Y                   -1
 155 #define DEF_ORIENT_ACCEL_Z                   -1
 156
 157 #define DEF_ORIENT_GYRO_X                   1
 158 #define DEF_ORIENT_GYRO_Y                   1
 159 #define DEF_ORIENT_GYRO_Z                   1
 160
 161 // G to m/s2
 162 #define CONVERT_FROM_VTF16(s,d,x)      (convert_from_vtf_format(s,d,x))
 163 #define CONVERT_A_G_VTF16E14_X(s,d,x)  (DEF_ORIENT_ACCEL_X *\
 164                                         convert_from_vtf_format(s,d,x)*GRAVITY)
 165 #define CONVERT_A_G_VTF16E14_Y(s,d,x)  (DEF_ORIENT_ACCEL_Y *\
 166                                         convert_from_vtf_format(s,d,x)*GRAVITY)
 167 #define CONVERT_A_G_VTF16E14_Z(s,d,x)  (DEF_ORIENT_ACCEL_Z *\
 168                                         convert_from_vtf_format(s,d,x)*GRAVITY)
 169
 170 // Degree/sec to radian/sec
 171 #define CONVERT_G_D_VTF16E14_X(s,d,x)  (DEF_ORIENT_GYRO_X *\
 172                                         convert_from_vtf_format(s,d,x) * ((float)M_PI/180.0f))
 173 #define CONVERT_G_D_VTF16E14_Y(s,d,x)  (DEF_ORIENT_GYRO_Y *\
 174                                         convert_from_vtf_format(s,d,x) * ((float)M_PI/180.0f))
 175 #define CONVERT_G_D_VTF16E14_Z(s,d,x)  (DEF_ORIENT_GYRO_Z *\
 176                                         convert_from_vtf_format(s,d,x) * ((float)M_PI/180.0f))
 177
 178 // Milli gauss to micro tesla
 179 #define CONVERT_M_MG_VTF16E14_X(s,d,x) (convert_from_vtf_format(s,d,x)/10)
 180 #define CONVERT_M_MG_VTF16E14_Y(s,d,x) (convert_from_vtf_format(s,d,x)/10)
 181 #define CONVERT_M_MG_VTF16E14_Z(s,d,x) (convert_from_vtf_format(s,d,x)/10)
 182
 183 /*****************************************************************************/
 184
 185 #endif  // SENSOR_CONFIG_H