AirSim提供很多API接口,本文将使用python,通过这些接口实现对单个无人机简单飞行的控制。
1.python库的安装
需安装两个airsim相关的库:
pip install msgpack-rpc-python
pip install airsim
2.在Unreal中运行无人机
2.1 仿真运行
在Documents\AirSim目录下创建setting.json文件,并写入如下的内容:
{
"SettingsVersion": 1.2,
"SimMode": "Multirotor"
}
"SimMode": "Multirotor"表示仿真模式为无人机,如果修改为 "SimMode": "Car"则为汽车。
之后进入环境目录下,运行VS项目工程文件,并使用Debug Game Editor模式开始调试。启动Unreal Editor后,可点击运行按钮运行仿真。在仿真运行时不会显示鼠标,通过“shift+F1”可弹出。
2.2 初始位置设置
进入Unreal Editor后,可对无人机的初始位置进行设置。在界面右侧的“世界大纲视图”中,搜素“PlayStart”,可以看到环境中已经设定的初始位置,如存在多个,保留一个即可。在其下方的“细节”一栏中,可修改参数以调整初始位置,或在关卡中拖动以修改初始位置。
2.3 视角设置
Unreal的环境中可以切换五种不同的视角:
F键切换至FirstPersonView,第一人称视角;B键切换至FlyWithMe,跟随视角;\键切换至GroundObserver,地面观察者;/键切换至SpringArmChase,弹性机械臂跟随;M键切换至Manual,手动控制,可以通过键盘按键控制观察者的位置和视角:
方向键:前后左右的水平移动;Page Up/Page Down:上下的垂直移动;W,S:俯仰转动;A,D:偏航转动。
3.无人机飞行控制
使用python对无人机飞行控制的基本代码逻辑可以分解为以下的步骤,接下来将分别说明如何通过代码实现。
3.1 获取与无人机的连接
在第2步中已经运行无人机的基础上,通过airsim.MultirotorClient()请求与无人机的连接,建立连接后返回句柄client,并通过client.confirmConnection()检查连接情况并打印。完整代码如下所示:
import airsim
client = airsim.MultirotorClient()
client.confirmConnection()
如果是对汽车进行仿真,则使用client = airsim.CarClient()。
3.2 控制权的获取和交还
为确保安全,API控制默认不开启,故使用代码进行控制前需先获取控制权,在控制结束后交回控制权。使用client.enableApiControl()设置控制权,如输入参数为True则获取控制权,False则失去控制权。
client.enableApiControl(True) # get control
client.enableApiControl(False) # release control
3.3 无人机解锁和锁定
使用client.armDisarm()对无人机解锁和锁定,锁定后无人机旋翼停止旋转。
client.armDisarm(True) # 解锁
client.armDisarm(False) # 锁定
3.4 无人机起飞和降落
代码指令如下所示,其中.join()的作用是让该任务完全执行,再执行之后的任务,否则会被后面的任务打断。
client.takeoffAsync().join() # 起飞
client.landAsync().join() # 降落
3.5 无人机飞行
3.5.1 坐标系
无人机飞行的控制方式可以分为位置控制和速度控制两种,为实现对无人机的控制,首先需要弄清楚坐标系。
这里需要注意三个坐标系:
Unreal中的世界坐标系,即Unreal中定义的机体外部环境的坐标系,这一坐标系在Unreal Editor中被用到。其x,y,zx,y,zx,y,z三个坐标轴的指向分别为北、东、上的方向,单位长度为厘米。AriSim中的全局坐标系,即AirSim中定义的机体外部环境的坐标系,在编写setting.json文件和airsim代码时,参考的坐标系为该坐标系。其x,y,zx,y,zx,y,z三个坐标轴的指向分别北、东、下的方向,单位长度为米。AriSim中的机体坐标系,即以机身朝向定义的坐标系,x,y,zx,y,zx,y,z三个坐标轴的指向分别为机体前、右、下的方向,单位长度为米。
在编写setting.json文件和airsim代码时,应依照AirSim中的全局坐标系,且其(0,0)(0,0)(0,0)的位置为Unreal Editor中选择的PlayerStart的位置。在仿真运行时,AirSim会将坐标自动转换至Unreal中的世界坐标系。
3.5.2 位置控制
位置控制主要使用到如下的两个函数,同样可以通过.join()进行阻塞。接下来对位置控制的三个控制通道进行说明。
client.moveToZAsync()
client.moveToPositionAsync()
高度通道
moveToZAsync()用于设置无人机的高度,其可设定zzz坐标和速度两个参数,如
client.moveToZAsync(-3, 2).join()
表示设定高度为3,速度为2,由于世界坐标系zzz坐标的朝向为地,故参数为-3。
水平通道
moveToPositionAsync()用于设定无人机的水平位置,对其水平通道进行控制的用法实例为
client.moveToPositionAsync(5, 0, -3, 1).join()
表示飞往世界坐标系中(5,0,−3)(5, 0, -3)(5,0,−3)的位置,即水平位置为(5,0)(5,0)(5,0),高度为3,最后一个参数表示速度。
偏航通道
moveToPositionAsync()还可以对偏航通道进行控制,用法示例为:
drivetrain = airsim.DrivetrainType.MaxDegreeOfFreedom
yaw_mode = airsim.YawMode(True, 10)
client.moveToPositionAsync(0, 0, -3, 1, drivetrain=drivetrain, yaw_mode=yaw_mode).join()
这里用到了moveToPositionAsync()的另外两个参数:
参数drivetrain有两种模式可以设置:
airsim.DrivetrainType.ForwardOnly,表示始终朝向速度方向;
airsim.DrivetrainType.MaxDegreeOfFreedom,表示手动设置偏航方向。
参数yaw_mode为偏航的模式和参数值,有两种模式可以设置:
airsim.YawMode(True, 10),第一个参数设置为True表示设置偏航角速度,第二个参数为角速度的值;airsim.YawMode(False, 10),第一个参数设置为False表示设置偏航速度,第二个参数为角度的值;
以上两个参数可以产生四种组合:
airsim.DrivetrainType.ForwardOnly,airsim.YawMode置为True,由于第一个参数要求始终朝向速度方向,第二个参数要求无人机以一定角速度持续旋转,二者矛盾,这种情况下无人机不会执行命令。airsim.DrivetrainType.ForwardOnly,airsim.YawMode置为False,此时以无人机的速度方向为参考方向,产生角度为airsim.YawMode第二个参数的偏航角。airsim.DrivetrainType.MaxDegreeOfFreedom,airsim.YawMode置为True,第一个参数要求手动设置偏航角度,第二个参数要求设置偏航加速度,故无人机以一定的角速度旋转。airsim.DrivetrainType.MaxDegreeOfFreedom,airsim.YawMode置为False,此时以正北方向为参考方向,产生角度为airsim.YawMode第二个参数的偏航角。
3.5.3 速度控制
速度控制可通过函数moveByVelocityZAsync()或moveByVelocityAsync()实现。
moveByVelocityZAsync()函数的前2个参数为无人机在x,yx,yx,y方向的速度vx,vyvx,vyvx,vy,第三个参数为无人机在zzz方向的位置,第四个参数为飞行时间,如以下代码可实现无人机以1m/s速度、在高度3m处沿xxx方向飞3秒钟。
client.moveByVelocityZAsync(1, 0, -3, 3).join()
moveByVelocityZAsync()同样可以设置偏航,方法与位置控制中设置偏航一致。
moveByVelocityAsync()只有第三个参数与moveByVelocityZAsync()不同,其第三个参数为无人机在zzz方向的速度。
但是由于无人机达到指令所要求的速度需要一定的调整时间,而其安装该指令飞行的总时长是固定的,故使用速度控制时总会存在一定的误差,而且速度的当前值与设定值差距越大,其误差越大。
3.5.4 悬停
使用hoverAsync()函数配合延迟函数可实现悬停,如以下代码可实现悬停3s。
client.hoverAsync().join()
time.sleep(3)
整时间,而其安装该指令飞行的总时长是固定的,故使用速度控制时总会存在一定的误差,而且速度的当前值与设定值差距越大,其误差越大。
3.5.4 悬停
使用hoverAsync()函数配合延迟函数可实现悬停,如以下代码可实现悬停3s。
client.hoverAsync().join()
time.sleep(3)