[Camera专题]Qcom- 获取sensor数据

前言

在集成eis算法时，我们需要获取sensor的数据：如gyro，ois，accelerate等传感器的数据。
本文以gyro数据为例子。

1.初始化

1.1 获取服务

void GyroReader::init()
{
    LOGE("zcf_g:E");
    //步骤1：获取sensor服务
    this->smgr = ISensorManager::getService();
    if(smgr == nullptr) {
        LOGE("zcf_g:Fail to get sensor manager!");
        this->deinit();
    }
    //打印所有支持的sensor信息
    this->printSensors();

    Result latestResult;
    //步骤2：获取相应的sensor：这里以gyro为例子
    this->smgr->getDefaultSensor(SensorType::GYROSCOPE,
        [&](const SensorInfo& sensorinfo,const Result & result){
        this->info = sensorinfo;
        latestResult = result;
    });

    //如果想获取accelerate的：
/*
    this->smgr->getDefaultSensor(:SensorType::ACCELEROMETER,
        [&](const SensorInfo& sensorinfo,const Result & result){
        this->info = sensorinfo;
        latestResult = result;
    });
*/
    if(latestResult != Result::OK) {
        LOGE("zcf_g:getDefaultSensor gyro failed !");
        return;
    }
    LOGE("[%s]: name: %s, version: 0x%x",
      this->iinfo.typeAsString.c_str(), this->iinfo.name.c_str(), this->iinfo.version);
    LOGE("[%s]: minDelay: %d, maxDelay: %d",
      this->iinfo.typeAsString.c_str(), this->iinfo.minDelay, this->iinfo.maxDelay);
    LOGE("[%s]: handle = 0x%x, flags: 0x%x",
      this->iinfo.typeAsString.c_str(), this->iinfo.sensorHandle, this->iinfo.flags);

    LOGE("sample_rate = ",USEC_PER_SEC/info.minDelay):

    /*callback object(sensorCb) is freed by IEventqueue implemter, don't delete in deinit*/
    this->sensorCb = new SensorEventCallback();
    this->sensorCb->gyroReader_ptr = (void*)this;

    //步骤3：创建EventQueue
    this->smgr->createEventQueue(this->sensorCb,
        [&](const auto& queue,const auto& result)->void{
            this->eventQueue = queue;
            latestResult = result;
        });

    if(latestResult != Result::OK){
        LOGE("zcf_g:createEventQueue failed!!!");
    }
    //步骤4：enable gyro sensor
    this->eventQueue->enableSensor(info.sensorHandle,info.minDelay,0);
    LOGE("zcf_g:X");
}

1.2 创建sensorCallback

class SensorEventCallback : public IEventQueueCallback
{
public:
    SensorEventCallback()
    {
        LOGE("zcf_g:SensorEventCallback 构造函数");
    }

    ~SensorEventCallback()
    {
        LOGE("zcf_g:SensorEventCallback 析构函数");
    }

    Return<void> onEvent(const Event &e)
    {
        GyroReader * gr_obj = (GyroReader *)this->gyroReader_ptr;
        if(gr_obj != nullptr) {
            gr_obj->processEvent(e);//这里调用processEvent去处理事件
        }else {
            LOGE("zcf_g:gr_obj is null!")
        }
        return Void();
    }
public:
    void* gyroReader_ptr;//GyroReader类的指针
};

1.3 processEvent

void GyroReader::processEvent(const Event& e)
{
    if(!e.sensorHandle){
        LOGE("zcf_g:invalid sensor handle, ignore");
        return;
    }
    switch(e.sensorType)
    {
    //这里只打印数据，有必要的话，可以创建数组存储起来，后续使用
        case SensorType::GYROSCOPE:
            LOGE("zcf_gd:Event type - gyro!");
            LOGE("zcf_gd:Gyro: evt_ts:%lld us x:%f y:%f z:%f",
                e.timestamp,
                e.u.uncal.x,
                e.u.uncal.y,
                e.u.uncal.z);
            break;
        case SensorType::ACCELEROMETER:
            LOGE("zcf_gd:Event type - Accel!");
            LOGE("zcf_gd:Accel: evt_timestamp:%lld us x:%f y:%f z:%f",
                e.timestamp,
                e.u.uncal.x,
                e.u.uncal.y,
                e.u.uncal.z);
            break;
        default:
            LOGE("zcf_gd:Event for sensor(type: %d) not interested", e.sensorType);
        break;
    }

}

