CN110286688B - 一种带有机械臂的水下四旋翼无人机控制方法 - Google Patents
一种带有机械臂的水下四旋翼无人机控制方法 Download PDFInfo
- Publication number
- CN110286688B CN110286688B CN201910532949.9A CN201910532949A CN110286688B CN 110286688 B CN110286688 B CN 110286688B CN 201910532949 A CN201910532949 A CN 201910532949A CN 110286688 B CN110286688 B CN 110286688B
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- mechanical arm
- underwater
- quaternion
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 10
- 239000002131 composite material Substances 0.000 claims abstract description 9
- 239000013598 vector Substances 0.000 claims description 53
- 239000011159 matrix material Substances 0.000 claims description 19
- 238000006243 chemical reaction Methods 0.000 claims description 15
- 238000005259 measurement Methods 0.000 claims description 10
- 230000004927 fusion Effects 0.000 claims description 9
- 239000002390 adhesive tape Substances 0.000 claims description 6
- 125000000484 butyl group Chemical group [H]C([*])([H])C([H])([H])C([H])([H])C([H])([H])[H] 0.000 claims description 5
- 230000009466 transformation Effects 0.000 claims description 5
- NIXOWILDQLNWCW-UHFFFAOYSA-N acrylic acid group Chemical group C(C=C)(=O)O NIXOWILDQLNWCW-UHFFFAOYSA-N 0.000 claims description 4
- 238000000576 coating method Methods 0.000 claims description 4
- 238000004891 communication Methods 0.000 claims description 4
- 229920000049 Carbon (fiber) Polymers 0.000 claims description 3
- 239000004917 carbon fiber Substances 0.000 claims description 3
- 239000011248 coating agent Substances 0.000 claims description 3
- 229920001971 elastomer Polymers 0.000 claims description 3
- 210000001145 finger joint Anatomy 0.000 claims description 3
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 2
- 230000001133 acceleration Effects 0.000 description 15
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 8
- 238000013461 design Methods 0.000 description 5
- 238000001914 filtration Methods 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- SMZOUWXMTYCWNB-UHFFFAOYSA-N 2-(2-methoxy-5-methylphenyl)ethanamine Chemical compound COC1=CC=C(C)C=C1CCN SMZOUWXMTYCWNB-UHFFFAOYSA-N 0.000 description 1
- 229910001069 Ti alloy Inorganic materials 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 229920005549 butyl rubber Polymers 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 239000003973 paint Substances 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 239000002994 raw material Substances 0.000 description 1
- 238000004078 waterproofing Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种带有机械臂的水下四旋翼无人机控制方法,在无人机水下飞行的基础上做出了水下应用的创新,提出了无人机机身与机械臂协同控制的方法,并提出了一种带有机械臂的水下无人机机械结构。相较于现有技术大多为单纯无人机水下飞行控制技术,本发明提供水下无人机的复合实时更新反馈动力学模型控制方法,以拓宽了水下无人机的应用前景,在水下无人机应用方面技术优势明显,具备更好的实用性。
Description
技术领域
本发明涉及无人机控制技术领域,具体涉及一种带有机械臂的水下四旋翼无人机控制方法。
背景技术
带有机械臂的水下无人机是一种在某种环境下可以依靠水下摄影实现侦查及抓取的机器人:主要应用复杂工作环境中,在特殊环境勘探、取样和灾害探测等领域具有重要应用。
在目前的水下无人机运动控制中,由于水下无人机的姿态平衡控制难度较高,目前市面上大部分的水下无人机仅能实现无人机水下飞行,无法实现附带设备时稳定姿态平衡控制,这样会导致水下无人机上的附带设备无法正常工作,故目前水下无人机无法有效控制携带的抓取设备,只能粗略勘探不能取样。
因此,如何提供一种能够协同控制无人机机身及附带设备的水下无人机控制方法是本领域技术人员目前需要解决的技术问题。
发明内容
本发明的目的是提供一种带有机械臂的水下四旋翼无人机控制方法,保证水下无人机的稳定飞行要求,同时结合机械臂控制实现水下无人机勘探、取样一步化,解决目前存在的技术问题。
为了实现上述任务,本发明采用以下技术方案:
一种带有机械臂的水下四旋翼无人机控制方法,包括以下步骤:
通过无人机上的三轴陀螺仪得到无人机机体旋转的角速度,利用四元数求出无人机的旋转矩阵,根据旋转矩阵与无人机角速度的转换关系,不断以角速度实时更新四元数;利用四元数与欧拉角的转换公式,求出当前无人机的姿态角;将无人机上的三轴加速度计与三轴磁力计的测量向量反馈给旋转矩阵,从而得出姿态角的理想输出,以理想输出与实际输出的向量积作为误差,通过PI控制器将此误差加至利用角速度实时更新四元数的过程中,进行数据融合从而不断更新四元数,建立起无人机的位姿动力学模型;基于位姿动力学模型,继续进行四元数及姿态角的更新,更新过程中加入扩展卡尔曼滤波器,对四元数进行动态估计,以此补偿水下GPS信号不准确产生的误差,最后结合PID控制来实现对水下无人机位姿的控制;
以一个二自由度爪型机械臂作为飞行载荷,机械臂具有两个关节,机械臂的手指部分用橡胶覆盖,其中2个机械手指是一体且静止的,另一个活动的机械手指在舵机的带动下运动,从而实现对物体的抓握与释放;将机械臂固定在无人机的质心上,使机械臂搭载稳定;
用DH法设计该机械臂的DH参数表如下:
θ<sub>r</sub> | d | a | α<sub>r</sub> | |
A1 | 90° | 0 | 0 | 0 |
A2 | 180° | 0 | 2L | 90° |
其中,A1,A2表示机械臂的两个关节,θr表示机械臂关节旋转变量,d表示关节滑动的变量,a表示关节偏移,αr表示关节扭转,L为无人机质心到机械臂质心的距离;
由DH参数表变换顺序θr,d,a,αr可得出无人机坐标系和机械臂坐标系间的齐次变换矩阵,继而得到机械臂的末端位姿方程;
通过设置无人机位置向量和机械臂位置向量之间的转换关系,从而得到机械臂的位置;根据所述的位姿方程以及机械臂的位置,以实现对机械臂的控制。
进一步地,所述的无人机位置向量和机械臂位置向量之间的转换关系为:
其中,Ak、Al为无人机位置向量和机械臂位置向量,L为无人机质心到机械臂质心的距离,θl为机械臂与x轴的夹角,所述的x轴平行于水平面。
进一步地,所述的扩展卡尔曼滤波器采用分布式滤波结构,以增加无人机控制的稳定性。
进一步地,所述的三轴陀螺仪采用四分布设计,在无人机的机舱内四个角处各设置一个,将四个三轴陀螺仪的信息融合后的数据作为三轴陀螺仪输出数据。
进一步地,所述的无人机的飞控单元、无线通信设备放入到碳纤维轻型复合材料耐压仓中,导线及各接口处用丁基防水胶带缠绕,缝隙处用丙烯酸防水涂料做防渗处理。
本发明具有以下技术特点:
本发明在无人机水下飞行的基础上做出了水下应用的创新,提出了无人机机身与机械臂协同控制的方法,并提出了一种带有机械臂的水下无人机机械结构。相较于现有技术大多为单纯无人机水下飞行控制技术,本发明提供水下无人机的复合实时更新反馈动力学模型控制方法,以拓宽了水下无人机的应用前景,在水下无人机应用方面技术优势明显,具备更好的实用性。
附图说明
图1为水下无人机机身的飞行控制流程图,输入初始位置,融合无人机飞行姿态复合信息,通过位置控制及姿态控制来实现无人机水下稳定飞行。
图2为水下无人机各模块的信息交互方法,通过设置飞控单元实现对机械臂等附带设备,电机等无人机机身设备,无人机飞行姿态及无人机通讯模块的控制。
图3为无人机携带机械臂的x-z平面图与三维立体图,基于此可实现机械臂的三维建模,DH表设置,正运动学推导。
图4为带有机械臂的水下无人机的整体结构示意图。
具体实施方式
本发明公开了一种带有机械臂的水下四旋翼无人机控制方法,包括以下步骤:
通过无人机上的三轴陀螺仪可得到无人机机体旋转的角速度如下:
wb=[wbx wby wbz]T其中,wbx,wby,wbz分别表示在x、y、z方向上的角速度;四元数表示为:其中,q1,q2,q3,q4为四元数参数,b为向量在无人机坐标系中的表示,e为向量在地心固定坐标系中的表示;
由四元数求出无人机的旋转矩阵如下:
通过旋转矩阵与无人机角速度的转换关系不断以角速度实时更新四元数;
其中,旋转矩阵与无人机角速度的转换关系如下:
通过四元数与欧拉角的转换公式,进而求出当前无人机的姿态角如下:
φ=arcsin[2(q0q2-q1q3)]
其中φ为俯仰角,θ为横滚角,ψ为偏航角;
在角度非奇异时,四元数与欧拉角的转换公式如下:
通过姿态角得出理想输出,把理想输出与实际输出的向量积作为误差,通过PI调节将误差加至陀螺仪的累加过程中进行数据融合不断更新四元数:
将无人机上的三轴加速度计与三轴磁力计的测量向量反馈给旋转矩阵,从而得出姿态角向量的理想输出,以理想输出(接收反馈进行融合后计算出的姿态角向量)与实际输出(未接收反馈计算出的姿态角向量)向量积作为误差,通过PI控制器将此误差加至利用角速度wb实时更新四元数的过程中进行数据融合不断更新四元数,建立起复合水下无人机的位姿动力学模型;其中磁力计使用多传感器进行局部融合更新使得反馈值更准确。具体反馈过程如下:
三轴加速度计的的测量模型如下:
三轴磁力计的测量模型如下:
将大地坐标系的理论加速度ag=[0 0 g]T(g为重力加速度)向量经过欧拉旋转转换至无人机机体坐标系上,即将地心固定坐标系中的理论加速度ag转换为本地NED坐标系中的加速度an,再将本地NED坐标系中的加速度an转换为机体轴坐标系中的加速度将与三轴加速度计的测量向量融合后得到无人机加速度的理想理论值,利用无人机上加速度计的输出值与无人机的理想理论值加速度的向量积作为误差输入到PI控制器(此处的误差为无人机机体坐标系中融入大地坐标系的理论加速度后的加速度向量误差,与之前无人机机体坐标系中姿态角向量误差不同),由于单纯使用三轴加速度计无法提取到偏航方向的角度,所以引入三轴磁力计根据无人机磁场向量变换解出偏航方向的角度,再经过PI控制器补偿至陀螺仪上,从而建立起复合水下无人机的位姿动力学模型如下:
基于上述动力学模型继续进行四元数及姿态角的更新。由于水下GPS信号较差,测量信息有较大误差,在四元数及姿态角的更新过程中,即GPS,INS(惯性导航***动态模型)与输出的无人机位置,速度之间加入扩展卡尔曼滤波器对四元数进行动态估计,以此补偿水下GPS信号不准确产生的误差,最后结合PID控制来实现对水下无人机位姿的控制。扩展卡尔曼滤波模型如下:
考虑以下***模型:
其中xk是k时刻的无人机的状态向量,wk是过程噪声向量,yk是测量输出向量,vk是测量噪声向量,fk(xk,aant,n)与hk(xk)是导航***运动学相关的线性或非线性函数,aant,n为本地NED轴系固有加速度。
预测阶段:利用前一步结果预估当前时刻状态,具体如下:
校正阶段:结合当前观测信息对当前预估状态进行校正,具体如下:
Pk|k=(I-KkHk)Pk|k-1
基于加速度计的航姿参考***扩展卡尔曼滤波器设计如下:
1.将状态向量和误差协方差矩阵初始化
2.设置噪声协方差矩阵Q和R
3.以50HZ的频率对四元数进行估计和校正,其中初始加速度数据由初始加速度计给出
4.每次迭代基于欧拉角计算公式更新欧拉角φ,θ,ψ。
基于磁力计的多传感器局部融合反馈(对应三轴磁力计根据无人机磁场向量变换解出偏航方向的角度,再经过PI控制器补偿至陀螺仪上,由于单个磁力计在测量过程中误差较大,所以考虑使用多传感器进行姿态融合),扩展卡尔曼滤波在设计时考虑为分布式滤波结构,这使得整个无人机飞行控制***更具稳定性。
陀螺仪***采用四分布式设计,即在水下无人机长方体机舱内四个角处各设置一个陀螺仪传感器,四个传感器信号融合后由飞控单元做出判断。
以一个二自由度爪型机械臂作为飞行载荷,机械臂具有两个关节,手指部分用高摩擦橡胶覆盖,其中2个手指是一体且静止的,另一个活动的机械手指在舵机的带动下运动,从而实现对物体的抓握与释放;将机械臂固定在无人机的质心上,使机械臂搭载稳定,机械臂的关节具体设计如下:
其中,参数的下标x,y,z表示该参数在x,y,z方向上的向量。
若(机械臂)坐标系T的中心不在固定参考坐标系(无人机坐标系)的原点,在坐标系T原点与参考坐标系原点之间做一个向量,以此来表示该坐标系的位置;这个向量可由相对于参考坐标系的三个分量来表示,这个坐标系可由这三个分量及第四个位置向量表示如下:
其中{Px Py Pz 1}T即为第4个位置向量。
用DH法设计该机械臂的DH参数表如下:
θ<sub>r</sub> | d | a | α<sub>r</sub> | |
A1 | 90 | 0 | 0 | 0 |
A2 | 180 | 0 | 2L | 90 |
其中,A1,A2表示机械臂的两个关节,关节1的转角范围0°~90°,关节2的转角范围0°~180°;θr表示机械臂关节旋转的变量(为了与无人机欧拉角区分,带字母r表示机械臂),d表示关节滑动的变量,a表示关节偏移,αr表示关节扭转,L为无人机质心到机械臂质心的距离。
机械臂正运动学推导如下:
由DH参数表变换顺序θr,d,a,αr可得出无人机坐标系和机械臂坐标系间的齐次变换矩阵为:
其中,参数的下标i表示在i时刻该参数的值。
则机械臂的末端位姿方程如下:
T=0T1 1T2
为了更好的实现无人机正常飞行和机械臂的稳定控制,考虑附图3中的无人机x-z平面图(x为平行于水平面方向,z为垂直于水平面方向),分别将Ak、Al作为无人机和机械臂的位置向量,通过设置无人机位置向量和机械臂位置向量之间的转换关系从而通过无人机的位置向量和机械臂与x轴的夹角即可得到机械臂的位置,以实现对机械臂位置的确定;根据机械臂的末端位姿方程、机械臂的位置,通过无人机的飞控单元在实现无人机位姿控制的同时,对机械臂进行协同控制。转换关系如下:
其中L为无人机质心到机械臂质心的距离,θl为机械臂与x轴的夹角。
无人机机身防水采用如下方案:将飞控单元、无线通信设备和电调等模块集中放入碳纤维轻型复合材料耐压仓中,导线及各接口处用丁基防水胶带缠绕,缝隙处用丙烯酸防水涂料做防渗处理。轻型复合材料防水仓比传统钛合金等防水仓重量减少40%-60%,便于无人机机身携带。丁基防水胶带以丁基橡胶为主要原料,其终生不固化,故对被粘物表面热胀冷缩和机械形变有极佳的追随性。
驱动电机:采用飓风系列等防水无刷电机,该电机为IPX-7防水电机,可放置1米水深,浸泡30分钟,电机可以正常使用,不受影响。
机械臂防水:用防水胶带包裹机械臂,接口处用丙烯酸防水涂料做防渗处理。防水涂料固化后形成的防水薄膜具有一定的延伸性、弹塑性及抗裂性等属性,可以起到防水、防渗作用。
摄像头防水:采用市面上常用的运动防水摄像机。
通过以上防水设计,利用以上设计的控制方法,使得无人机可实现浅水飞行、侦查,加装的机械臂可以在水下柔性工作。
Claims (5)
1.一种带有机械臂的水下四旋翼无人机控制方法,其特征在于,包括以下步骤:
通过无人机上的三轴陀螺仪得到无人机机体旋转的角速度,利用四元数求出无人机的旋转矩阵,根据旋转矩阵与无人机角速度的转换关系,不断以角速度实时更新四元数;利用四元数与欧拉角的转换公式,求出当前无人机的姿态角;将无人机上的三轴加速度计与三轴磁力计的测量向量反馈给旋转矩阵,从而得出姿态角的理想输出,以理想输出与实际输出的向量积作为误差,通过PI控制器将此误差加至利用角速度实时更新四元数的过程中,进行数据融合从而不断更新四元数,建立起无人机的位姿动力学模型;基于位姿动力学模型,继续进行四元数及姿态角的更新,更新过程中加入扩展卡尔曼滤波器,对四元数进行动态估计,以此补偿水下GPS信号不准确产生的误差;最后结合PID控制来实现对水下无人机位姿的控制;
以一个二自由度爪型机械臂作为飞行载荷,机械臂具有两个关节,机械臂的手指部分用橡胶覆盖,机械手指的数量为3个,其中2个机械手指是一体且静止的,另一个活动的机械手指在舵机的带动下运动,从而实现对物体的抓握与释放;将机械臂固定在无人机的质心上,使机械臂搭载稳定;
用DH法设计该机械臂的DH参数表如下:
其中,A1,A2表示机械臂的两个关节,θr表示机械臂关节旋转变量,d表示关节滑动的变量,a表示关节偏移,αr表示关节扭转,L为无人机质心到机械臂质心的距离;
由DH参数表变换顺序θr,d,a,αr可得出无人机坐标系和机械臂坐标系间的齐次变换矩阵,继而得到机械臂的末端位姿方程;
通过设置无人机位置向量和机械臂位置向量之间的转换关系,从而得到机械臂的位置;根据所述的位姿方程以及机械臂的位置,以实现对机械臂的控制。
3.如权利要求1所述的带有机械臂的水下四旋翼无人机控制方法,其特征在于,所述的扩展卡尔曼滤波器采用分布式滤波结构,以增加无人机控制的稳定性。
4.如权利要求1所述的带有机械臂的水下四旋翼无人机控制方法,其特征在于,所述的三轴陀螺仪采用四分布设计,在无人机的机舱内四个角处各设置一个,将四个三轴陀螺仪的信息融合后的数据作为三轴陀螺仪输出数据。
5.如权利要求1所述的带有机械臂的水下四旋翼无人机控制方法,其特征在于,所述的无人机的飞控单元、无线通信设备放入到碳纤维轻型复合材料耐压仓中,导线及各接口处用丁基防水胶带缠绕,缝隙处用丙烯酸防水涂料做防渗处理。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910532949.9A CN110286688B (zh) | 2019-06-19 | 2019-06-19 | 一种带有机械臂的水下四旋翼无人机控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910532949.9A CN110286688B (zh) | 2019-06-19 | 2019-06-19 | 一种带有机械臂的水下四旋翼无人机控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110286688A CN110286688A (zh) | 2019-09-27 |
CN110286688B true CN110286688B (zh) | 2021-03-16 |
Family
ID=68003930
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910532949.9A Active CN110286688B (zh) | 2019-06-19 | 2019-06-19 | 一种带有机械臂的水下四旋翼无人机控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110286688B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111722452B (zh) * | 2020-06-29 | 2022-07-12 | 烟台艾睿光电科技有限公司 | 一种红外产品的防抖稳像方法、装置、设备及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106569502A (zh) * | 2016-05-20 | 2017-04-19 | 上海铸天智能科技有限公司 | 多旋翼飞行器抓捕目标后的复合体姿态自适应控制方法 |
CN107139178A (zh) * | 2017-05-10 | 2017-09-08 | 哈尔滨工业大学深圳研究生院 | 一种无人机及其基于视觉的抓取方法 |
CN107968915A (zh) * | 2017-12-04 | 2018-04-27 | 国网山东省电力公司电力科学研究院 | 水下机器人摄像机云台实时控制***及其方法 |
CN108327874A (zh) * | 2018-02-11 | 2018-07-27 | 河海大学常州校区 | 一种多功能水下航行器及其控制方法 |
CN108469829A (zh) * | 2018-03-05 | 2018-08-31 | 黄相贤 | 一种无人机的稳定型控制方式及控制算法 |
WO2019024541A1 (zh) * | 2017-08-04 | 2019-02-07 | 深圳市道通智能航空技术有限公司 | 一种机臂及无人机 |
CN109895099A (zh) * | 2019-03-28 | 2019-06-18 | 哈尔滨工业大学(深圳) | 一种基于自然特征的飞行机械臂视觉伺服抓取方法 |
-
2019
- 2019-06-19 CN CN201910532949.9A patent/CN110286688B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106569502A (zh) * | 2016-05-20 | 2017-04-19 | 上海铸天智能科技有限公司 | 多旋翼飞行器抓捕目标后的复合体姿态自适应控制方法 |
CN107139178A (zh) * | 2017-05-10 | 2017-09-08 | 哈尔滨工业大学深圳研究生院 | 一种无人机及其基于视觉的抓取方法 |
WO2019024541A1 (zh) * | 2017-08-04 | 2019-02-07 | 深圳市道通智能航空技术有限公司 | 一种机臂及无人机 |
CN107968915A (zh) * | 2017-12-04 | 2018-04-27 | 国网山东省电力公司电力科学研究院 | 水下机器人摄像机云台实时控制***及其方法 |
CN108327874A (zh) * | 2018-02-11 | 2018-07-27 | 河海大学常州校区 | 一种多功能水下航行器及其控制方法 |
CN108469829A (zh) * | 2018-03-05 | 2018-08-31 | 黄相贤 | 一种无人机的稳定型控制方式及控制算法 |
CN109895099A (zh) * | 2019-03-28 | 2019-06-18 | 哈尔滨工业大学(深圳) | 一种基于自然特征的飞行机械臂视觉伺服抓取方法 |
Non-Patent Citations (3)
Title |
---|
Cartesian Impedance Control of a UAV with a Robotic Arm;PRISMA Lab等;《IFAC》;20120907;第704-709页 * |
基于滑模PID的飞行机械臂稳定性控制;刘云平 等;《南京理工大学学报》;20181031;第42卷(第5期);第525-532页 * |
基于蚁群算法的水下机器人机械臂工作路径优化;林树锋 等;《水下无人***学报》;20190228;第27卷(第1期);第45-50页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110286688A (zh) | 2019-09-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106643737B (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
Cavallo et al. | Experimental comparison of sensor fusion algorithms for attitude estimation | |
CN110125936B (zh) | 一种空间机器人的地面实验验证*** | |
CN103363992B (zh) | 基于梯度下降的四旋翼无人机姿态航向参考***解算方法 | |
CN112630813B (zh) | 基于捷联惯导和北斗卫星导航***的无人机姿态测量方法 | |
WO2019024303A1 (zh) | 一种基于有限时间神经动力学的多旋翼无人飞行器的稳定飞行控制方法 | |
CN105203098A (zh) | 基于九轴mems传感器的农业机械全姿态角更新方法 | |
CN106293103B (zh) | 基于惯性传感器的四轴飞行器手势控制装置和控制方法 | |
CN111189442B (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN106767767A (zh) | 一种微纳多模星敏感器***及其数据融合方法 | |
CN106052685A (zh) | 一种两级分离融合的姿态和航向估计方法 | |
CN110017837A (zh) | 一种姿态抗磁干扰的组合导航方法 | |
CN112558621A (zh) | 一种基于解耦控制的飞行机械臂*** | |
CN110793515A (zh) | 一种基于单天线gps和imu的大机动条件下无人机姿态估计方法 | |
CN111506095A (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN110286688B (zh) | 一种带有机械臂的水下四旋翼无人机控制方法 | |
CN112284379B (zh) | 一种基于非线性积分补偿的组合运动测量***的惯性预积分方法 | |
CN111625768A (zh) | 一种基于扩展卡尔曼滤波的手持云台姿态估计方法 | |
Li et al. | Quaternion-based robust extended Kalman filter for attitude estimation of micro quadrotors using low-cost MEMS | |
Zhang et al. | Research on UAV attitude data fusion algorithm based on quaternion gradient descent | |
Dai et al. | Unsupervised feature fusion combined with neural network applied to UAV attitude estimation | |
Zhang et al. | An improved Kalman filter for attitude determination of multi-rotor UAVs based on low-cost MEMS sensors | |
Kamali et al. | Multiplicative error state Kalman filter vs nonlinear complimentary filter for a high performance aircraft attitude estimation | |
Kashkul et al. | Variable structure control of quadrotor based on position input | |
CN117742364B (zh) | 含姿态规划器的四旋翼无人机的轨迹跟踪控制方法及*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |