【问题标题】:Change velocity with message to Mavlink通过消息更改速度到 Mavlink
【发布时间】:2019-01-22 17:22:44
【问题描述】:

我正在尝试通过改变速度来移动车辆。我已经能够在 Python 中成功执行操作,但是对于我的项目我不能使用 Python,所以我正在使用 Android 尝试进行相同的操作。 Python 中的工作功能是:

def send_ned_velocity(velocity_x, velocity_y, velocity_z):
"""
Move vehicle in direction based on specified velocity vectors.
"""
msg = vehicle.message_factory.set_position_target_local_ned_encode(
    0,       # time_boot_ms (not used)
    0, 0,    # target system, target component
    mavutil.mavlink.MAV_FRAME_BODY_NED, # frame
    0b0000111111000111, # type_mask (only speeds enabled)
    0, 0, 0, # x, y, z positions (not used)
    velocity_x, velocity_y, velocity_z, # x, y, z velocity in m/s
    0, 0, 0, # x, y, z acceleration (not supported yet, ignored in GCS_Mavlink)
    0, 0)    # yaw, yaw_rate (not supported yet, ignored in GCS_Mavlink)
# send command to vehicle
vehicle.send_mavlink(msg)
vehicle.flush()

我正在尝试做的是 Android 中的等效代码:

                   // Create the message
                msg_local_position_ned msgMessageInterval = new msg_local_position_ned();
                msgMessageInterval.x = 0;
                msgMessageInterval.y = 0;
                msgMessageInterval.z = 0;
                msgMessageInterval.vx = 10;
                msgMessageInterval.vy = 0;
                msgMessageInterval.vz = 0;
                msgMessageInterval.time_boot_ms = 0;

                MavlinkMessageWrapper mavlinkMessageWrapper = new MavlinkMessageWrapper(msgMessageInterval);

                // Send the message to MavLink
                ExperimentalApi.getApi(drone).sendMavlinkMessage(mavlinkMessageWrapper);

                // Listen for the message received
                drone.addMavlinkObserver(new MavlinkObserver() {
                    @Override
                    public void onMavlinkMessageReceived(MavlinkMessageWrapper mavlinkMessageWrapper) {
                        System.out.println("MESSAGE RECEIVED="+mavlinkMessageWrapper.getMavLinkMessage().toString());
                    }
                });

我错过了什么?任何帮助将不胜感激。

谢谢。

【问题讨论】:

    标签: java android dronekit mavlink dronekit-android


    【解决方案1】:

    我不熟悉 Java MAVLink 实现,但您发送的 LOCAL_POSITION_NED 消息是遥测消息,而不是控制消息。您需要发送 SET_POSITION_TARGET_LOCAL_NED,就像在 Python 中一样。

    【讨论】:

      【解决方案2】:

      [关闭问题]对于未来必须面对同样问题的程序员,这里是我的工作代码:

                  msg_set_position_target_local_ned msgMessageVelocity = new msg_set_position_target_local_ned();
              msgMessageVelocity.time_boot_ms = 0;
              msgMessageVelocity.target_system = 0;
              msgMessageVelocity.target_component = 0;
              msgMessageVelocity.coordinate_frame = MAV_FRAME.MAV_FRAME_BODY_NED;
              msgMessageVelocity.type_mask = 0b0000111111000111;
              msgMessageVelocity.x = 0;
              msgMessageVelocity.y = 0;
              msgMessageVelocity.z = 0;
              msgMessageVelocity.vx = _vx * _speed;
              msgMessageVelocity.vy = _vz * _speed;
              msgMessageVelocity.vz = _vy * _speed;
              msgMessageVelocity.afx = 0;
              msgMessageVelocity.afy = 0;
              msgMessageVelocity.afz = 0;
              msgMessageVelocity.yaw = 0;
              msgMessageVelocity.yaw_rate = 0;
      
              MavlinkMessageWrapper mavlinkMessageWrapper = new MavlinkMessageWrapper(msgMessageVelocity);
      
              ExperimentalApi.getApi(drone).sendMavlinkMessage(mavlinkMessageWrapper);
      
              drone.addMavlinkObserver(new MavlinkObserver() {
                  @Override
                  public void onMavlinkMessageReceived(MavlinkMessageWrapper mavlinkMessageWrapper) {
                      System.out.println("MESSAGE RECEIVED="+mavlinkMessageWrapper.getMavLinkMessage().toString());
                  }
              });
      

      【讨论】:

        猜你喜欢
        • 2016-09-19
        • 1970-01-01
        • 2022-11-11
        • 1970-01-01
        • 1970-01-01
        • 1970-01-01
        • 2022-12-25
        • 1970-01-01
        • 1970-01-01
        相关资源
        最近更新 更多