1.4 编译

hardware/qcom/camera/QCamera2/Android.mk

--- a/hardware/qcom/camera/QCamera2/Android.mk
+++ b/hardware/qcom/camera/QCamera2/Android.mk
@@ -40,7 +40,7 @@ LOCAL_SRC_FILES += \
         HAL3/QCamera3CropRegionMapper.cpp \
         HAL3/QCamera3StreamMem.cpp
 
-LOCAL_CFLAGS := -Wall -Wextra -Werror
+LOCAL_CFLAGS := -Wall -Wextra
 LOCAL_CFLAGS += -DFDLEAK_FLAG
 LOCAL_CFLAGS += -DMEMLEAK_FLAG
 #HAL 1.0 source
@@ -68,7 +68,8 @@ LOCAL_SRC_FILES += \
         util/QCameraExtZoomTranslator.cpp \
         util/QCameraPprocManager.cpp \
         util/QCameraBokeh.cpp \
-        util/QCameraClearSight.cpp
+        util/QCameraClearSight.cpp \
+               HAL/GyroReader.cpp
 endif

 # System header file path prefix
 LOCAL_SHARED_LIBRARIES += libmmcamera_interface libmmjpeg_interface libui libcamera_metadata
 LOCAL_SHARED_LIBRARIES += libqdMetaData libqservice libbinder
 LOCAL_SHARED_LIBRARIES += libcutils libdl libhal_dbg
+LOCAL_SHARED_LIBRARIES += libhidlbase libhidltransport android.frameworks.sensorservice@1.0
 ifeq ($(IS_QC_BOKEH_SUPPORTED),true)
 LOCAL_SHARED_LIBRARIES += libdualcameraddm
 LOCAL_CFLAGS += -DENABLE_QC_BOKEH

1.5 调用

hardware/qcom/camera/QCamera2/HAL/QCamera2HWI.h

--- a/hardware/qcom/camera/QCamera2/HAL/QCamera2HWI.h
+++ b/hardware/qcom/camera/QCamera2/HAL/QCamera2HWI.h
@@ -62,6 +62,8 @@ extern "C" {
 
 #include "QCameraTrace.h"
 
+#include "GyroReader.h"
+
 namespace qcamera {
 
 #ifndef TRUE
@@ -863,6 +865,7 @@ private:
     bool bDepthAFCallbacks;
     bool m_bOptimizeCacheOps;
     bool m_bNeedHalPP;
+       ISensorAPI::GyroReader gy;
 };
 
 }; // namespace qcamera

2 完整源码

hardware/qcom/camera/QCamera2/HAL/GyroReader.h

#ifndef GYRO_READ_H_
#define GYRO_READ_H_

extern "C" {
#include "mm_camera_dbg.h"
}


#include <android/frameworks/sensorservice/1.0/ISensorManager.h>
#include <android/frameworks/sensorservice/1.0/types.h>
//#include <hardware/sensors.h>  // for sensor type strings

using ::android::frameworks::sensorservice::V1_0::ISensorManager;
using ::android::frameworks::sensorservice::V1_0::Result;
using ::android::frameworks::sensorservice::V1_0::IEventQueue;
using ::android::frameworks::sensorservice::V1_0::IEventQueueCallback;

using ::android::hardware::sensors::V1_0::Event;
using ::android::hardware::sensors::V1_0::SensorType;
using ::android::hardware::sensors::V1_0::SensorInfo;

using ::android::sp;
using ::android::hardware::Void;
using ::android::hardware::Return;

class SensorEventCallback;
namespace ISensorAPI {

class GyroReader
{
public:
    GyroReader();
    ~GyroReader();
    void init();
    void deinit();
    void processEvent(const Event& e);
    void printSensors();
    static constexpr int32_t USEC_PER_SEC = 1e6;
    static constexpr int32_t NSEC_PER_SEC = 1e9;

private:
    SensorInfo info;
    sp<ISensorManager> smgr;
    /*callback object(sensorCb) is freed by IEventqueue implemter, don't delete in deinit*/
    //因此可以不用定义成智能指针：sp<SensorEventCallback > sensorCb;
    SensorEventCallback * sensorCb; 
    sp<IEventQueue> eventQueue;
};
}
#endif /* GYRO_READ_H_ */

