Ardupilot开源飞控之AP_Follow

Ardupilot开源飞控之AP_Follow

  • 1. 源由
  • 2. 定义
    • 2.1 ModeFollow类
      • 2.1.1 ModeFollow::update
      • 2.1.2 ModeFollow::_enter
      • 2.1.3 ModeFollow::_exit
    • 2.2 AP_Follow类
      • 2.2.1 AP_Follow::handle_msg
      • 2.2.2 AP_Follow::get_target_location_and_velocity
      • 2.2.3 AP_Follow::get_velocity_ned
  • 3. 其他函数
    • 3.1 JitterCorrection::correct_offboard_timestamp_msec
  • 4. 总结
  • 5. 参考资料

1. 源由

前面在《Ardupilot开源飞控之FollowMe计划》最初“【无障碍物】主动FollowMe功能(采用GPS) ”就是在这部分实现的。

那么我们研读下这部分代码。

2. 定义

关于模型模式的相关框架，详见：ArduPilot开源飞控之飞行模式。注：ArduRover和ArduCopter类似，可以相互借鉴。

2.1 ModeFollow类

ModeFollow
├── 继承自 Mode
├── 公有成员函数 (public)
│   ├── mode_number() const
│   ├── name4() const
│   ├── update() override
│   ├── is_autopilot_mode() const
│   ├── wp_bearing() const
│   ├── nav_bearing() const
│   ├── crosstrack_error() const
│   ├── get_desired_location(Location& destination) const WARN_IF_UNUSED
│   ├── get_distance_to_destination() const
│   └── set_desired_speed(float speed)
└── 保护成员函数与变量 (protected)├── _enter() override├── _exit() override└── _desired_speed

  1. 类定义

    • class ModeFollow : public Mode
      • ModeFollow 类继承自 Mode 类。

  2. 公有成员函数（public）

    • Number mode_number() const override
      • 返回模式编号，具体为 Number::FOLLOW。
    • const char *name4() const override
      • 返回模式名称，为 “FOLL”。
    • void update() override
      • 更新车辆状态的方法。
    • bool is_autopilot_mode() const override
      • 返回是否为自动驾驶模式，这里返回 true。
    • float wp_bearing() const override
      • 返回导航点的航向。
    • float nav_bearing() const override
      • 返回导航航向，这里调用 wp_bearing() 方法。
    • float crosstrack_error() const override
      • 返回偏航误差，这里固定返回 0.0f。
    • bool get_desired_location(Location& destination) const override WARN_IF_UNUSED
      • 返回期望的位置，这里固定返回 false。
    • float get_distance_to_destination() const override
      • 返回到目的地的距离。
    • bool set_desired_speed(float speed) override
      • 设置期望的速度。

  3. 保护成员函数（protected）

    • bool _enter() override
      • 进入模式时的操作。
    • void _exit() override
      • 退出模式时的操作。

  4. 保护成员变量（protected）

    • float _desired_speed
      • 期望速度，单位为 m/s。

2.1.1 ModeFollow::update

模式更新函数，定时轮训。

SCHED_TASK(update_current_mode,   400,    200,  12),└──> Rover::update_current_mode└──> control_mode->update└──> ModeFollow::update

主要分为以下几个步骤：

  1. 声明需要的变量。
  2. 获取并检查当前车辆的速度，如果无法获取有效速度则停止车辆。
  3. 获取目标车辆的距离和速度信息，如果无法获取则停止车辆。
  4. 计算期望速度向量。
  5. 检查期望速度是否为零，如果为零则停止车辆。
  6. 设置未到达目的地状态。
  7. 调整期望速度以保持在预设的速度限制内。
  8. 计算车辆的期望航向。
  9. 根据期望航向和速度控制车辆的转向和油门。
ModeFollow::update()
├── 声明变量
│   ├── float speed;
│   ├── Vector3f dist_vec;
│   ├── Vector3f dist_vec_offs;
│   ├── Vector3f vel_of_target;
│   ├── Vector2f desired_velocity_ne;
│   └── float desired_speed;
|
├── 获取车辆速度并检查
│   ├── if (!attitude_control.get_forward_speed(speed))
│   │   ├── g2.motors.set_throttle(0.0f);
│   │   ├── g2.motors.set_steering(0.0f);
│   │   └── return;
|
├── 获取目标距离和速度并检查
│   ├── if (!g2.follow.get_target_dist_and_vel_ned(dist_vec, dist_vec_offs, vel_of_target))
│   │   ├── _reached_destination = true;
│   │   ├── stop_vehicle();
│   │   └── return;
|
├── 计算期望速度向量
│   ├── const float kp = g2.follow.get_pos_p().kP();
│   ├── desired_velocity_ne.x = vel_of_target.x + (dist_vec_offs.x * kp);
│   ├── desired_velocity_ne.y = vel_of_target.y + (dist_vec_offs.y * kp);
|
├── 检查期望速度是否为零
│   ├── if (is_zero(desired_velocity_ne.x) && is_zero(desired_velocity_ne.y))
│   │   ├── _reached_destination = true;
│   │   ├── stop_vehicle();
│   │   └── return;
|
├── 设置未到达目的地状态
│   ├── _reached_destination = false;
|
├── 缩放期望速度以保持在水平速度限制内
│   ├── desired_speed = safe_sqrt(sq(desired_velocity_ne.x) + sq(desired_velocity_ne.y));
│   ├── if (!is_zero(desired_speed) && (desired_speed > _desired_speed))
│   │   ├── const float scalar_xy = _desired_speed / desired_speed;
│   │   ├── desired_velocity_ne *= scalar_xy;
│   │   └── desired_speed = _desired_speed;
|
├── 计算车辆航向
│   ├── const float desired_yaw_cd = wrap_180_cd(atan2f(desired_velocity_ne.y, desired_velocity_ne.x) * DEGX100);
|
├── 运行转向和油门控制器
│   ├── calc_steering_to_heading(desired_yaw_cd);
│   └── calc_throttle(desired_speed, true);

2.1.2 ModeFollow::_enter

进入模式，执行的初始化函数。

Rover::set_mode└──> Mode::enter└──> ModeFollow::_enter

判断跟随模式是否使能，使能情况下初始化期望速度。

// initialize follow mode
bool ModeFollow::_enter()
{if (!g2.follow.enabled()) {return false;}// initialise speed to waypoint speed_desired_speed = g2.wp_nav.get_default_speed();return true;
}

2.1.3 ModeFollow::_exit

退出模式，执行的“清场”函数。

Rover::set_mode└──> Mode::exit└──> ModeFollow::_exit

清场处理。

// exit handling
void ModeFollow::_exit()
{g2.follow.clear_offsets_if_required();
}

2.2 AP_Follow类

AP_Follow 类用于管理无人机的跟随模式，包含目标位置追踪、偏移处理、航向控制等功能。

AP_Follow
├── 枚举类型
│   ├── Option
│   └── YawBehave
├── 构造函数
│   └── AP_Follow()
├── 静态方法
│   └── get_singleton()
├── 公有方法
│   ├── enabled() const
│   ├── set_target_sysid(uint8_t sysid)
│   ├── clear_offsets_if_required()
│   ├── have_target() const
│   ├── get_target_location_and_velocity(Location &loc, Vector3f &vel_ned) const
│   ├── get_target_location_and_velocity_ofs(Location &loc, Vector3f &vel_ned) const
│   ├── get_target_dist_and_vel_ned(Vector3f &dist_ned, Vector3f &dist_with_ofs, Vector3f &vel_ned)
│   ├── get_target_sysid() const
│   ├── get_pos_p() const
│   ├── get_yaw_behave() const
│   ├── get_target_heading_deg(float &heading) const
│   ├── handle_msg(const mavlink_message_t &msg)
│   ├── get_distance_to_target() const
│   ├── get_bearing_to_target() const
│   ├── get_last_update_ms() const
│   ├── option_is_enabled(Option option) const
│   └── var_info[]
├── 静态成员
│   └── _singleton
├── 私有方法
│   ├── get_velocity_ned(Vector3f &vel_ned, float dt) const
│   ├── init_offsets_if_required(const Vector3f &dist_vec_ned)
│   ├── get_offsets_ned(Vector3f &offsets) const
│   ├── rotate_vector(const Vector3f &vec, float angle_deg) const
│   └── clear_dist_and_bearing_to_target()
└── 私有成员变量├── _enabled├── _sysid├── _dist_max├── _offset_type├── _offset├── _yaw_behave├── _alt_type├── _p_pos├── _options├── _last_location_update_ms├── _target_location├── _target_velocity_ned├── _target_accel_ned├── _last_heading_update_ms├── _target_heading├── _automatic_sysid├── _dist_to_target├── _bearing_to_target└── _offsets_were_zero
  1. 公有成员

  • 枚举类型 Option 和 YawBehave

    • Option 枚举：定义跟随选项参数。
    • YawBehave 枚举：定义航向行为参数。

  • 构造函数

    • AP_Follow(): 类的构造函数。

  • 静态方法

    • get_singleton(): 返回单例对象。

  • 公有方法

    • enabled() const: 返回库是否启用。
    • set_target_sysid(uint8_t sysid): 设置跟随目标的系统ID。
    • clear_offsets_if_required(): 如有必要，重置偏移量。
    • have_target() const: 返回是否有有效的目标位置估计。
    • get_target_location_and_velocity(Location &loc, Vector3f &vel_ned) const: 获取目标位置和速度。
    • get_target_location_and_velocity_ofs(Location &loc, Vector3f &vel_ned) const: 获取目标位置和速度（包含偏移）。
    • get_target_dist_and_vel_ned(Vector3f &dist_ned, Vector3f &dist_with_ofs, Vector3f &vel_ned): 获取到目标的距离和速度。
    • get_target_sysid() const: 获取目标系统ID。
    • get_pos_p() const: 获取位置控制器。
    • get_yaw_behave() const: 获取用户定义的航向行为。
    • get_target_heading_deg(float &heading) const: 获取目标航向。
    • handle_msg(const mavlink_message_t &msg): 解析包含目标位置、速度和姿态的MAVLink消息。
    • get_distance_to_target() const: 获取到目标的水平距离。
    • get_bearing_to_target() const: 获取到目标的方位。
    • get_last_update_ms() const: 获取最后一次位置更新的系统时间。
    • option_is_enabled(Option option) const: 返回是否启用某个跟随选项。
    • var_info[]: 参数列表。
  1. 私有成员

  • 静态成员

    • _singleton: 单例对象指针。

  • 私有方法

    • get_velocity_ned(Vector3f &vel_ned, float dt) const: 获取NED坐标系中的速度估计。
    • init_offsets_if_required(const Vector3f &dist_vec_ned): 初始化偏移量。
    • get_offsets_ned(Vector3f &offsets) const: 获取NED坐标系中的偏移量。
    • rotate_vector(const Vector3f &vec, float angle_deg) const: 顺时针旋转3D向量。
    • clear_dist_and_bearing_to_target(): 重置到目标的距离和方位。

  • 私有成员变量

    • _enabled: 是否启用该子系统。
    • _sysid: 目标的MAVLink系统ID。
    • _dist_max: 到目标的最大距离，超出此距离的目标将被忽略。
    • _offset_type: 偏移坐标系类型。
    • _offset: 与目标的偏移量。
    • _yaw_behave: 跟随车辆的航向行为。
    • _alt_type: 跟随模式下的高度源。
    • _p_pos: 位置误差P控制器。
    • _options: 跟随模式的选项。
    • _last_location_update_ms: 最后一次位置更新的系统时间。
    • _target_location: 目标的最后已知位置。
    • _target_velocity_ned: 目标在NED坐标系中的速度。
    • _target_accel_ned: 目标在NED坐标系中的加速度。
    • _last_heading_update_ms: 最后一次航向更新的系统时间。
    • _target_heading: 目标的航向。
    • _automatic_sysid: 是否自动锁定系统ID。
    • _dist_to_target: 到目标的最新距离。
    • _bearing_to_target: 到目标的最新方位。
    • _offsets_were_zero: 偏移量是否最初为零然后初始化为与目标的偏移量。
    • _jitter: 抖动校正器，最大传输延迟为3秒。

2.2.1 AP_Follow::handle_msg

