ArduPilot开源代码之OpticalFlow_backend

ArduPilot开源代码之OpticalFlow_backend

  • [1. 源由](#1. 源由)
  • [2. Library设计](#2. Library设计)
  • [3. 重要例程](#3. 重要例程)
    • [3.1 OpticalFlow_backend::_update_frontend](#3.1 OpticalFlow_backend::_update_frontend)
    • [3.2 OpticalFlow_backend::_applyYaw](#3.2 OpticalFlow_backend::_applyYaw)
  • [4. 总结](#4. 总结)
  • [5. 参考资料](#5. 参考资料)

1. 源由

光流计是一种低成本定位传感器,所有的光流计设备传感驱动代码抽象公共部分统一由OpticalFlow_backend实现。设计的核心思想是将光流传感器的具体实现与其前端接口分离开来,通过纯虚函数和友元类的机制,实现了灵活且可扩展的架构。

2. Library设计

OpticalFlow_backend类是一个抽象基类,用于表示光流传感器的后端实现。它包含了一些基本的接口函数,如初始化、更新和消息处理函数。

  1. 公共部分使用虚函数,根据不同硬件传感设备进行实现;
  • init函数是一个虚函数,允许子类在必要时重写初始化过程。
  • update函数是一个纯虚函数,强制所有子类必须实现自己的更新逻辑。
  • handle_msghandle_msp函数用于处理不同类型的消息,提供了默认的空实现,子类可以根据需要进行重写。
  1. 保护部分直接抽象的公共部分的函数实现,如访问前端对象、更新前端状态、获取缩放参数、计算偏航角等。
  2. AP_OpticalFlow类被声明为友元类,允许它访问OpticalFlow_backend的私有和保护成员。这表示AP_OpticalFlow可能是该后端类的管理类或控制类。
  3. **CLASS_NO_COPY(OpticalFlow_backend)**是一个宏,用于禁止该类的拷贝构造和赋值操作,确保每个对象都是唯一的。
cpp 复制代码
class OpticalFlow_backend
{
    // 将AP_OpticalFlow类声明为友元类,允许其访问OpticalFlow_backend的私有成员
    friend class AP_OpticalFlow;

public:
    // 构造函数,接受一个AP_OpticalFlow对象的引用
    OpticalFlow_backend(AP_OpticalFlow &_frontend);
    // 虚析构函数,允许子类重写
    virtual ~OpticalFlow_backend(void);

    // 禁止拷贝构造和拷贝赋值操作
    CLASS_NO_COPY(OpticalFlow_backend);

    // 初始化传感器的函数,默认实现为空
    virtual void init() {}

    // 从传感器读取最新的值并填充x, y和totals的纯虚函数,必须在子类中实现
    virtual void update() = 0;

    // 处理光流的mavlink消息的虚函数,默认实现为空
    virtual void handle_msg(const mavlink_message_t &msg) {}

#if HAL_MSP_OPTICALFLOW_ENABLED
    // 处理光流的msp消息的虚函数,默认实现为空
    virtual void handle_msp(const MSP::msp_opflow_data_message_t &pkt) {}
#endif

protected:
    // 前端对象的引用
    AP_OpticalFlow &frontend;

    // 更新前端状态的函数
    void _update_frontend(const struct AP_OpticalFlow::OpticalFlow_state &state);

    // 获取光流缩放参数的函数,返回一个包含X和Y轴缩放因子的向量
    Vector2f _flowScaler(void) const { return Vector2f(frontend._flowScalerX, frontend._flowScalerY); }

    // 获取以弧度表示的偏航角的函数
    float _yawAngleRad(void) const { return radians(float(frontend._yawAngle_cd) * 0.01f); }

    // 应用偏航角到一个向量上的函数
    void _applyYaw(Vector2f &v);

    // 获取ADDR参数值的函数
    uint8_t get_address(void) const { return frontend._address; }
    
    // 用于访问共享前端数据的信号量
    HAL_Semaphore _sem;
};

3. 重要例程

3.1 OpticalFlow_backend::_update_frontend

cpp 复制代码
// update the frontend
void OpticalFlow_backend::_update_frontend(const struct AP_OpticalFlow::OpticalFlow_state &state)
{
    frontend.update_state(state);
}

3.2 OpticalFlow_backend::_applyYaw

cpp 复制代码
// apply yaw angle to a vector
void OpticalFlow_backend::_applyYaw(Vector2f &v)
{
    float yawAngleRad = _yawAngleRad();
    if (is_zero(yawAngleRad)) {
        return;
    }
    v.rotate(yawAngleRad);
}

4. 总结

OpticalFlow_backend继承出来的硬件传感设备在Ardupilot上,目前有以下几类设备:

MATEKSYS Optical Flow & LIDAR 3901-L0X是其中的一种。

5. 参考资料

【1】ArduPilot开源飞控系统之简单介绍

【2】ArduPilot之开源代码Task介绍

【3】ArduPilot飞控启动&运行过程简介

【4】ArduPilot之开源代码Library&Sketches设计

【5】ArduPilot之开源代码Sensor Drivers设计

相关推荐
ragnwang2 小时前
C++ Eigen常见的高级用法 [学习笔记]
c++·笔记·学习
星就前端叭3 小时前
【开源】一款基于Vue3 + WebRTC + Node + SRS + FFmpeg搭建的直播间项目
前端·后端·开源·webrtc
lqqjuly5 小时前
特殊的“Undefined Reference xxx“编译错误
c语言·c++
冰红茶兑滴水5 小时前
云备份项目--工具类编写
linux·c++
刘好念5 小时前
[OpenGL]使用 Compute Shader 实现矩阵点乘
c++·计算机图形学·opengl·glsl
酒鬼猿6 小时前
C++进阶(二)--面向对象--继承
java·开发语言·c++
姚先生976 小时前
LeetCode 209. 长度最小的子数组 (C++实现)
c++·算法·leetcode
小王爱吃月亮糖7 小时前
QT开发【常用控件1】-Layouts & Spacers
开发语言·前端·c++·qt·visual studio
Faith_xzc7 小时前
【Apache Doris】周FAQ集锦:第 26 期
大数据·数据仓库·开源·doris
aworkholic7 小时前
opencv sdk for java中提示无stiching模块接口的问题
java·c++·opencv·jni·opencv4android·stiching