【Tello无人机】使用Matlab完成控制器的设计—建模

模型辨识篇

  在实际的无人机系统中,控制器的设计至关重要,它直接影响无人机的稳定性和响应能力。然而,要设计出高效、可靠的控制器,首先必须准确理解无人机的动态行为,这就需要通过收集输入输出数据来辨识其运动学模型。运动学模型是描述无人机在空间中运动规律的数学模型,它通常包含了无人机的位置、速度、加速度以及与之相关的控制输入等参数。通过辨识运动学模型,能够理解无人机在受到不同控制输入时的响应方式,这对于控制器设计极为重要。具体来说,这个过程包括以下几个步骤:

  1. 数据采集:在实际飞行测试中,通过无人机上的传感器收集关于其位置、速度、姿态等的数据,同时记录下相应的控制输入信息,如推力、方向控制等。

  2. 模型假设:在数据分析之前,需要先建立运动学模型的基本形式。这通常涉及到选择合适的数学结构来描述无人机的运动,如线性模型、非线性模型或是混合模型等。

  3. 参数辨识:使用统计或机器学习方法,如最小二乘法、神经网络等,根据收集到的数据来估计模型的参数。这一步的目标是找到一组参数,使得模型能够尽可能准确地预测无人机的实际行为。

  4. 模型验证:通过将模型预测的结果与实际飞行数据进行对比,评估模型的准确性和可靠性。如果模型表现不佳,可能需要返回上一步调整模型结构或参数,或者收集更多数据进行分析。

完成运动学模型的辨识后就可以基于该模型设计控制器。

1.数据采集

期望速度输入:

desv_{x}=0.3\cdot cos(\theta)

desv_{y}=0.2\cdot sin(\theta)

input_data = [desv_x, desv_y]

位置差分得到速度输出:

output_{data}=[\underset{\Delta t}{real_{x}- lastreal_{x}},\underset{\Delta t}{real_{y}- lastreal_{y}}]

output_data = np.array([real_x - last_real_x, real_y - last_real_y]) / 0.001

其中0.001为采样时间

仿真环境中运动轨迹:

这样得到了无人机的输入输出速度,可进行下一步的模型辨识。

2.模型辨识

2.1数据查看

将保存的数据导入Matlab,x,y方向的输入输出速度关系如下:

2.2辨识工具箱

打开系统辨识工具箱:【System ldentification】

导入数据:选择时域

选择要导入的数据名称

成功导入:

点击Time plot查看导入的数据是否正确:

数据预处理:Matlab系统辨识工具箱提供了一系列数据预处理功能,我们这里选择去均值

  1. Select channels…:选择数据通道功能允许用户从多通道数据中选择特定的通道进行分析。适用于处理多变量系统时,当用户仅对系统中的部分变量感兴趣或需要排除某些变量的干扰时使用。
  2. Select experiments…:选择实验功能用于从数据集中选择特定的实验或数据批次进行分析。这在处理包含多个实验条件或批次的数据集时特别有用,允许用户专注于特定条件下的系统行为。
  3. Merge experiments…:合并实验功能允许用户将来自不同实验或数据批次的数据合并为一个单一数据集。这对于增加数据量以提高系统模型的鲁棒性和泛化能力特别有用。
  4. Select range…:选择范围功能使用户能够指定数据集中的特定时间范围或数据点范围进行分析。这适用于专注于特定事件或系统响应阶段的分析。
  5. Remove means:去除均值功能用于从数据中去除平均值,通常用于消除静态偏置或将数据中心化,有助于突出数据的动态变化。
  6. Remove trends:去除趋势功能用于消除数据中的线性或非线性趋势。这对于处理具有时间相关趋势的数据非常有用,可以帮助揭示系统的内在动态行为。
  7. Filter…:滤波功能允许用户应用各种滤波器来处理数据,以去除噪声或提取感兴趣的信号频段。这在数据含有高频噪声或需要分析特定频率内容时非常有用。
  8. Resample…:重采样功能用于改变数据的采样率,通过插值或降采样来适应不同的分析需求。适用于处理采样率不一致的数据或优化处理速度。
  9. Transform data…:数据转换功能提供了多种数据转换方法,如对数变换、幂律变换等,用于改善数据的统计特性或适应特定的分析方法。
  10. Quick start:快速开始指南为用户提供了一个简易的操作流程,帮助用户快速开始数据预处理,尤其适用于初学者或需要快速处理数据的场景。

将预处理完成后,需要进行辨识的数据拖入working区域:

点击【Tello无人机】使用Matlab完成控制器的设计—建模——古月居可查看全文

  • 28
    点赞
  • 25
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
此代码需要安装tellopy库和opencv-python库。 ```python import time import cv2 import tellopy # 定义手势识别函数 def gesture_recognition(): # 打开电脑摄像头 cap = cv2.VideoCapture(0) # 读取手势识别型 gesture = cv2.CascadeClassifier("gesture.xml") while True: # 读取摄像头中的图像 ret, frame = cap.read() # 灰度化处理 gray = cv2.cvtColor(frame, cv2.COLOR_BGR2GRAY) # 进行手势检测 hands = gesture.detectMultiScale(gray, 1.3, 5) # 绘制矩形框 for (x, y, w, h) in hands: cv2.rectangle(frame, (x, y), (x + w, y + h), (255, 0, 0), 2) # 显示图像 cv2.imshow("gesture recognition", frame) # 按下q键退出 if cv2.waitKey(1) & 0xFF == ord('q'): break # 释放资源 cap.release() cv2.destroyAllWindows() # 定义tello无人机控制函数 def tello_control(): # 创tello对象 drone = tellopy.Tello() # 连接tello无人机 drone.connect() # 启动视频流传输 drone.start_video() # 等待无人机准备就绪 time.sleep(1) # 打开电脑摄像头 cap = cv2.VideoCapture(0) # 读取手势识别型 gesture = cv2.CascadeClassifier("gesture.xml") # 设置飞行方向 direction = "" while True: # 读取摄像头中的图像 ret, frame = cap.read() # 灰度化处理 gray = cv2.cvtColor(frame, cv2.COLOR_BGR2GRAY) # 进行手势检测 hands = gesture.detectMultiScale(gray, 1.3, 5) # 绘制矩形框 for (x, y, w, h) in hands: cv2.rectangle(frame, (x, y), (x + w, y + h), (255, 0, 0), 2) # 判断手势 if w > h: direction = "left" if x < 200 else "right" if x > 400 else "" else: direction = "up" if y < 150 else "down" if y > 350 else "" # 显示图像 cv2.imshow("tello control", frame) # 按下q键退出 if cv2.waitKey(1) & 0xFF == ord('q'): break # 控制tello无人机飞行 if direction == "left": drone.left(30) elif direction == "right": drone.right(30) elif direction == "up": drone.up(30) elif direction == "down": drone.down(30) else: drone.hover() # 停止视频流传输 drone.stop_video() # 断开连接 drone.disconnect() # 释放资源 cap.release() cv2.destroyAllWindows() if __name__ == '__main__': # 执行手势识别函数 # gesture_recognition() # 执行tello无人机控制函数 tello_control() ``` 在代码中,手势识别函数使用OpenCV库进行手势检测,识别手势后显示在电脑屏幕上,通过判断手势的方向,将其转换为对tello无人机的控制指令。 tello无人机控制函数通过连接tello无人机,启动视频流传输,打开电脑摄像头,读取手势识别型,检测手势方向,并将其转换为对tello无人机的控制指令。最后,停止视频流传输,断开连接,释放资源。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值