AP_Follow::handle_msg(const mavlink_message_t &msg)
|
|-- 初步检查
|   |-- if (!_enabled)  //未使能`AP_Follow`类
|   |   |-- return;
|   |
|   |-- if (msg.sysid == mavlink_system.sysid)  //自身MAVLink消息忽略
|   |   |-- return;
|   |
|   |-- if (_sysid != 0 && msg.sysid != _sysid)  //非跟踪目标MAVLink消息忽略
|       |-- if (_automatic_sysid)  // 使能超时自动重置跟踪目标
|           |-- if ((_last_location_update_ms == 0) || (AP_HAL::millis() - _last_location_update_ms > AP_FOLLOW_SYSID_TIMEOUT_MS))
|               |-- _sysid.set(0);
|       |-- return;
|
|-- 消息解析
|   |-- bool updated = false;
|
|   |-- switch (msg.msgid)
|       |
|       |-- case MAVLINK_MSG_ID_GLOBAL_POSITION_INT
|       |   |-- mavlink_global_position_int_t packet;
|       |   |-- mavlink_msg_global_position_int_decode(&msg, &packet);
|       |
|       |   |-- if ((packet.lat == 0 && packet.lon == 0))
|       |       |-- return;
|       |
|       |   |-- _target_location.lat = packet.lat;
|       |   |-- _target_location.lng = packet.lon;
|       |
|       |   |-- if (_alt_type == AP_FOLLOW_ALTITUDE_TYPE_RELATIVE)
|       |       |-- _target_location.set_alt_cm(packet.relative_alt / 10, Location::AltFrame::ABOVE_HOME);
|       |   |   else
|       |       |-- _target_location.set_alt_cm(packet.alt / 10, Location::AltFrame::ABSOLUTE);
|       |
|       |   |-- _target_velocity_ned.x = packet.vx * 0.01f;
|       |   |-- _target_velocity_ned.y = packet.vy * 0.01f;
|       |   |-- _target_velocity_ned.z = packet.vz * 0.01f;
|       |
|       |   |-- _last_location_update_ms = _jitter.correct_offboard_timestamp_msec(packet.time_boot_ms, AP_HAL::millis());
|       |   |-- if (packet.hdg <= 36000)
|       |       |-- _target_heading = packet.hdg * 0.01f;
|       |       |-- _last_heading_update_ms = _last_location_update_ms;
|       |
|       |   |-- if (_sysid == 0)
|       |       |-- _sysid.set(msg.sysid);
|       |       |-- _automatic_sysid = true;
|       |
|       |   |-- updated = true;
|       |   |-- break;
|
|       |-- case MAVLINK_MSG_ID_FOLLOW_TARGET
|       |   |-- mavlink_follow_target_t packet;
|       |   |-- mavlink_msg_follow_target_decode(&msg, &packet);
|       |
|       |   |-- if ((packet.lat == 0 && packet.lon == 0))
|       |       |-- return;
|       |
|       |   |-- if ((packet.est_capabilities & (1<<0)) == 0)
|       |       |-- return;
|       |
|       |   |-- Location new_loc = _target_location;
|       |   |-- new_loc.lat = packet.lat;
|       |   |-- new_loc.lng = packet.lon;
|       |   |-- new_loc.set_alt_cm(packet.alt * 100, Location::AltFrame::ABSOLUTE);
|       |
|       |   |-- if (_alt_type == AP_FOLLOW_ALTITUDE_TYPE_RELATIVE && !new_loc.change_alt_frame(Location::AltFrame::ABOVE_HOME))
|       |       |-- return;
|       |
|       |   |-- _target_location = new_loc;
|       |
|       |   |-- if (packet.est_capabilities & (1<<1))
|       |       |-- _target_velocity_ned.x = packet.vel[0];
|       |       |-- _target_velocity_ned.y = packet.vel[1];
|       |       |-- _target_velocity_ned.z = packet.vel[2];
|       |   |   else
|       |       |-- _target_velocity_ned.zero();
|       |
|       |   |-- _last_location_update_ms = _jitter.correct_offboard_timestamp_msec(packet.timestamp, AP_HAL::millis());
|       |
|       |   |-- if (packet.est_capabilities & (1<<3))
|       |       |-- Quaternion q{packet.attitude_q[0], packet.attitude_q[1], packet.attitude_q[2], packet.attitude_q[3]};
|       |       |-- float r, p, y;
|       |       |-- q.to_euler(r, p, y);
|       |       |-- _target_heading = degrees(y);
|       |       |-- _last_heading_update_ms = _last_location_update_ms;
|       |
|       |   |-- if (_sysid == 0)
|       |       |-- _sysid.set(msg.sysid);
|       |       |-- _automatic_sysid = true;
|       |
|       |   |-- updated = true;
|       |   |-- break;
|
|-- if (updated)
|   |-- #if HAL_LOGGING_ENABLED
|       |-- Location loc_estimate{};
|       |-- Vector3f vel_estimate;
|       |-- UNUSED_RESULT(get_target_location_and_velocity(loc_estimate, vel_estimate));
|       |
|       |-- AP::logger().WriteStreaming("FOLL",
|                                       "TimeUS,Lat,Lon,Alt,VelN,VelE,VelD,LatE,LonE,AltE",  // labels
|                                       "sDUmnnnDUm",    // units
|                                       "F--B000--B",    // mults
|                                       "QLLifffLLi",    // fmt
|                                       AP_HAL::micros64(),
|                                       _target_location.lat,
|                                       _target_location.lng,
|                                       _target_location.alt,
|                                       (double)_target_velocity_ned.x,
|                                       (double)_target_velocity_ned.y,
|                                       (double)_target_velocity_ned.z,
|                                       loc_estimate.lat,
|                                       loc_estimate.lng,
|                                       loc_estimate.alt);
|   |-- #endif

  • 初步检查：

    • 启用检查：如果未启用AP_Follow类，则直接返回。
    • 跳过自有消息：如果消息来自当前系统（即自反馈消息），则跳过。
    • 目标系统检查：如果消息不来自当前目标系统且不是自动系统ID，则跳过，并在必要时重置系统ID。

  • 消息解析：

    • 消息类型判断：根据消息的msgid，分别处理不同类型的MAVLink消息：
      • MAVLINK_MSG_ID_GLOBAL_POSITION_INT：处理全局位置消息，更新目标的经纬度、高度、速度和航向信息。如果消息无效（经纬度为零），则忽略消息。
      • MAVLINK_MSG_ID_FOLLOW_TARGET：处理跟踪目标消息，更新目标的经纬度、高度、速度和航向信息。如果消息无效（经纬度为零或不包含位置数据），则忽略消息。

  • 更新检查和日志记录：

    • 如果目标数据被更新，则在启用日志记录时记录目标的估计位置和速度，以及车辆的当前位置和速度。

