AnyMath 文档

Ardupilot的软件控制

此页面显示了Ardupilot的所有可用软件控制功能 AnyMath .

使用Ardupilot的软件控制功能 AnyMath ,按照在给出的说明 文章. 之后,执行:

using Main.EngeeDeviceManager.Devices.ARDUPILOT

接下来,您需要创建一个Ardupilot对象,该对象将用于与自动驾驶仪交互。:

ap = ARDUPILOT.Ardupilot()

构造函数可以使用现有连接的句柄调用。 然后对象将使用此连接而不创建新连接。:

ap = ARDUPILOT.Ardupilot(desc)

描述符由函数返回 美联社接(。..).

方法 阿杜皮洛特

ap.close()

关闭与 ArduPilot SITL 的 UDP 桥接并释放 UDP 套接字。

参数

无(该方法由 ArduPilot 对象调用)。

示例

ap = ARDUPILOT.Ardupilot()
desc = ap.connect()
# ... 数据交换 ...
ap.close()
ap.connect()
ap.connect(host, port_out, port_in, visualize_port, visual_ok)

建立与ArduPilot SITL的UDP桥接:在port_in 端口上创建UDP套接字,开始监听自动驾驶仪的PWM帧,并返回连接描述符。 作为对 PWM 帧的响应,桥接器会向自动驾驶仪发送由函数ap.send(...) 传输的传感器帧。

参数

  • host::String = "127.0.0.1" :用于打开 UDP 套接字的地址。

  • port_out::Int64 = 9002: 为兼容性保留,未使用。

  • port_in::Int64 = 9002: 桥接器用于接收ArduPilot PWM帧的UDP端口。

  • visualize_port::Int64 = 14600: 用于发送可视化数据(飞行器位置)的UDP端口。

  • visual_ok::Bool = false :当true 时,桥接器会额外将飞行器位置发送至visualize_port 。

返回值

desc::Int64 :连接描述符。将其传递给ARDUPILOT.Ardupilot(desc) 的构造函数,以便从另一个对象中使用同一连接。

示例

using Main.EngeeDeviceManager.Devices.ARDUPILOT

ap = ARDUPILOT.Ardupilot()
desc = ap.connect("127.0.0.1", 9002, 9002, 5040, true)
println("Дескриптор соединения: ", desc)
ap.receive()
ap.receive(timeout)
ap.receive(timeout, async_rpc)

返回来自 ArduPilot 最新帧的 PWM 信号。该帧包含 16 或 32 个 PWM 值;该函数将全部返回。

参数

  • timeout::Float64 = 0.01 :帧的最大等待时间(单位:秒)。

  • async_rpc::Bool = false :当设置为true 时,该函数不会等待请求完成,而是立即返回控制权。

返回值

Vector{Float64} :帧的PWM值(以脉冲持续时间的微秒为单位)。如果帧未在timeout 内到达,则返回空向量。

示例

servos = ap.receive(0.05)
if !isempty(servos)
    println("ШИМ: ", servos[1:4])
end
ap.send(timestamp, gyro, accel, position, attitude, velocity)
ap.send(timestamp, gyro, accel, position, attitude, velocity, async_rpc)

向飞行控制器发送下一帧传感器数据。该帧是作为对 ArduPilot PWM 帧(锁步)的响应而发送的:只有在接收到这帧传感器数据后,飞行控制器才会发送下一帧 PWM 数据。

参数

  • timestamp::Float64: 模型时间(单位:秒)。

  • gyro::Vector{Float64}: 角速度,弧度/秒(恰好3个分量)。

  • accel::Vector{Float64}: 关联坐标系中的加速度,米/秒²(恰好3个分量)。

  • position::Vector{Float64}: 在NED坐标系中的位置,米(恰好3个分量)。

  • attitude::Vector{Float64}: 定向角,弧度(恰好3个分量)。

  • velocity::Vector{Float64}: NED坐标系中的速度,单位为米/秒(恰好3个分量)。

  • async_rpc::Bool = false: 当true 时,该函数不会等待请求完成,而是立即返回控制权。

示例

ap.send(
    0.05,                # timestamp, s
    [0.0, 0.0, 0.1],     # gyro, rad/s
    [0.0, 0.0, -9.81],   # accel, m/s²(关联坐标系)
    [0.0, 0.0, 10.0],    # position, 米 (NED)
    [0.0, 0.1, 0.0],     # attitude, 弧度
    [0.0, 0.0, 0.0],     # velocity, 米/秒 (NED)
)