android_hardware_SensorManager.cpp revision 270e87f71abc2edf446dbec20c725c823e8c7f37
19066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project/* 29066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * Copyright 2008, The Android Open Source Project 39066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * 49066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * Licensed under the Apache License, Version 2.0 (the "License"); 59066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * you may not use this file except in compliance with the License. 69066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * You may obtain a copy of the License at 79066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * 89066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * http://www.apache.org/licenses/LICENSE-2.0 99066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * 109066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * Unless required by applicable law or agreed to in writing, software 119066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * distributed under the License is distributed on an "AS IS" BASIS, 129066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 139066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * See the License for the specific language governing permissions and 149066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * limitations under the License. 159066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project */ 169066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 17270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood#define LOG_TAG "SensorManager" 18270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood 19270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood#define LOG_NDEBUG 0 20270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood#include "utils/Log.h" 219066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 229066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project#include <hardware/sensors.h> 23270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood#include <cutils/native_handle.h> 249066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 259066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project#include "jni.h" 269066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project#include "JNIHelp.h" 279066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 289066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 299066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectnamespace android { 309066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 319066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstruct SensorOffsets 329066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 339066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID name; 349066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID vendor; 359066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID version; 369066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID handle; 379066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID type; 389066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID range; 399066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID resolution; 409066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfieldID power; 419066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} gSensorOffsets; 429066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 439066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project/* 449066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project * The method below are not thread-safe and not intended to be 459066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project */ 469066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 479066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic sensors_module_t* sSensorModule = 0; 489066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic sensors_data_device_t* sSensorDevice = 0; 499066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 509066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 519066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectsensors_module_init(JNIEnv *env, jclass clazz) 529066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 539066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project int err = 0; 549066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensors_module_t const* module; 559066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project err = hw_get_module(SENSORS_HARDWARE_MODULE_ID, (const hw_module_t **)&module); 569066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (err == 0) 579066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sSensorModule = (sensors_module_t*)module; 589066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return err; 599066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 609066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 619066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 629066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectsensors_module_get_next_sensor(JNIEnv *env, jobject clazz, jobject sensor, jint next) 639066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 649066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (sSensorModule == NULL) 659066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return 0; 669066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 679066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project SensorOffsets& sensorOffsets = gSensorOffsets; 689066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project const struct sensor_t* list; 699066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project int count = sSensorModule->get_sensors_list(sSensorModule, &list); 709066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (next >= count) 719066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return -1; 729066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 739066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project list += next; 749066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 759066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jstring name = env->NewStringUTF(list->name); 769066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jstring vendor = env->NewStringUTF(list->vendor); 779066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetObjectField(sensor, sensorOffsets.name, name); 789066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetObjectField(sensor, sensorOffsets.vendor, vendor); 799066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetIntField(sensor, sensorOffsets.version, list->version); 809066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetIntField(sensor, sensorOffsets.handle, list->handle); 819066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetIntField(sensor, sensorOffsets.type, list->type); 829066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetFloatField(sensor, sensorOffsets.range, list->maxRange); 839066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetFloatField(sensor, sensorOffsets.resolution, list->resolution); 849066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetFloatField(sensor, sensorOffsets.power, list->power); 859066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 869066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project next++; 879066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return next<count ? next : 0; 889066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 899066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 909066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project//---------------------------------------------------------------------------- 919066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 929066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectsensors_data_init(JNIEnv *env, jclass clazz) 939066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 949066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (sSensorModule == NULL) 959066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return -1; 969066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project int err = sensors_data_open(&sSensorModule->common, &sSensorDevice); 979066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return err; 989066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 999066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1009066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 1019066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectsensors_data_uninit(JNIEnv *env, jclass clazz) 1029066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 1039066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project int err = 0; 1049066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (sSensorDevice) { 1059066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project err = sensors_data_close(sSensorDevice); 1069066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (err == 0) 1079066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sSensorDevice = 0; 1089066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project } 1099066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return err; 1109066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 1119066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1129066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 113270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwoodsensors_data_open(JNIEnv *env, jclass clazz, jobjectArray fdArray, jintArray intArray) 1149066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 1159066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jclass FileDescriptor = env->FindClass("java/io/FileDescriptor"); 116270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood jfieldID fieldOffset = env->GetFieldID(FileDescriptor, "descriptor", "I"); 117270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood int numFds = (fdArray ? env->GetArrayLength(fdArray) : 0); 118270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood int numInts = (intArray ? env->GetArrayLength(intArray) : 0); 119270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood native_handle_t* handle = native_handle_create(numFds, numInts); 120270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood int offset = 0; 121270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood 122270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood for (int i = 0; i < numFds; i++) { 123270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood jobject fdo = env->GetObjectArrayElement(fdArray, i); 124270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood if (fdo) { 125270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood handle->data[offset++] = env->GetIntField(fdo, fieldOffset); 126270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood } else { 127270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood handle->data[offset++] = -1; 128270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood } 129270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood } 130270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood if (numInts > 0) { 131270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood jint* ints = env->GetIntArrayElements(intArray, 0); 132270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood for (int i = 0; i < numInts; i++) { 133270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood handle->data[offset++] = ints[i]; 134270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood } 135270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood env->ReleaseIntArrayElements(intArray, ints, 0); 136270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood } 137270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood 138270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood // doesn't take ownership of the native handle 139270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood return sSensorDevice->data_open(sSensorDevice, handle); 1409066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 1419066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1429066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 1439066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectsensors_data_close(JNIEnv *env, jclass clazz) 1449066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 1459066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return sSensorDevice->data_close(sSensorDevice); 1469066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 1479066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1489066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic jint 1499066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectsensors_data_poll(JNIEnv *env, jclass clazz, 1509066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jfloatArray values, jintArray status, jlongArray timestamp) 1519066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 1529066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensors_data_t data; 1539066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project int res = sSensorDevice->poll(sSensorDevice, &data); 1549066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project if (res >= 0) { 1559066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jint accuracy = data.vector.status; 1569066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetFloatArrayRegion(values, 0, 3, data.vector.v); 1579066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetIntArrayRegion(status, 0, 1, &accuracy); 1589066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project env->SetLongArrayRegion(timestamp, 0, 1, &data.time); 1599066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project } 1609066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return res; 1619066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 1629066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1639066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic void 1649066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source ProjectnativeClassInit (JNIEnv *_env, jclass _this) 1659066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 1669066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project jclass sensorClass = _env->FindClass("android/hardware/Sensor"); 1679066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project SensorOffsets& sensorOffsets = gSensorOffsets; 1689066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.name = _env->GetFieldID(sensorClass, "mName", "Ljava/lang/String;"); 1699066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.vendor = _env->GetFieldID(sensorClass, "mVendor", "Ljava/lang/String;"); 1709066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.version = _env->GetFieldID(sensorClass, "mVersion", "I"); 1719066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.handle = _env->GetFieldID(sensorClass, "mHandle", "I"); 1729066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.type = _env->GetFieldID(sensorClass, "mType", "I"); 1739066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.range = _env->GetFieldID(sensorClass, "mMaxRange", "F"); 1749066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.resolution = _env->GetFieldID(sensorClass, "mResolution","F"); 1759066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project sensorOffsets.power = _env->GetFieldID(sensorClass, "mPower", "F"); 1769066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 1779066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1789066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectstatic JNINativeMethod gMethods[] = { 1799066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"nativeClassInit", "()V", (void*)nativeClassInit }, 1809066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"sensors_module_init","()I", (void*)sensors_module_init }, 1819066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"sensors_module_get_next_sensor","(Landroid/hardware/Sensor;I)I", 1829066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project (void*)sensors_module_get_next_sensor }, 1839066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"sensors_data_init", "()I", (void*)sensors_data_init }, 1849066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"sensors_data_uninit", "()I", (void*)sensors_data_uninit }, 185270e87f71abc2edf446dbec20c725c823e8c7f37Mike Lockwood {"sensors_data_open", "([Ljava/io/FileDescriptor;[I)I", (void*)sensors_data_open }, 1869066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"sensors_data_close", "()I", (void*)sensors_data_close }, 1879066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project {"sensors_data_poll", "([F[I[J)I", (void*)sensors_data_poll }, 1889066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project}; 1899066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1909066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project}; // namespace android 1919066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1929066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectusing namespace android; 1939066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project 1949066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Projectint register_android_hardware_SensorManager(JNIEnv *env) 1959066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project{ 1969066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project return jniRegisterNativeMethods(env, "android/hardware/SensorManager", 1979066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project gMethods, NELEM(gMethods)); 1989066cfe9886ac131c34d59ed0e2d287b0e3c0087The Android Open Source Project} 199