该方法通过处理不同类型的MAVLink消息来跟踪目标的实时位置和运动信息，并在需要时进行日志记录，以确保目标跟踪的精度和可靠性。

2.2.2 AP_Follow::get_target_location_and_velocity

get_target_location_and_velocity(Location &loc, Vector3f &vel_ned) -> bool
└── 判断是否启用 (_enabled)├── 否：立即返回 false└── 是：继续└── 检查是否超时├── 是：立即返回 false└── 否：继续└── 计算自上次位置更新后的时间差 (dt)└── 获取速度估算 (get_velocity_ned)├── 失败：返回 false└── 成功：继续└── 投影车辆位置 (_target_location)├── 使用速度 (vel_ned.x 和 vel_ned.y) 更新水平位置└── 使用速度 (vel_ned.z) 更新垂直位置└── 更新后的位置信息 (last_loc) 赋值给 loc└── 返回 true

  1. 判断是否启用：

    • 检查 _enabled 是否为 true。
    • 如果 _enabled 为 false，函数立即返回 false。

  2. 检查是否超时：

    • 检查 _last_location_update_ms 是否为 0，或当前时间与 _last_location_update_ms 的差值是否超过 AP_FOLLOW_TIMEOUT_MS。
    • 如果是超时条件，则函数立即返回 false。

  3. 计算时间差 (dt)：

    • 计算自上次位置更新以来的时间差，单位为秒。

  4. 获取速度估算：

    • 调用 get_velocity_ned(vel_ned, dt) 获取速度估算值。
    • 如果获取失败，函数返回 false。

  5. 投影车辆位置：

    • 根据当前速度估算值和时间差，更新目标位置。
    • 水平方向：vel_ned.x * dt 和 vel_ned.y * dt 用于更新水平位置。
    • 垂直方向：vel_ned.z * 100.0f * dt 用于更新垂直位置（速度单位转换为 cm/s，并乘以时间差）。
    • 更新后的目标位置赋值给 loc。

  6. 返回最新的位置信息：

    • 函数成功执行完毕，返回 true。

2.2.3 AP_Follow::get_velocity_ned

AP_Follow: Calculate acceleration target #20922 

// get velocity estimate in m/s in NED frame using dt since last update
bool AP_Follow::get_velocity_ned(Vector3f &vel_ned, float dt) const
{vel_ned = _target_velocity_ned + (_target_accel_ned * dt);return true;
}

3. 其他函数

3.1 JitterCorrection::correct_offboard_timestamp_msec