hardware/qcom/camera/QCamera2/HAL/GyroReader.cpp

#include "GyroReader.h"

using namespace ISensorAPI;

class SensorEventCallback : public IEventQueueCallback
{
public:
    SensorEventCallback()
    {
        LOGE("zcf_g:SensorEventCallback 构造函数");
    }
    
    ~SensorEventCallback()
    {
        LOGE("zcf_g:SensorEventCallback 析构函数");
    }
        
    Return<void> onEvent(const Event &e)
    {
        GyroReader * gr_obj = (GyroReader *)this->gyroReader_ptr;
        if(gr_obj != nullptr) {
            gr_obj->processEvent(e);
        }else {
            LOGE("zcf_g:gr_obj is null!")
        }
        return Void();
    }
public:
    void* gyroReader_ptr;
};

GyroReader::GyroReader()
{
    this->init();
}

GyroReader::~GyroReader()
{
    this->deinit();
}

void GyroReader::init()
{
    LOGE("zcf_g:E");
    //步骤1：获取sensor服务
    this->smgr = ISensorManager::getService();
    if(smgr == nullptr) {
        LOGE("zcf_g:Fail to get sensor manager!");
        this->deinit();
    }
    //打印所有支持的sensor信息
    this->printSensors();

    Result latestResult;
    //步骤2：获取相应的sensor：这里以gyro为例子
    this->smgr->getDefaultSensor(SensorType::GYROSCOPE,
        [&](const SensorInfo& sensorinfo,const Result & result){
        this->info = sensorinfo;
        latestResult = result;
    });

    //如果想获取accelerate的：
/*
    this->smgr->getDefaultSensor(:SensorType::ACCELEROMETER,
        [&](const SensorInfo& sensorinfo,const Result & result){
        this->info = sensorinfo;
        latestResult = result;
    });
*/
    if(latestResult != Result::OK) {
        LOGE("zcf_g:getDefaultSensor gyro failed !");
        return;
    }
    LOGE("[%s]: name: %s, version: 0x%x",
      this->iinfo.typeAsString.c_str(), this->iinfo.name.c_str(), this->iinfo.version);
    LOGE("[%s]: minDelay: %d, maxDelay: %d",
      this->iinfo.typeAsString.c_str(), this->iinfo.minDelay, this->iinfo.maxDelay);
    LOGE("[%s]: handle = 0x%x, flags: 0x%x",
      this->iinfo.typeAsString.c_str(), this->iinfo.sensorHandle, this->iinfo.flags);

    LOGE("sample_rate = ",USEC_PER_SEC/info.minDelay):
    /*callback object(sensorCb) is freed by IEventqueue implemter, don't delete in deinit*/
    this->sensorCb = new SensorEventCallback();
    this->sensorCb->gyroReader_ptr = (void*)this;

    //步骤3：创建EventQueue
    this->smgr->createEventQueue(this->sensorCb,
        [&](const auto& queue,const auto& result)->void{
            this->eventQueue = queue;
            latestResult = result;
        });

    if(latestResult != Result::OK){
        LOGE("zcf_g:createEventQueue failed!!!");
    }
    //步骤4：enable gyro sensor
    this->eventQueue->enableSensor(info.sensorHandle,info.minDelay,0);
    LOGE("zcf_g:X");
}

void GyroReader::deinit()
{
    this->eventQueue->disableSensor(info.sensorHandle);
}

void GyroReader::processEvent(const Event& e)
{
    if(!e.sensorHandle){
        LOGE("zcf_g:invalid sensor handle, ignore");
        return;
    }
    switch(e.sensorType)
    {
        case SensorType::GYROSCOPE:
            LOGE("zcf_gd:Event type - gyro!");
            LOGE("zcf_gd:Gyro: evt_ts:%lld us x:%f y:%f z:%f",
                e.timestamp,
                e.u.uncal.x,
                e.u.uncal.y,
                e.u.uncal.z);
            break;
        case SensorType::ACCELEROMETER:
            LOGE("zcf_gd:Event type - Accel!");
            LOGE("zcf_gd:Accel: evt_timestamp:%lld us x:%f y:%f z:%f",
                e.timestamp,
                e.u.uncal.x,
                e.u.uncal.y,
                e.u.uncal.z);
            break;
        default:
            LOGE("zcf_gd:Event for sensor(type: %d) not interested", e.sensorType);
        break;
    }

}

