Ardupilot的软件控制
此页面显示了Ardupilot的所有可用软件控制功能 AnyMath .
|
使用Ardupilot的软件控制功能 AnyMath ,按照在给出的说明 文章. 之后,执行:
接下来,您需要创建一个Ardupilot对象,该对象将用于与自动驾驶仪交互。:
构造函数可以使用现有连接的句柄调用。 然后对象将使用此连接而不创建新连接。:
描述符由函数返回 |
方法 阿杜皮洛特
#
Main.EngeeDeviceManager.Devices.ARDUPILOT.close — Method
ap.close()
关闭与 ArduPilot SITL 的 UDP 桥接并释放 UDP 套接字。
参数
无(该方法由 ArduPilot 对象调用)。
示例
ap = ARDUPILOT.Ardupilot()
desc = ap.connect()
# ... 数据交换 ...
ap.close()
#
Main.EngeeDeviceManager.Devices.ARDUPILOT.connect — Method
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)
#
Main.EngeeDeviceManager.Devices.ARDUPILOT.receive — Method
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
#
Main.EngeeDeviceManager.Devices.ARDUPILOT.send — Method
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)
)