JitterCorrection::correct_offboard_timestamp_msec└──> correct_offboard_timestamp_useccorrect_offboard_timestamp_usec(uint64_t offboard_usec, uint64_t local_usec)
|
|-- 计算本地时间与外部时间的差异
|   |
|   |-- int64_t diff_us = int64_t(local_usec) - int64_t(offboard_usec);
|
|-- 初次初始化或时间差异超前的处理
|   |
|   |-- if (!initialised || diff_us < link_offset_usec)
|       |
|       |-- 设置 link_offset_usec 为当前差异
|       |-- link_offset_usec = diff_us;
|       |-- 标记为已初始化
|       |-- initialised = true;
|
|-- 估算校正后的外部时间
|   |
|   |-- int64_t estimate_us = offboard_usec + link_offset_usec;
|
|-- 检查消息是否太过于滞后
|   |
|   |-- if (estimate_us + (max_lag_ms*1000U) < int64_t(local_usec))
|       |
|       |-- 将估算时间调整为最大滞后时间
|       |-- estimate_us = local_usec - (max_lag_ms*1000U);
|       |-- 更新 link_offset_usec
|       |-- link_offset_usec = estimate_us - offboard_usec;
|
|-- 最小样本处理
|   |
|   |-- if (min_sample_counter == 0)
|       |
|       |-- 初始化 min_sample_us
|       |-- min_sample_us = diff_us;
|
|   |-- 增加样本计数器
|   |   |-- min_sample_counter++;
|
|   |-- 如果当前差异小于最小样本，更新最小样本
|   |   |-- if (diff_us < min_sample_us)
|           |-- min_sample_us = diff_us;
|
|   |-- 达到收敛循环次数后，更新 link_offset_usec
|   |   |-- if (min_sample_counter == convergence_loops)
|           |
|           |-- 更新 link_offset_usec 为最小样本
|           |-- link_offset_usec = min_sample_us;
|           |-- 重置样本计数器
|           |-- min_sample_counter = 0;
|
|-- 返回校正后的时间
|   |-- return uint64_t(estimate_us);

  1. 计算时间差异:

    • diff_us 计算本地时间 local_usec 和外部时间 offboard_usec 之间的差异。

  2. 初次初始化或时间差异超前的处理:

    • 如果还未初始化或时间差异小于 link_offset_usec，则更新 link_offset_usec 并标记为已初始化。这部分处理外部时间戳过于超前的情况。

  3. 估算校正后的外部时间:

    • 使用外部时间 offboard_usec 加上 link_offset_usec 来估算校正后的时间 estimate_us。

  4. 检查消息是否太过于滞后:

    • 如果估算的时间加上最大滞后时间小于本地时间，说明消息太过滞后，需要将 estimate_us 调整为本地时间减去最大滞后时间，并更新 link_offset_usec。

  5. 最小样本处理:

    • 用于记录和更新传输延迟的最小样本，逐步收敛传输延迟的估算值。
    • 如果样本计数器为 0，初始化最小样本 min_sample_us。
    • 增加样本计数器 min_sample_counter。
    • 如果当前差异 diff_us 小于记录的最小样本 min_sample_us，则更新最小样本。
    • 如果样本计数器达到收敛循环次数 convergence_loops，则更新 link_offset_usec 为最小样本，并重置样本计数器。

  6. 返回校正后的时间:

    • 最后返回校正后的时间 estimate_us。

通过这种树形结构，可以清晰地看到函数的每个步骤和逻辑分支的关系，更加容易理解整个函数的工作流程。

4. 总结

GPS下的跟随模式，主要是通过AP_Follow和ModeFollow来实现：

  1. AP_Follow更新跟随目标的状态信息
  2. ModeFollow定期根据跟随目标情况，更新自身的方向和速度，根据两者之间的距离进行判断

注：详细代码可以仔细阅读，但是从整个设计逻辑的角度看，其实还是可以理解的。另外，也有一些关于加速度的问题，截止发稿日，还并没有很好的处理，这个可能和轨迹预测，跟随车辆指向变化方向改变有关系，对于摄像头跟随是很有意义和价值的。

5. 参考资料

【1】ArduPilot开源飞控系统之简单介绍
【2】ArduPilot之开源代码框架
【3】ArduPilot开源飞控之飞行模式

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.mzph.cn/bicheng/18971.shtml

如若内容造成侵权/违法违规/事实不符，请联系多彩编程网进行投诉反馈email:809451989@qq.com，一经查实，立即删除！

相关文章

getContentView(mBinding.getRoot())； 会导致内存泄露吗？里面有SurfaceView ViewBinding

getContentView(mBinding.getRoot())； 会导致内存泄露吗？里面有SurfaceView ViewBinding

在上述代码中&#xff0c;ActivityTestingBinding 是一个 Data Binding 库生成的类&#xff0c;用于绑定 XML 布局到 Activity 中。inflate(getLayoutInflater()) 用于将布局文件解析并转换为对应的视图层次结构。然后 getWindow().setFlags() 设置窗口属性&#xff0c;保持屏幕…
阅读更多...
小型海外仓如何选择第三方海外仓系统：多看多对比，性价比优先

小型海外仓如何选择第三方海外仓系统：多看多对比，性价比优先

