动态 Android传感器HAL_C语言_代码_相关文件_下载

/* * Copyright (C) 2012 Sony Mobile Communications AB. * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #define LOG_TAG "DASH - lsm303dlh" #include <stdlib.h> #include <string.h> #include "sensors_log.h" #include <linux/input.h> #include <sys/types.h> #include <sys/stat.h> #include <fcntl.h> #include <linux/input.h> #include <pthread.h> #include <errno.h> #include "sensors_list.h" #include "sensors_fifo.h" #include "sensors_select.h" #include "sensor_util.h" #include "sensors_id.h" #include "sensors_config.h" #include "lsm303dlh.h" #include "sensors_compass_API.h" #define ARRAY_SIZE(a) (sizeof(a) / sizeof(a[0])) #define DELAY_LOWEST_MS 1000 #define DEBUG_VERBOSE 0 #define PHYS_PATH_BASE "/sys/bus/i2c/devices" #define PHYS_PATH_LEN (sizeof(PHYS_PATH_BASE) + sizeof("/0-0000/")) #define ATTR_NAME_LEN 32 #define DEV_PATH_LEN sizeof("/dev/input/event/4294967295") enum android_rates { RATE_GAME = 20, RATE_UI = 60, RATE_NORMAL = 200, }; enum dev_mode { MODE_FASTEST, MODE_GAME, MODE_UI, MODE_NORMAL, MODES_NUM }; enum user_type { USER_INTERNAL = 0x01, USER_EXTERNAL = 0x02, }; enum { AXIS_X, AXIS_Y, AXIS_Z, NUM_AXIS }; struct config_record { int max; int min; int size; int *store; }; struct sensor_desc { struct sensor_t sensor; struct sensor_api_t api; struct sensors_select_t select_worker; int status; int data[3]; char *map_prefix; int map[3]; int sign[3]; enum user_type users; int64_t internal_delay; int64_t external_delay; int applied_delay_ms; float scale; void * (*read)(void *); int (*find_input)(struct sensor_desc *d); char *input_name; char dev_path[DEV_PATH_LEN]; char phys_path[PHYS_PATH_LEN + ATTR_NAME_LEN]; char *dev_name; char *dev_attr_rate_ms; char *dev_attr_range_mg; char *dev_attr_mode; char *dev_modes[MODES_NUM]; }; static struct sensor_desc *required_sensors[2]; static struct sensor_desc *sensor_acc; static struct sensor_desc *sensor_mag; static struct sensor_desc *sensor_compass; static int compass_api_activated; static int num_formations; static pthread_mutex_t lock; static int config_read_axis(char *prefix, char *key, struct config_record *cr) { int rc = -1; int tmp[NUM_AXIS]; if (!sensors_config_get_key(prefix, key, TYPE_ARRAY_INT, tmp, cr->size)) { int i; for (i = 0; i < cr->size; i++) { if (tmp[i] < cr->min || tmp[i] > cr->max) break; } if (i == cr->size) { memcpy(cr->store, tmp, sizeof(tmp)); rc = 0; } else { ALOGE("%s: bad config (%s_%s) [%2d %2d %2d]", __func__, prefix, key, tmp[AXIS_X], tmp[AXIS_Y], tmp[AXIS_Z]); } } else { ALOGE("%s: failed to read %s_%s", __func__, prefix, key); } return rc; } static void config_read_sensor_map(struct sensor_desc *d) { struct config_record rec; if (!sensors_have_config_file()) { ALOGI("%s: No config file found. Using default config.", __func__); return; } rec.size = NUM_AXIS; rec.min = AXIS_X; rec.max = AXIS_Z; rec.store = d->map; config_read_axis(d->map_prefix, "axis_map", &rec); rec.min = -1; rec.max = 1; rec.store = d->sign; config_read_axis(d->map_prefix, "axis_sign", &rec); ALOGD("%s: %s: axis map [%2d %2d %2d]", __func__, d->sensor.name, d->map[AXIS_X], d->map[AXIS_Y], d->map[AXIS_Z]); ALOGD("%s: %s: axis sign [%2d %2d %2d]", __func__, d->sensor.name, d->sign[AXIS_X], d->sign[AXIS_Y], d->sign[AXIS_Z]); } static int store_str_attr(struct sensor_desc *d, const char *attr, const char *val) { int rc; int fd; unsigned l = strlen(d->phys_path); if (!*d->phys_path) return 0; rc = snprintf(d->phys_path + l, sizeof(d->phys_path) - l, "%s", attr); if ((unsigned)rc >= sizeof(d->phys_path) - l) { ALOGE("%s: Attr path truncated to '%s'\n", __func__, d->phys_path); rc = -1; goto exit; } fd = open(d->phys_path, O_WRONLY); ALOGD("%s: '%s' = %s", __func__, d->phys_path, val); if (fd < 0) { ALOGE("%s: unable to open %s, err %d\n", __func__, d->phys_path, errno); rc = -1; goto exit; } rc = write(fd, val, strlen(val)); if (rc < 0) ALOGE("%s: unable to write %s (fd %d), err %d\n", __func__, d->phys_path, fd, errno); close(fd); exit: d->phys_path[l] = 0; return rc > 0 ? 0 : rc; } static int store_int_attr(struct sensor_desc *d, const char *attr, int value) { char b[16]; (void)snprintf(b, sizeof(b), "%d\n", value); return store_str_attr(d, attr, b); } static void scale_data(struct sensors_event_t *s, struct sensor_desc *d) { unsigned i; float scale = d->scale; for (i = 0; i < ARRAY_SIZE(s->data); i++) s->data[i] = d->data[i] * scale; } static int compass_status(int accuracy) { if (accuracy <= 110) return SENSOR_STATUS_ACCURACY_HIGH; else if (accuracy < 130) return SENSOR_STATUS_ACCURACY_MEDIUM; else if (accuracy < 150) return SENSOR_STATUS_ACCURACY_LOW; else return SENSOR_STATUS_UNRELIABLE; } static int compass_run(sensors_event_t *s) { int rc; int accuracy = -1; rc = compass_API_SaveAcc(sensor_acc->data[0], sensor_acc->data[1], sensor_acc->data[2]); if (rc) { ALOGE("%s: compass_API_SaveAcc, error %d\n", __func__, rc); goto exit; } rc = compass_API_SaveMag(sensor_mag->data[0], sensor_mag->data[1], sensor_mag->data[2]); if (rc) { ALOGE("%s: compass_API_SaveMag, error %d\n", __func__, rc); goto exit; } rc = compass_API_Run(); if (!rc) { rc = compass_API_OrientationValues(s); if (!rc) accuracy = compass_API_GetCalibrationGodness(); else ALOGE("%s GetCalibrationGodness, error %d\n", __func__, rc); } else { ALOGE("%s: compass_API_Run, error %d\n", __func__, rc); } rc = compass_API_GetNewFullScale(); if (rc) { int range = to_lsm303dlh_mag_range(rc); ALOGD("%s: new range %d requested", __func__, rc); if (sensor_mag->dev_attr_range_mg) store_int_attr(sensor_mag, sensor_mag->dev_attr_range_mg, range); else ALOGI("%s: magnetic range not supported", __func__); } exit: ALOGD("%s: accuracy %d\n", __func__, accuracy); return accuracy; } static void compass_formation(int value) { ALOGD("%s: formation %d", __func__, value); compass_API_ChangeFormFactor(!!value); } static int find_input_dev(struct sensor_desc *d) { return input_dev_path_by_name(d->input_name, d->dev_path, sizeof(d->dev_path)); } static int compass_find_input_dev(struct sensor_desc *d) { return input_dev_path_by_keycode(EV_SW, SW_LID, d->dev_path, sizeof(d->dev_path)); } static int open_input_device(struct sensor_desc *d) { int rc; if (!*d->dev_path) { ALOGD("%s: No input device for %s", __func__, d->sensor.name); return -1; } rc = open(d->dev_path, O_RDONLY | O_NONBLOCK); if (rc < 0) { ALOGE("%s: Failed to open '%s' but access (R_OK) got", __func__, d->dev_path); } return rc; } static int sensor_init(struct sensor_api_t *s_api) { struct sensor_desc *d = container_of(s_api, struct sensor_desc, api); int rc; rc = dev_phys_path_by_attr("name", d->dev_name, PHYS_PATH_BASE, d->phys_path, sizeof(d->phys_path)); if (rc) { ALOGE("%s: no phys dev path for dev name '%s'", __func__, d->dev_name); *d->phys_path = 0; } config_read_sensor_map(d); sensors_select_init(&d->select_worker, d->read, d, -1); return 0; } static int set_current_formation(int fd, int formation) { if (fd >= 0) { /* * TODO: perform formation check (ioctl) */ formation = 0; } compass_API_ChangeFormFactor(formation); return formation; } static int compass_api_init(struct sensor_desc *d, int fd) { int rc; int f; rc = compass