void GyroReader::printSensors()
{
    
    if(this->smgr.get() != nullptr){
        this->smgr.get()->getSensorList([&](const auto &list,auto result){
            if(result == Result::OK){
                for(unsigned int i =0;i<list.size();i++){
                    LOGE("zcf_g:Sensor:%s",list[i].name.c_str());
                }
            }else{
                LOGE("zcf_g:failed to get sensor list!");
            }
        });
    }
}
最后编辑于 ：
©著作权归作者所有,转载或内容合作请联系作者
  • 人面猴
    序言：七十年代末，一起剥皮案震惊了整个滨河市，随后出现的几起案子，更是在滨河造成了极大的恐慌，老刑警刘岩，带你破解...
    沈念sama阅读 213,558评论 6赞 492
  • 死咒
    序言：滨河连续发生了三起死亡事件，死亡现场离奇诡异，居然都是意外死亡，警方通过查阅死者的电脑和手机，发现死者居然都...
    沈念sama阅读 91,002评论 3赞 387
  • 救了他两次的神仙让他今天三更去死
    文/潘晓璐 我一进店门，熙熙楼的掌柜王于贵愁眉苦脸地迎上来，“玉大人，你说我怎么就摊上这事。” “怎么了？”我有些...
    开封第一讲书人阅读 159,036评论 0赞 349
  • 道士缉凶录：失踪的卖姜人
    文/不坏的土叔 我叫张陵，是天一观的道长。 经常有香客问我，道长，这世上最难降的妖魔是什么？ 我笑而不...
    开封第一讲书人阅读 57,024评论 1赞 285
  • 港岛之恋（遗憾婚礼）
    正文 为了忘掉前任，我火速办了婚礼，结果婚礼上，老公的妹妹穿的比我还像新娘。我一直安慰自己，他们只是感情好，可当我...
    茶点故事阅读 66,144评论 6赞 385
  • 恶毒庶女顶嫁案：这布局不是一般人想出来的
    文/花漫 我一把揭开白布。 她就那样静静地躺着，像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上，一...
    开封第一讲书人阅读 50,255评论 1赞 292
  • 城市分裂传说
    那天，我揣着相机与录音，去河边找鬼。 笑死，一个胖子当着我的面吹牛，可吹牛的内容都是我干的。 我是一名探鬼主播，决...
    沈念sama阅读 39,295评论 3赞 412
  • 双鸳鸯连环套：你想象不到人心有多黑
    文/苍兰香墨 我猛地睁开眼，长吁一口气：“原来是场噩梦啊……” “哼！你这毒妇竟也来了？” 一声冷哼从身侧响起，我...
    开封第一讲书人阅读 38,068评论 0赞 268
  • 万荣杀人案实录
    序言：老挝万荣一对情侣失踪，失踪者是张志新（化名）和其女友刘颖，没想到半个月后，有当地人在树林里发现了一具尸体，经...
    沈念sama阅读 44,478评论 1赞 305
  • 护林员之死
    正文 独居荒郊野岭守林人离奇死亡，尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 36,789评论 2赞 327
  • 白月光启示录
    正文 我和宋清朗相恋三年，在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 38,965评论 1赞 341
  • 活死人
    序言：一个原本活蹦乱跳的男人离奇死亡，死状恐怖，灵堂内的尸体忽然破棺而出，到底是诈尸还是另有隐情，我是刑警宁泽，带...
    沈念sama阅读 34,649评论 4赞 336
  • 日本核电站爆炸内幕
    正文 年R本政府宣布，位于F岛的核电站，受9级特大地震影响，放射性物质发生泄漏。R本人自食恶果不足惜，却给世界环境...
    茶点故事阅读 40,267评论 3赞 318
  • 男人毒药：我在死后第九天来索命
    文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹，春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 30,982评论 0赞 21
  • 一桩弑父案，背后竟有这般阴谋
    文/苍兰香墨 我抬头看了看天上的太阳。三九已至，却和暖如春，着一层夹袄步出监牢的瞬间，已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,223评论 1赞 267
  • 情欲美人皮
    我被黑心中介骗来泰国打工， 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留，地道东北人。 一个月前我还...
    沈念sama阅读 46,800评论 2赞 365
  • 代替公主和亲
    正文 我出身青楼，却偏偏与公主长得像，于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子，可洞房花烛夜当晚...
    茶点故事阅读 43,847评论 2赞 351