在现在的海外仓市场中&#xff0c;中小型海外仓&#xff0c;家庭海外仓的占比还是非常大的。这类海外仓的一个共同点就是资金有限&#xff0c;管理能力比较弱&#xff0c;很难实现规模效应。 对于这类海外仓来说&#xff0c;选择一套合适的第三方海外仓系统&#xff0c;对提升…
阅读更多...
好用的国产大文件传输软件有哪些，快来看看吧

好用的国产大文件传输软件有哪些，快来看看吧

在这个数字化飞速发展的时代&#xff0c;我们每天都在与各种文件打交道&#xff0c;从简单的文档到庞大的视频素材&#xff0c;文件的体积越来越大&#xff0c;传统的文件传输方式逐渐显得力不从心。面对这个挑战&#xff0c;大文件传输软件应运而生&#xff0c;它们不仅解决了…
阅读更多...
note-网络是怎样连接的4 接入网和网络运营商

note-网络是怎样连接的4 接入网和网络运营商

助记提要 网络包从用户传输到互联网的过程信号的调制方式ADSL使用多个频率的合成波传输信号分离器的作用电话线的特点光纤的构造光纤的原理单模光纤和多模光纤光纤接入网的两种接入方式PPP拨号上网过程ADSL和FTTH使用PPPoE的方式PPPoE的规则隧道其他接入认证方式 PPPoA和DHCP网…
阅读更多...
基于大数据的高校生源可视化分析系统

基于大数据的高校生源可视化分析系统

基于大数据的高校生源可视化分析系统 “A Visual Analysis System for Higher Education Student Enrollment based on Big Data” 完整下载链接:基于大数据的高校生源可视化分析系统 文章目录 基于大数据的高校生源可视化分析系统摘要第一章 引言1.1 研究背景1.2 研究目的1.…
阅读更多...
adam优化器计算过程(tensorflow)

adam优化器计算过程(tensorflow)

一、adam原理 原理 应用 优点 缺点 二、手动实现 一步一步计算 三、使用tensorflow api实现 api使用 四、一个具体的深度学习的例子
阅读更多...
随后记： uniapp uview u-dropdown 下拉菜单固定高度滑动不生效

随后记： uniapp uview u-dropdown 下拉菜单固定高度滑动不生效

使用u-dropdown 下拉组件 按照uview官网讲解使用 配置根本不生效 scroll-y"true" style"height: 200rpx;" 但是在下拉的时候&#xff0c;不能上下滑动 &#xff0c;原因是自带的遮罩层挡住了 解决办法&#xff1a;在下拉菜单打开和关闭的时候&#xff0c…
阅读更多...
linux 目录 /usr/lib和 /usr/lib64区别

linux 目录 /usr/lib和 /usr/lib64区别

在 Linux 系统中&#xff0c;/usr/lib 和 /usr/lib64 目录通常用于存储库文件&#xff08;libraries&#xff09;&#xff0c;这些库文件是程序运行时所需的共享代码和数据。这两个目录之间的主要区别在于它们所包含的库文件的架构&#xff08;architecture&#xff09;和用途。…
阅读更多...
Python函数式编程进阶：用函数实现设计模式

Python函数式编程进阶：用函数实现设计模式

文章目录 函数式编程进阶&#xff1a;用函数实现设计模式案例实现&#xff1a;构建“策略”模式使用函数实现”策略“模式享元 选择最佳策略&#xff1a;简单的方式 globals关键字 函数式编程进阶&#xff1a;用函数实现设计模式 案例实现&#xff1a;构建“策略”模式 策略模…
阅读更多...
Java 18新特性：探索Java的未来

Java 18新特性：探索Java的未来

目录 1. 增强的模式匹配 2. JEP 411&#xff1a;String解构 3. JEP 395&#xff1a;Records增强 4. JEP 398&#xff1a;Deprecate警告增强 5. JEP 409&#xff1a;Sealed类和接口增强 6. API改进 6.1 集合API改进 6.2 流API改进 6.3 IO/NIO API改进 7. 性能优化 7.…
阅读更多...
从0开始带你成为Kafka消息中间件高手---第三讲

从0开始带你成为Kafka消息中间件高手---第三讲

从0开始带你成为Kafka消息中间件高手—第三讲 实际上来说&#xff0c;每次leader接收到一条消息&#xff0c;都会更新自己的LEO&#xff0c;也就是log end offset&#xff0c;把最后一位offset 1&#xff0c;这个大家都能理解吧&#xff1f;接着各个follower会从leader请求同…
阅读更多...
k8s 中svc映射的外部端口是如何监听的，netstat命令为什么查不到？

k8s 中svc映射的外部端口是如何监听的，netstat命令为什么查不到？

