HidSensor_Compass3D.cpp

   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 #include <fcntl.h>
  17 #include <errno.h>
  18 #include <math.h>
  19 #include <poll.h>
  20 #include <unistd.h>
  21 #include <dirent.h>
  22 #include <sys/select.h>
  23 #include <cutils/log.h>
  24
  25 #include "common.h"
  26 #include "SensorConfig.h"
  27 #include "HidSensor_Compass3D.h"
  28
  29 #define CHANNEL_X 0
  30 #define CHANNEL_Y 1
  31 #define CHANNEL_Z 2
  32
  33 struct compass_3d_sample{
  34     unsigned int compass_x;
  35     unsigned int compass_y;
  36     unsigned int compass_z;
  37 } __packed;
  38
  39 const struct sensor_t CompassSensor::sSensorInfo_compass3D = {
  40     "HID_SENSOR Compass 3D", "Intel", 1, SENSORS_MAGNETIC_FIELD_HANDLE,
  41     SENSOR_TYPE_MAGNETIC_FIELD, RANGE_M, RESOLUTION_M, 0.1f, 0, 0, 0, {}
  42 };
  43 const int retry_cnt = 10;
  44
  45 CompassSensor::CompassSensor(): SensorIIODev("magn_3d", "in_magn_scale", "in_magn_offset", "in_magn_", retry_cnt){
  46     ALOGV(">>ComassSensor 3D: constructor!");
  47     mPendingEvent.version = sizeof(sensors_event_t);
  48     mPendingEvent.sensor = ID_M;
  49     mPendingEvent.type = SENSOR_TYPE_MAGNETIC_FIELD;
  50     memset(mPendingEvent.data, 0, sizeof(mPendingEvent.data));
  51
  52     // CDD 4.2 requires 10Hz.  20Hz is the maximum for HSB.
  53     sample_delay_min_ms = 50;
  54
  55     ALOGV("<<ComassSensor 3D: constructor!");
  56 }
  57
  58 int CompassSensor::processEvent(unsigned char *raw_data, size_t raw_data_len){
  59     struct compass_3d_sample *sample;
  60
  61     ALOGV(">>%s", __func__);
  62     if (IsDeviceInitialized() == false){
  63         ALOGE("Device was not initialized \n");
  64         return  - 1;
  65     } if (raw_data_len < sizeof(struct compass_3d_sample)){
  66         ALOGE("Insufficient length \n");
  67         return  - 1;
  68     }
  69     sample = (struct compass_3d_sample*)raw_data;
  70
  71     float sc = GetScaleValue();
  72     mPendingEvent.data[0] = mPendingEvent.magnetic.x = CONVERT_M_MG_VTF16E14_X
  73         (GetChannelBytesUsedSize(CHANNEL_X), sc, sample->compass_x);
  74     mPendingEvent.data[1] = mPendingEvent.magnetic.y = CONVERT_M_MG_VTF16E14_Y
  75         (GetChannelBytesUsedSize(CHANNEL_Y), sc, sample->compass_y);
  76     mPendingEvent.data[2] = mPendingEvent.magnetic.z = CONVERT_M_MG_VTF16E14_Z
  77         (GetChannelBytesUsedSize(CHANNEL_Z), sc, sample->compass_z);
  78
  79     ALOGV("COMPASS 3D Sample %fuT %fuT %fuT\n", mPendingEvent.magnetic.x,
  80         mPendingEvent.magnetic.y, mPendingEvent.magnetic.z);
  81     ALOGV("<<%s", __func__);
  82     return 0;
  83 }