1c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong/* 2c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * Copyright (C) 2017 The Android Open Source Project 3c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * 4c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * Licensed under the Apache License, Version 2.0 (the "License"); 5c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * you may not use this file except in compliance with the License. 6c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * You may obtain a copy of the License at 7c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * 8c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * http://www.apache.org/licenses/LICENSE-2.0 9c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * 10c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * Unless required by applicable law or agreed to in writing, software 11c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * distributed under the License is distributed on an "AS IS" BASIS, 12c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * See the License for the specific language governing permissions and 14c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong * limitations under the License. 15c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong */ 16c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 17c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong// LOG_TAG defined via build flag. 18c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong#ifndef LOG_TAG 19c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong#define LOG_TAG "HidlSensorManager" 20c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong#endif 21c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong#include <android-base/logging.h> 22c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 23c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong#include "SensorManager.h" 2495c7a0636763c0861d46425709befe90a3919c04Yifan Hong 2571906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong#include <sched.h> 2671906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong 2771906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong#include <thread> 2871906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong 2995c7a0636763c0861d46425709befe90a3919c04Yifan Hong#include "EventQueue.h" 3095c7a0636763c0861d46425709befe90a3919c04Yifan Hong#include "DirectReportChannel.h" 31c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong#include "utils.h" 32c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 33c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongnamespace android { 34c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongnamespace frameworks { 35c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongnamespace sensorservice { 36c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongnamespace V1_0 { 37c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongnamespace implementation { 38c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 39c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongusing ::android::hardware::sensors::V1_0::SensorInfo; 408a420ed627c1db832ef33663e8abaedb214368f7Yifan Hongusing ::android::hardware::sensors::V1_0::SensorsEventFormatOffset; 41c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongusing ::android::hardware::hidl_vec; 42c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongusing ::android::hardware::Void; 43c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongusing ::android::sp; 44c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 4509034f076e7897732479c8aef6284938aafbfbfeYifan Hongstatic const char* POLL_THREAD_NAME = "hidl_ssvc_poll"; 4609034f076e7897732479c8aef6284938aafbfbfeYifan Hong 4709034f076e7897732479c8aef6284938aafbfbfeYifan HongSensorManager::SensorManager(JavaVM* vm) 4809034f076e7897732479c8aef6284938aafbfbfeYifan Hong : mJavaVm(vm) { 49c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} 50c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 5195c7a0636763c0861d46425709befe90a3919c04Yifan HongSensorManager::~SensorManager() { 5295c7a0636763c0861d46425709befe90a3919c04Yifan Hong // Stops pollAll inside the thread. 5395c7a0636763c0861d46425709befe90a3919c04Yifan Hong std::unique_lock<std::mutex> lock(mLooperMutex); 5495c7a0636763c0861d46425709befe90a3919c04Yifan Hong if (mLooper != nullptr) { 5595c7a0636763c0861d46425709befe90a3919c04Yifan Hong mLooper->wake(); 5695c7a0636763c0861d46425709befe90a3919c04Yifan Hong } 5795c7a0636763c0861d46425709befe90a3919c04Yifan Hong} 5895c7a0636763c0861d46425709befe90a3919c04Yifan Hong 59c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong// Methods from ::android::frameworks::sensorservice::V1_0::ISensorManager follow. 60c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan HongReturn<void> SensorManager::getSensorList(getSensorList_cb _hidl_cb) { 61c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong ::android::Sensor const* const* list; 62542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong ssize_t count = getInternalManager().getSensorList(&list); 63c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong if (count < 0 || !list) { 64c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong LOG(ERROR) << "::android::SensorManager::getSensorList encounters " << count; 65c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb({}, Result::UNKNOWN_ERROR); 66c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 67c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong } 68c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong hidl_vec<SensorInfo> ret; 69c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong ret.resize(static_cast<size_t>(count)); 70c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong for (ssize_t i = 0; i < count; ++i) { 71c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong ret[i] = convertSensor(*list[i]); 72c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong } 73c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb(ret, Result::OK); 74c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 75c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} 76c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 77c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan HongReturn<void> SensorManager::getDefaultSensor(SensorType type, getDefaultSensor_cb _hidl_cb) { 78542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong ::android::Sensor const* sensor = getInternalManager().getDefaultSensor(static_cast<int>(type)); 79c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong if (!sensor) { 80c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb({}, Result::NOT_EXIST); 81c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 82c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong } 83c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb(convertSensor(*sensor), Result::OK); 84c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 85c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} 86c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 87c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongtemplate<typename Callback> 88c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hongvoid createDirectChannel(::android::SensorManager& manager, size_t size, int type, 89c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong const native_handle_t* handle, const Callback& _hidl_cb) { 90c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 91c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong int channelId = manager.createDirectChannel( 92c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong size, type, handle); 93c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong if (channelId < 0) { 94c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb(nullptr, convertResult(channelId)); 95c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return; 96c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong } 97c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong if (channelId == 0) { 98c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb(nullptr, Result::UNKNOWN_ERROR); 99c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return; 100c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong } 101c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 102c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb(sp<IDirectReportChannel>(new DirectReportChannel(manager, channelId)), 103c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong Result::OK); 104c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} 105c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 106c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan HongReturn<void> SensorManager::createAshmemDirectChannel( 107c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong const hidl_memory& mem, uint64_t size, 108c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong createAshmemDirectChannel_cb _hidl_cb) { 1098a420ed627c1db832ef33663e8abaedb214368f7Yifan Hong if (size > mem.size() || size < (uint64_t)SensorsEventFormatOffset::TOTAL_LENGTH) { 110c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong _hidl_cb(nullptr, Result::BAD_VALUE); 111c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 112c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong } 113c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 114542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong createDirectChannel(getInternalManager(), size, SENSOR_DIRECT_MEM_TYPE_ASHMEM, 115c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong mem.handle(), _hidl_cb); 116c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 117c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 118c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} 119c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 120c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan HongReturn<void> SensorManager::createGrallocDirectChannel( 121c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong const hidl_handle& buffer, uint64_t size, 122c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong createGrallocDirectChannel_cb _hidl_cb) { 123c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 124542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong createDirectChannel(getInternalManager(), size, SENSOR_DIRECT_MEM_TYPE_GRALLOC, 125c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong buffer.getNativeHandle(), _hidl_cb); 126c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 127c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong return Void(); 128c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} 129c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong 13095c7a0636763c0861d46425709befe90a3919c04Yifan Hong/* One global looper for all event queues created from this SensorManager. */ 13195c7a0636763c0861d46425709befe90a3919c04Yifan Hongsp<::android::Looper> SensorManager::getLooper() { 13295c7a0636763c0861d46425709befe90a3919c04Yifan Hong std::unique_lock<std::mutex> lock(mLooperMutex); 13395c7a0636763c0861d46425709befe90a3919c04Yifan Hong if (mLooper == nullptr) { 13495c7a0636763c0861d46425709befe90a3919c04Yifan Hong std::condition_variable looperSet; 13595c7a0636763c0861d46425709befe90a3919c04Yifan Hong 13609034f076e7897732479c8aef6284938aafbfbfeYifan Hong std::thread{[&mutex = mLooperMutex, &looper = mLooper, &looperSet, javaVm = mJavaVm] { 13771906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong 13871906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong struct sched_param p = {0}; 13971906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong p.sched_priority = 10; 14071906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong if (sched_setscheduler(0 /* current thread*/, SCHED_FIFO, &p) != 0) { 14171906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong LOG(WARNING) << "Could not use SCHED_FIFO for looper thread: " 14271906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong << strerror(errno); 14371906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong } 14471906aac8532b80b43a04582eb3ad1e92acdaa7aYifan Hong 14595c7a0636763c0861d46425709befe90a3919c04Yifan Hong std::unique_lock<std::mutex> lock(mutex); 14680d87ee386be7065817d4d40f2151dec9e0c557cYifan Hong if (looper != nullptr) { 14780d87ee386be7065817d4d40f2151dec9e0c557cYifan Hong LOG(INFO) << "Another thread has already set the looper, exiting this one."; 14880d87ee386be7065817d4d40f2151dec9e0c557cYifan Hong return; 14980d87ee386be7065817d4d40f2151dec9e0c557cYifan Hong } 15095c7a0636763c0861d46425709befe90a3919c04Yifan Hong looper = Looper::prepare(ALOOPER_PREPARE_ALLOW_NON_CALLBACKS /* opts */); 15195c7a0636763c0861d46425709befe90a3919c04Yifan Hong lock.unlock(); 15295c7a0636763c0861d46425709befe90a3919c04Yifan Hong 15309034f076e7897732479c8aef6284938aafbfbfeYifan Hong // Attach the thread to JavaVM so that pollAll do not crash if the event 15409034f076e7897732479c8aef6284938aafbfbfeYifan Hong // is from Java. 15509034f076e7897732479c8aef6284938aafbfbfeYifan Hong JavaVMAttachArgs args{ 15609034f076e7897732479c8aef6284938aafbfbfeYifan Hong .version = JNI_VERSION_1_2, 15709034f076e7897732479c8aef6284938aafbfbfeYifan Hong .name = POLL_THREAD_NAME, 15809034f076e7897732479c8aef6284938aafbfbfeYifan Hong .group = NULL 15909034f076e7897732479c8aef6284938aafbfbfeYifan Hong }; 16009034f076e7897732479c8aef6284938aafbfbfeYifan Hong JNIEnv* env; 16109034f076e7897732479c8aef6284938aafbfbfeYifan Hong if (javaVm->AttachCurrentThread(&env, &args) != JNI_OK) { 16209034f076e7897732479c8aef6284938aafbfbfeYifan Hong LOG(FATAL) << "Cannot attach SensorManager looper thread to Java VM."; 16309034f076e7897732479c8aef6284938aafbfbfeYifan Hong } 16409034f076e7897732479c8aef6284938aafbfbfeYifan Hong 16595c7a0636763c0861d46425709befe90a3919c04Yifan Hong looperSet.notify_one(); 16695c7a0636763c0861d46425709befe90a3919c04Yifan Hong int pollResult = looper->pollAll(-1 /* timeout */); 16795c7a0636763c0861d46425709befe90a3919c04Yifan Hong if (pollResult != ALOOPER_POLL_WAKE) { 16895c7a0636763c0861d46425709befe90a3919c04Yifan Hong LOG(ERROR) << "Looper::pollAll returns unexpected " << pollResult; 16995c7a0636763c0861d46425709befe90a3919c04Yifan Hong } 17009034f076e7897732479c8aef6284938aafbfbfeYifan Hong 17109034f076e7897732479c8aef6284938aafbfbfeYifan Hong if (javaVm->DetachCurrentThread() != JNI_OK) { 17209034f076e7897732479c8aef6284938aafbfbfeYifan Hong LOG(ERROR) << "Cannot detach SensorManager looper thread from Java VM."; 17309034f076e7897732479c8aef6284938aafbfbfeYifan Hong } 17409034f076e7897732479c8aef6284938aafbfbfeYifan Hong 17595c7a0636763c0861d46425709befe90a3919c04Yifan Hong LOG(INFO) << "Looper thread is terminated."; 17695c7a0636763c0861d46425709befe90a3919c04Yifan Hong }}.detach(); 17795c7a0636763c0861d46425709befe90a3919c04Yifan Hong looperSet.wait(lock, [this]{ return this->mLooper != nullptr; }); 17895c7a0636763c0861d46425709befe90a3919c04Yifan Hong } 17995c7a0636763c0861d46425709befe90a3919c04Yifan Hong return mLooper; 18095c7a0636763c0861d46425709befe90a3919c04Yifan Hong} 18195c7a0636763c0861d46425709befe90a3919c04Yifan Hong 182542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong::android::SensorManager& SensorManager::getInternalManager() { 183542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong std::lock_guard<std::mutex> lock(mInternalManagerMutex); 184542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong if (mInternalManager == nullptr) { 185542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong mInternalManager = &::android::SensorManager::getInstanceForPackage( 186542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong String16(ISensorManager::descriptor)); 187542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong } 188542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong return *mInternalManager; 189542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong} 190542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong 1918358c6b5d4f30292f25ffbed16ddd23cec333a61Yifan HongReturn<void> SensorManager::createEventQueue( 19295c7a0636763c0861d46425709befe90a3919c04Yifan Hong const sp<IEventQueueCallback> &callback, createEventQueue_cb _hidl_cb) { 19395c7a0636763c0861d46425709befe90a3919c04Yifan Hong if (callback == nullptr) { 19495c7a0636763c0861d46425709befe90a3919c04Yifan Hong _hidl_cb(nullptr, Result::BAD_VALUE); 19595c7a0636763c0861d46425709befe90a3919c04Yifan Hong return Void(); 19695c7a0636763c0861d46425709befe90a3919c04Yifan Hong } 19795c7a0636763c0861d46425709befe90a3919c04Yifan Hong 19895c7a0636763c0861d46425709befe90a3919c04Yifan Hong sp<::android::Looper> looper = getLooper(); 199542eace6bf9aa9cc4a2fff4886ff023b973232e2Yifan Hong sp<::android::SensorEventQueue> internalQueue = getInternalManager().createEventQueue(); 20095c7a0636763c0861d46425709befe90a3919c04Yifan Hong if (internalQueue == nullptr) { 20195c7a0636763c0861d46425709befe90a3919c04Yifan Hong LOG(WARNING) << "::android::SensorManager::createEventQueue returns nullptr."; 20295c7a0636763c0861d46425709befe90a3919c04Yifan Hong _hidl_cb(nullptr, Result::UNKNOWN_ERROR); 20395c7a0636763c0861d46425709befe90a3919c04Yifan Hong return Void(); 20495c7a0636763c0861d46425709befe90a3919c04Yifan Hong } 20595c7a0636763c0861d46425709befe90a3919c04Yifan Hong 20695c7a0636763c0861d46425709befe90a3919c04Yifan Hong sp<IEventQueue> queue = new EventQueue(callback, looper, internalQueue); 20795c7a0636763c0861d46425709befe90a3919c04Yifan Hong _hidl_cb(queue, Result::OK); 20895c7a0636763c0861d46425709befe90a3919c04Yifan Hong 2098358c6b5d4f30292f25ffbed16ddd23cec333a61Yifan Hong return Void(); 2108358c6b5d4f30292f25ffbed16ddd23cec333a61Yifan Hong} 2118358c6b5d4f30292f25ffbed16ddd23cec333a61Yifan Hong 212c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} // namespace implementation 213c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} // namespace V1_0 214c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} // namespace sensorservice 215c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} // namespace frameworks 216c34f57fed0ad09c6d7361a39580da20b466d46d1Yifan Hong} // namespace android 217