在Kubernetes中&#xff0c;Service&#xff08;服务&#xff09;是一种抽象&#xff0c;用于将一组Pod&#xff08;容器&#xff09;公开为一个网络服务。Service可以通过ClusterIP&#xff08;集群内部IP&#xff09;、NodePort&#xff08;节点端口&#xff09;或LoadBalanc…
阅读更多...
KDD 2024｜基于隐空间因果推断的微服务系统根因定位

KDD 2024｜基于隐空间因果推断的微服务系统根因定位

简介&#xff1a;本文介绍了由清华大学、南开大学、eBay、微软、中国科学院计算机网络信息中心等单位共同合作的论文《基于隐空间因果推断的受限可观测性场景的微服务系统根因定位》。该论文已被KDD 2024会议录用。 论文标题&#xff1a;Microservice Root Cause Analysis Wit…
阅读更多...
10年老运营人吐血整理，给新媒体运营人的20条建议！沈阳新媒体运营培训

10年老运营人吐血整理，给新媒体运营人的20条建议！沈阳新媒体运营培训

对于企业&#xff0c;在新媒体平台开设官方账号应该是已经成为标配。不仅是对企业新媒体运营需求量提高&#xff0c;新媒体人的薪资也是水涨船高。 另外值得注意的是&#xff0c;企业对资深新媒体运营人才尤为重视&#xff0c;这表现在他们不惜重金招聘高薪新媒体运营人才&…
阅读更多...
Linux新增磁盘挂载分区

Linux新增磁盘挂载分区

1. 查看磁盘分区名称 lsblk 可见&#xff0c;新增的分区为 sdb 2.格式化磁盘 mkfs.xfs -f /dev/sdb 3.挂在磁盘到 /ocean目录&#xff0c;挂在前先创建空目录 /ocean mkdir /oceanmount /dev/sdb /ocean 执行后&#xff0c;可用 df -h 查看分区是否成功 4.持久化磁盘分区&a…
阅读更多...
查询MongoDB中某个数据库的占用空间大小

查询MongoDB中某个数据库的占用空间大小

要查询MongoDB中某个数据库的占用空间大小&#xff0c;可以使用以下几种方法&#xff1a; 方法一&#xff1a;使用 MongoDB Shell (mongo) 1. **连接到 MongoDB**&#xff1a; bash mongo 2. **选择数据库**&#xff1a; javascript use yourDatabaseName …
阅读更多...
AI推介-大语言模型LLMs论文速览（arXiv方向）：2024.05.20-2024.05.25

AI推介-大语言模型LLMs论文速览（arXiv方向）：2024.05.20-2024.05.25

文章目录~ 1.STRIDE: A Tool-Assisted LLM Agent Framework for Strategic and Interactive Decision-Making2. M 3 M^3 M3GPT: An Advanced Multimodal, Multitask Framework for Motion Comprehension and Generation3.MindStar: Enhancing Math Reasoning in Pre-trained LL…
阅读更多...
计算机图形学入门03：二维变换

计算机图形学入门03：二维变换

变换(Transformation)可分为模型(Model)变换和视图(Viewing)变换。在3D虚拟场景中相机的移动和旋转&#xff0c;角色人物动画都需要变换&#xff0c;用来描述物体运动。将三维世界投影变换到2D屏幕上成像出来&#xff0c;也需要变换。 1.缩放变换 缩放(Scale)变换&#xff1a; …
阅读更多...
【B站 heima】小兔鲜Vue3 项目学习笔记 Day06

【B站 heima】小兔鲜Vue3 项目学习笔记 Day06

文章目录 购物车本地1. 列表购物车基础数据渲染2. 列表购物车单选功能3. 列表购物车全选功能4. 列表购物车统计列表实现5. 接口-加入购物车6. 接口-删除购物车7. 退出登录-清空购物车数据8. 合并购物车到服务器(重要) 结算1. 路由配置和基础数据渲染2. 地址切换-打开弹框交互实…
阅读更多...
跨境人必读：X（原Twitter）和Facebook区别是什么？

跨境人必读：X（原Twitter）和Facebook区别是什么？

在今日全球化的商业环境中&#xff0c;跨境电商领域的企业和独立站卖家正逐渐认识到社交媒体营销的巨大潜力。特别是X&#xff08;原Twitter&#xff09;和Facebook&#xff0c;作为领先的社交媒体平台&#xff0c;它们的使用不仅能够提升品牌知名度&#xff0c;还能直接影响销…
阅读更多...
最新文章

Copyright @ 2022~2023