CN110032208B - 一种用于水下侦查与摄影无人机及其控制方法 - Google Patents
一种用于水下侦查与摄影无人机及其控制方法 Download PDFInfo
- Publication number
- CN110032208B CN110032208B CN201910417180.6A CN201910417180A CN110032208B CN 110032208 B CN110032208 B CN 110032208B CN 201910417180 A CN201910417180 A CN 201910417180A CN 110032208 B CN110032208 B CN 110032208B
- Authority
- CN
- China
- Prior art keywords
- speed
- motor
- target
- unmanned aerial
- aerial vehicle
- 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 17
- 238000011835 investigation Methods 0.000 title abstract description 14
- 230000001105 regulatory effect Effects 0.000 claims abstract description 88
- 238000012937 correction Methods 0.000 claims description 76
- 238000001514 detection method Methods 0.000 claims description 15
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 238000011217 control strategy Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 3
- 238000013139 quantization Methods 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000009189 diving Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Telescopes (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种用于水下侦查与摄影的无人机,包括:壳体;旋转支撑臂,其一端可旋转支撑在所述壳体一侧;多个螺旋桨,其可旋转支撑在所述旋转支撑臂另一端,并能够随所述旋转支撑臂偏转;调速电机,其设置在所述壳体内,连接并带动所述螺旋桨旋转;步进电机,其连接所述旋转支撑臂,并能够驱动所述旋转支撑臂偏转;摄影机,设置在所述壳体顶部;中央控制器,其连接所述驱动电机和所述步进电机,由步进电机驱动旋转支撑臂带动螺旋桨旋转,并有调速电机带动螺旋桨旋转,可以由螺旋桨带动壳体在水下环境进行拍摄,结构简单,控制方便,还设计开发了一种用于水下侦查与摄影的无人机控制方法。
Description
技术领域
本发明涉及无人机领域,更具体的是,本发明涉及一种用于水下侦查与摄影的无人机及控制方法。
背景技术
国内无人机市场已发展了将近30余年,水下无人机,也被成为水下机器人。最初,水下机器人被用于军事、科考等领域。近年,水下机器人开始在渔业环境检测、潜水娱乐等消费级市场兴起,但相比于无人机在技术和产品上都较为成熟并已被消费级市场接受相比,水下机器人在技术和产品形态上都有待开发。
发明内容
本发明设计开发了一种用于水下侦查与摄影的无人机,由步进电机驱动旋转支撑臂带动螺旋桨旋转,并有调速电机带动螺旋桨旋转,可以由螺旋桨带动壳体在水下环境进行拍摄,结构简单,控制方便。
本发明还设计开发了一种用于水下侦查与摄影的无人机控制方法,通过两个闭环PID控制器精准控制步进电机的转角和调速电机转速,实现无人机水下行驶的精准控制,提高了无人机的行驶稳定性。
本发明提供的技术方案为:
一种用于水下侦查与摄影的无人机,包括:
壳体;
左前旋转支撑臂,其一端可旋转支撑在所述壳体一侧;
左后旋转支撑臂,其一端可旋转支撑在所述壳体一侧,并与所述左前旋转支撑臂平行设置;
右前旋转支撑臂,其一端可旋转支撑在所述壳体另一侧;
右后旋转支撑臂,其一端可旋转支撑在所述壳体另一侧,并与所述右前旋转支撑臂平行设置;
多个螺旋浆,其可旋转支撑在所述旋转支撑臂另一端,并能够随所述旋转支撑臂偏转;
调速电机,其设置在所述壳体内,连接并带动所述螺旋桨旋转;
步进电机,其连接所述旋转支撑臂,并能够驱动所述旋转支撑臂偏转;
摄影机,设置在所述壳体顶部;
中央控制器,其连接所述驱动电机和所述步进电机。
优选的是,所述中央控制器包括:
三轴陀螺仪,其设置在所述壳体内,用于检测所述无人机在水中的行驶姿态;
三轴传感器,其设置在所述壳体内,用于检测所述无人机的行驶加速度;
三轴磁强计,其设置在所述壳体内,用于检测所述无人机的潜入深度;
第一PID控制器,其连接所述三轴陀螺仪、三轴传感器和所述三轴磁强计,得到无人机的行驶姿态,并进行解析,进而控制所述调速电机的转速;
第二PID控制器,其连接所述三轴陀螺仪、三轴传感器和所述三轴磁强计,得到无人机的行驶姿态,并进行解析,进而控制所述步进电机的转角。
一种用于水下侦查与摄影无人机的控制方法,包括:
建立三维笛卡尔检测坐标系,实时检测无人机的潜入深度,实时检测无人机的偏转角:
其中,ψ为航向角,为横滚角,ω为俯仰角,/> δ0为无人机旋转幅度,lix为无人机质心到检测坐标系x轴的距离,liy为无人机质心到检测坐标系y轴的距离,liz为无人机质心到检测坐标系z轴的距离;
并通过目标深度计算调速电机目标的目标转速:
其中,为左前调速电机的目标转速,/>为右前调速电机的目标转速,/>为左后调速电机的目标转速,/>为右后调速电机的目标转速,n1为左前调速电机的实时转速,n2为右前调速电机的实时转速,n3为左后调速电机的实时转速,n4为右后调速电机的实时转速,k为转动系数,j为量化系数,/>为目标深度,Hq为潜入深度,L为螺旋桨中心到质心的距离;
根据所述调速电机的目标转速,计算调速电机的目标输入电压;
将调速电机的理想输入电压、实际输入电压之差和电压差变化率输入第一PID控制器,输出为调速电机输出电压的控制策略;
通过无人机的目标航向角,计算步进电机的目标
其中,为左前步进电机的目标转角,/>右前步进电机的目标转角,/>左后步进电机的目标转角,/>为右后步进电机的目标转角,/>为无人机的目标航向角,ψ为无人机的实时航向角,c为转换系数;
将无人机的目标转角、实际转角之差和转动角速度输入第二PID控制器,输出为支撑臂转角的控制策略,即为步进电机转动角度。
优选的是,还包括对所述无人机的潜入深度检测校正:
其中,Hq为潜入深度,G为校正因数,S为磁强计检测到的嵌入深度,L为螺旋桨中心到质心的距离,n为无人机螺旋桨个数。
优选的是,所述第一PID控制器包括电压环控制器和压差变化率环控制器;
所述电压环控制器的输入为给定的目标输入电压与调速电机的实际输入电压之差,即为电压差,所述电压环控制器的输出为调速电机的目标压差变化率;
将所述调速电机的目标压差变化率与所述调速电机的实际压差变化率之差输入压差变化率环控制器,所述转速环控制器输出为调速电机输入电压的目标控制幅度,实现螺旋浆的转速控制。
优选的是,所述第二PID控制器包括转角环控制器和转动角速度环控制器;
将所述步进电机的目标转角与所述步进电机的实际转角之差输入转角环控制器,即为角度差,所述转角环控制器输出为目标转动角速度;
所述转动角速度控制器的输入为给定的目标转动角速度与支撑臂的实际转动角速度之差,即为角速度误差,所述转动角速度环控制器的输出为角速度控制幅度,实现支撑臂转角的控制。
优选的是,所述调速电机的目标输入电压的计算公式为:
其中,为左前调速电机输出电压,/>为右前调速电机输出电压,/>为左后调速电机输出电压,/>为右后调速电机输出电压,/>为左前调速电机转速,/>为右前调速电机转速,/>为左后调速电机转速,/>为右后调速电机转速;kn为调速电机转速n,i=1,2,3,4;与对应螺旋桨推动力之间的转换系数,L为螺旋桨中心到机体质心的距离。
优选的是,所述电压环控制器PID控制算法公式为:
其中,U(t)为输出的调速电机压差变化率控制幅度,kp为电压环控制器的比例项修正系数,ki为电压环控制器的积分项修正系数,kd为电压环控制器的微分项修正系数,ec(t)为给定的目标输入电压与调速电机的实际输入电压之差;
所述压差变化率环控制器PID控制算法公式为:
其中,P(t)为输出的目标电压控制幅度,ki-p为压差变化率环控制器的比例项修正系数,ki-i为压差变化率环控制器的积分项修正系数,ki-d为压差变化率环控制器的微分项修正系数,ep(t)为给定的目标电压变化率与调速电机的实际电压变化率之差;
所述转角环控制器PID控制算法公式为:
其中,α(t)为输出的转角电机角速度控制幅度,ko-p转角环控制器的比例项修正系数,ko-i为转角环控制器的积分项修正系数,ko-d为转角环控制器的微分项修正系数,eo(t)为给定的步进电机的目标转角与所述步进电机的实际转角之差;
所述转动角速度环控制器PID控制算法公式为:
其中,θ(t)为输出的转角电机角度控制幅度,kz-p转动角速度环控制器的比例项修正系数,kz-i为转动角速度环控制器的积分项修正系数,kz-d为转动角速度环控制器的微分项修正系数,ez(t)为给定的目标转动角速度与支撑臂的实际转动角速度之差。
优选的是,还包括专家控制规则:
但时,/>
其中,为调速电机的目标输入电压,Ui为速电机的实际输入电压,pm为变化比例系数,im为积分比例系数,dm为微分比例系数,δ为时间变化系数,k′p为规则电压环控制器的比例项修正系数,k′i为规则电压环控制器的积分项修正系数,k′d为规则电压环控制器的微分项修正系数;
当时,/>
其中,为调速电机的目标电压变化率,Pi为调速电机的实际电压变化率,δ为时间变化系数,k′i-p为规则压差变化率环控制器的比例项修正系数,k′i-i为规则压差变化率环控制器的积分项修正系数,k′i-d为规则压差变化率环控制器的微分项修正系数,ep(t)为给定的目标电压变化率与调速电机的实际电压变化率之差;
当时,/>
其中,为转角电机的目标转角,αi转角电机的实际转角,δ为时间变化系数,k′o-p为规则转角环控制器的比例项修正系数,k′o-i为规则转角环控制器的积分项修正系数,k′o-d为规则转角环控制器的微分项修正系数,eo(t)为给定的步进电机的目标转角与所述步进电机的实际转角之差
当时,/>
其中,为转角电机的目标角速度,θi为转角电机的实际角速度,k′z-p为规则转动角速度环控制器的比例项修正系数,k′z-i为规则转动角速度环控制器的积分项修正系数,k′z-d为规则转动角速度环控制器的微分项修正系数,ez(t)为给定的目标转动角速度与支撑臂的实际转动角速度之差。
本发明所述的有益效果
本发明设计开发了一种用于水下侦查与摄影的无人机,由步进电机驱动旋转支撑臂带动螺旋桨旋转,并有调速电机带动螺旋桨旋转,可以由螺旋桨带动壳体在水下环境进行拍摄,结构简单,控制方便。本发明还设计开发了一种用于水下侦查与摄影的无人机控制方法,通过两个闭环PID控制器精准控制步进电机的转角和调速电机转速,实现无人机水下行驶的精准控制,提高了无人机的行驶稳定性。
附图说明
图1为本发明所述的用于水下侦查与摄影的无人机的结构示意图。
图2为本发明所述的中央控制器的结构框图。
图3为本发明所述的第一PID控制器流程图。
图4为本发明所述的第二PID控制器流程图。
图5为本发明所述的双闭环PID专家姿态角控制系统结构框架示意图。
具体实施方式
下面结合附图对本发明做进一步的详细说明,以令本领域技术人员参照说明书文字能够据以实施。
如图1所示,本发明提供的用于水下侦查与摄影的无人机,包括:壳体100、旋转支撑臂200、多个螺旋浆300、调速电机400、步进电机500和中央控制器600。
其中,旋转支撑臂200为4个包括:左前旋转支撑臂210、左后旋转支撑臂220、右前旋转支撑臂230和右后旋转支撑臂240。左前旋转支撑臂210一端可旋转支撑在壳体100一侧;左后旋转支撑臂220的一端可旋转支撑在壳体220,与左前旋转支撑臂210平行设置;右前旋转支撑臂230的一端可旋转支撑在壳体100的另一侧;右后旋转支撑臂240一端可旋转支撑在所述壳体100另一侧,并与右前旋转支撑臂240平行设置。
多个螺旋浆300包括:左前螺旋桨310、左后螺旋桨320、右前螺旋桨330和右后螺旋桨340,分别旋转支撑在旋转支撑臂200的另一端,并能够随旋转支撑臂偏转;
调速电机400包括:左前调速电机410、左后调速电机420、右前调速电机430和右后调速电机440,调速电机400设置在所述壳体内,分别连接并带动螺旋桨300旋转;
步进电机500包括:左前步进电机510、左后步进电机520、右前步进电机530和右后步进电机540其连接旋转支撑臂200,并能够驱动旋转支撑臂200偏转;
摄影机700设置在壳体100的顶部,采用鱼眼摄像机,摄像机像素在1200万以上,摄像机安装在无人机前部,可实现180°角度范围内的监控及拍摄,摄像头所取景的图像经过摄像机内部主芯片将球面图像进行修正和展开处理,转化为适合人眼的正常平面视图传入系统内部,由系统再传入到终端设备中。
如图2所示,中央控制器600包括:三轴陀螺仪610、三轴传感器620、三轴磁强计630、第一PID控制器640和第二PID控制器650。
三轴陀螺仪610设置在壳体100内,用于检测无人机在水中的行驶姿态;三轴传感器620设置在壳体100内,用于检测无人机的行驶加速度;三轴磁强计630设置在壳体内,用于检测无人机的潜入深度;第一PID控制器640连接三轴陀螺仪610、三轴传感器620和三轴磁强计630,得到无人机的行驶姿态,并进行解析,进而控制调速电机400的转速;第二PID控制器650连接三轴陀螺仪610、三轴传感器620和三轴磁强计630,得到无人机的行驶姿态,并进行解析,进而控制步进电机500的转角。
如图3所示,一种用于水下侦查与摄影无人机的控制方法,包括:
步骤一、建立三维笛卡尔检测坐标系,通过三周磁强计630实时检测无人机的潜入深度Hq,三轴陀螺仪610实时检测无人机态势
步骤二、计算无人机的偏转角:
其中,ψ为航向角,为横滚角,ω为俯仰角,/> δ0为无人机旋转幅度,lix为无人机质心到检测坐标系x轴的距离,liy为无人机质心到检测坐标系y轴的距离,liz为无人机质心到检测坐标系z轴的距离;
步骤三、通过目标深度计算调速电机目标的目标转速:
其中,为左前调速电机的目标转速,/>为右前调速电机的目标转速,/>为左后调速电机的目标转速,/>为右后调速电机的目标转速,n1为左前调速电机的实时转速,n2为右前调速电机的实时转速,n3为左后调速电机的实时转速,n4为右后调速电机的实时转速,k为转动系数,其数值为2.46,j为量化系数,其数值为3014-6.29,/>为目标深度,Hq为潜入深度,L为螺旋桨中心到质心的距离;
步骤四、根据所述调速电机的目标转速计算调速电机的目标输入电压:
其中,为左前调速电机输出电压,/>为右前调速电机输出电压,/>为左后调速电机输出电压,/>为右后调速电机输出电压,/>为左前调速电机转速,/>为右前调速电机转速,/>为左后调速电机转速,/>为右后调速电机转速;kn为调速电机转速与对应螺旋桨推动力之间的转换系数,n,i=1,2,3,4;kn为1.69-5.46,L为螺旋桨中心到机体质心的距离;
步骤五、通过无人机的目标航向角,计算步进电机的目标
其中,为左前步进电机的目标转角,/>右前步进电机的目标转角,/>左后步进电机的目标转角,/>为右后步进电机的目标转角,/>为无人机的目标航向角,ψ为无人机的实时航向角,c为转换系数,其数值为22.35-23.95;
步骤六、将调速电机的理想输入电压、实际输入电压之差和电压差变化率输入第一PID控制器,输出为调速电机输出电压的控制策略;
将无人机的目标转角、实际转角之差和转动角速度输入第二PID控制器,输出为支撑臂转角控制策略,即为步进电机转动策略。
在另一实施例中,无人机潜入深度存在磁力计测不准的情况,因此要对测试结果进行校正,无人机的潜入深度检测校正计算公式为:
其中,Hq为潜入深度,G为校正因数,其数值为3.25,S为磁强计检测到的嵌入深度,L为螺旋桨中心到质心的距离,n为无人机螺旋桨个数。
如图4所示,第一PID控制器包括电压环控制器和压差变化率环控制器;
电压环控制器的输入为给定的目标输入电压与调速电机的实际输入电压Ui之差,即为电压差ec(t),电压环控制器的输出为调速电机的目标压差变化率/>
将调速电机的目标压差变化率与调速电机的实际压差变化率Pi之差eP(t)输入压差变化率环控制器,转速环控制器输出为调速电机输入电压的目标控制幅度,实现螺旋浆的转速控制。
如图5所示,第二PID控制器包括转角环控制器和转动角速度环控制器;
步进电机的目标转角与步进电机的实际转角αi之差输入转角环控制器,即为角度差eo(t),转角环控制器输出为目标转动角速度/>
转动角速度控制器的输入为给定的目标转动角速度与支撑臂的实际转动角速度之差θi,即为角速度误差ez(t),转动角速度环控制器的输出为角速度控制幅度,实现支撑臂转角的控制。
其中,电压环控制器PID控制算法公式为:
U(t)为输出的调速电机压差变化率控制幅度,kp为电压环控制器的比例项修正系数,ki为电压环控制器的积分项修正系数,kd为电压环控制器的微分项修正系数,ec(t)为给定的目标输入电压与调速电机的实际输入电压之差;
压差变化率环控制器PID控制算法公式为:
其中,P(t)为输出的目标电压控制幅度,ki-p为压差变化率环控制器的比例项修正系数,ki-i为压差变化率环控制器的积分项修正系数,ki-d为压差变化率环控制器的微分项修正系数,ep(t)为给定的目标电压变化率与调速电机的实际电压变化率之差;
转角环控制器PID控制算法公式为:
其中,α(t)为输出的转角电机角速度控制幅度,ko-p转角环控制器的比例项修正系数,ko-i为转角环控制器的积分项修正系数,ko-d为转角环控制器的微分项修正系数,eo(t)为给定的步进电机的目标转角与所述步进电机的实际转角之差;
转动角速度环控制器PID控制算法公式为:
其中,θ(t)为输出的转角电机角度控制幅度,kz-p转动角速度环控制器的比例项修正系数,kz-i为转动角速度环控制器的积分项修正系数,kz-d为转动角速度环控制器的微分项修正系数,ez(t)为给定的目标转动角速度与支撑臂的实际转动角速度之差。
如图5所示,在另一实施例中,还包括专家控制规则:
当时,/>
当时,/>
其中,为调速电机的目标输入电压,Ui为速电机的实际输入电压,pm为变化比例系数,其数值为3.25-7.61,im为积分比例系数,其数值为4.67-6.54,dm为微分比例系数,其数值为3.69-7.89,δ为时间变化系数,k′p为规则电压环控制器的比例项修正系数,k′i为规则电压环控制器的积分项修正系数,k′d为规则电压环控制器的微分项修正系数;
当时,/>
当时,/>
其中,为调速电机的目标电压变化率,Pi为调速电机的实际电压变化率,δ为时间变化系数,k′i-p为规则压差变化率环控制器的比例项修正系数,k′i-i为规则压差变化率环控制器的积分项修正系数,k′i-d为规则压差变化率环控制器的微分项修正系数,ep(t)为给定的目标电压变化率与调速电机的实际电压变化率之差;
当时,/>/>
当时,/>
其中,为转角电机的目标转角,αi转角电机的实际转角,δ为时间变化系数,k′o-p为规则转角环控制器的比例项修正系数,k′o-i为规则转角环控制器的积分项修正系数,k′o-d为规则转角环控制器的微分项修正系数,eo(t)为给定的步进电机的目标转角与所述步进电机的实际转角之差;
当时,/>
当时,/>
其中,为转角电机的目标角速度,θi为转角电机的实际角速度,k′z-p为规则转动角速度环控制器的比例项修正系数,k′z-i为规则转动角速度环控制器的积分项修正系数,k′z-d为规则转动角速度环控制器的微分项修正系数,ez(t)为给定的目标转动角速度与支撑臂的实际转动角速度之差。
本发明设计开发了一种用于水下侦查与摄影的无人机,由步进电机驱动旋转支撑臂带动螺旋桨旋转,并有调速电机带动螺旋桨旋转,可以由螺旋桨带动壳体在水下环境进行拍摄,结构简单,控制方便。本发明还设计开发了一种用于水下侦查与摄影的无人机控制方法,通过两个闭环PID控制器精准控制步进电机的转角和调速电机转速,实现无人机水下行驶的精准控制,提高了无人机的行驶稳定性。
尽管本发明的实施方案已公开如上,但其并不仅仅限于说明书和实施方式中所列运用,它完全可以被适用于各种适合本发明的领域,对于熟悉本领域的人员而言,可容易地实现另外的修改,因此在不背离权利要求及等同范围所限定的一般概念下,本发明并不限于特定的细节和这里示出与描述的图例。
Claims (7)
1.一种用于水下侦查与摄影无人机的控制方法,使用一种用于水下侦查与摄影的无人机,包括:
壳体;
左前旋转支撑臂,其一端可旋转支撑在所述壳体一侧;
左后旋转支撑臂,其一端可旋转支撑在所述壳体一侧,并与所述左前旋转支撑臂平行设置;
右前旋转支撑臂,其一端可旋转支撑在所述壳体另一侧;
右后旋转支撑臂,其一端可旋转支撑在所述壳体另一侧,并与所述右前旋转支撑臂平行设置;
多个螺旋浆,其分别对应可旋转支撑在所述旋转支撑臂另一端,并能够随所述旋转支撑臂偏转;
调速电机,其设置在所述壳体内,连接并带动所述螺旋桨旋转;
步进电机,其连接所述旋转支撑臂,并能够驱动所述旋转支撑臂偏转;
摄影机,设置在所述壳体顶部;
中央控制器,其连接所述驱动电机和所述步进电机;
所述中央控制器包括:
三轴陀螺仪,其设置在所述壳体内,用于检测所述无人机在水中的行驶姿态;
三轴传感器,其设置在所述壳体内,用于检测所述无人机的行驶加速度;
三轴磁强计,其设置在所述壳体内,用于检测所述无人机的潜入深度;
第一PID控制器,其连接所述三轴陀螺仪、三轴传感器和所述三轴磁强计,得到无人机的行驶姿态,并进行解析,进而控制所述调速电机的转速;
第二PID控制器,其连接所述三轴陀螺仪、三轴传感器和所述三轴磁强计,得到无人机的行驶姿态,并进行解析,进而控制所述步进电机的转角;
其特征在于,包括:
建立三维笛卡尔检测坐标系,实时检测无人机的潜入深度,实时检测无人机的偏转角:
其中,ψ为航向角,为横滚角,ω为俯仰角,/> 为无人机旋转幅度,lix为无人机质心到检测坐标系x轴的距离,liy为无人机质心到检测坐标系y轴的距离,liz为无人机质心到检测坐标系z轴的距离;
并通过目标深度计算调速电机目标的目标转速:
其中,为左前调速电机的目标转速,/>为右前调速电机的目标转速,/>为左后调速电机的目标转速,/>为右后调速电机的目标转速,n1为左前调速电机的实时转速,n2为右前调速电机的实时转速,n3为左后调速电机的实时转速,n4为右后调速电机的实时转速,k为转动系数,j为量化系数,/>为目标深度,Hq为潜入深度,L为螺旋桨中心到质心的距离;
根据所述调速电机的目标转速,计算调速电机的目标输入电压;
将调速电机的理想输入电压、实际输入电压之差和电压差变化率输入第一PID控制器,输出为调速电机输出电压的控制策略;
通过无人机的目标航向角,计算步进电机的目标
其中,为左前步进电机的目标转角,/>右前步进电机的目标转角,/>左后步进电机的目标转角,/>为右后步进电机的目标转角,/>为无人机的目标航向角,ψ为无人机的实时航向角,c为转换系数;
将无人机的目标转角、实际转角之差和转动角速度输入第二PID控制器,输出为支撑臂转角的控制策略,即为步进电机转动角度。
2.根据权利要求1所述的用于水下侦查与摄影无人机的控制方法,其特征在于,还包括对所述无人机的潜入深度检测校正:
其中,Hq为潜入深度,G为校正因数,S为磁强计检测到的嵌入深度,L为螺旋桨中心到质心的距离,n为无人机螺旋桨个数。
3.根据权利要求2所述的用于水下侦查与摄影无人机的控制方法,其特征在于,所述第一PID控制器包括电压环控制器和压差变化率环控制器;
所述电压环控制器的输入为给定的目标输入电压与调速电机的实际输入电压之差,即为电压差,所述电压环控制器的输出为调速电机的目标压差变化率;
将所述调速电机的目标压差变化率与所述调速电机的实际压差变化率之差输入压差变化率环控制器,所述转速环控制器输出为调速电机输入电压的目标控制幅度,实现螺旋浆的转速控制。
4.根据权利要求3所述的用于水下侦查与摄影无人机的控制方法,其特征在于,所述第二PID控制器包括转角环控制器和转动角速度环控制器;
将所述步进电机的目标转角与所述步进电机的实际转角之差输入转角环控制器,即为角度差,所述转角环控制器输出为目标转动角速度;
所述转动角速度控制器的输入为给定的目标转动角速度与支撑臂的实际转动角速度之差,即为角速度误差,所述转动角速度环控制器的输出为角速度控制幅度,实现支撑臂转角的控制。
5.根据权利要求3所述的用于水下侦查与摄影无人机的控制方法,其特征在于,所述调速电机的目标输入电压的计算公式为:
其中,为左前调速电机输出电压,/>为右前调速电机输出电压,/>为左后调速电机输出电压,/>为右后调速电机输出电压,/>为左前调速电机转速,/>为右前调速电机转速,为左后调速电机转速,/>为右后调速电机转速;kn为调速电机转速n,i=1,2,3,4;与对应螺旋桨推动力之间的转换系数,L为螺旋桨中心到机体质心的距离。
6.根据权利要求4所述的用于水下侦查与摄影无人机的控制方法,其特征在于,所述电压环控制器PID控制算法公式为:
其中,U(t)为输出的调速电机压差变化率控制幅度,kp为电压环控制器的比例项修正系数,ki为电压环控制器的积分项修正系数,kd为电压环控制器的微分项修正系数,ec(t)为给定的目标输入电压与调速电机的实际输入电压之差;
所述压差变化率环控制器PID控制算法公式为:
其中,P(t)为输出的目标电压控制幅度,ki-p为压差变化率环控制器的比例项修正系数,ki-i为压差变化率环控制器的积分项修正系数,ki-d为压差变化率环控制器的微分项修正系数,ep(t)为给定的目标电压变化率与调速电机的实际电压变化率之差;
所述转角环控制器PID控制算法公式为:
其中,α(t)为输出的转角电机角速度控制幅度,ko-p转角环控制器的比例项修正系数,ko-i为转角环控制器的积分项修正系数,ko-d为转角环控制器的微分项修正系数,eo(t)为给定的步进电机的目标转角与所述步进电机的实际转角之差;
所述转动角速度环控制器PID控制算法公式为:
其中,θ(t)为输出的转角电机角度控制幅度,kz-p转动角速度环控制器的比例项修正系数,kz-i为转动角速度环控制器的积分项修正系数,kz-d为转动角速度环控制器的微分项修正系数,ez(t)为给定的目标转动角速度与支撑臂的实际转动角速度之差。
7.根据权利要求6所述的用于水下侦查与摄影无人机的控制方法,其特征在于,还包括专家控制规则:
但时,/>
其中,为调速电机的目标输入电压,Ui为速电机的实际输入电压,pm为变化比例系数,im为积分比例系数,dm为微分比例系数,δ为时间变化系数,k′p为规则电压环控制器的比例项修正系数,ki′为规则电压环控制器的积分项修正系数,kd′为规则电压环控制器的微分项修正系数;
当时,/>
其中,为调速电机的目标电压变化率,Pi为调速电机的实际电压变化率,δ为时间变化系数,k′i-p为规则压差变化率环控制器的比例项修正系数,k′i-i为规则压差变化率环控制器的积分项修正系数,k′i-d为规则压差变化率环控制器的微分项修正系数,ep(t)为给定的目标电压变化率与调速电机的实际电压变化率之差;
当时,/>
其中,为转角电机的目标转角,αi转角电机的实际转角,δ为时间变化系数,k′o-p为规则转角环控制器的比例项修正系数,k′o-i为规则转角环控制器的积分项修正系数,k′o-d为规则转角环控制器的微分项修正系数,eo(t)为给定的步进电机的目标转角与所述步进电机的实际转角之差
当时,/>
其中,为转角电机的目标角速度,θi为转角电机的实际角速度,k′z-p为规则转动角速度环控制器的比例项修正系数,k′z-i为规则转动角速度环控制器的积分项修正系数,k′z-d为规则转动角速度环控制器的微分项修正系数,ez(t)为给定的目标转动角速度与支撑臂的实际转动角速度之差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910417180.6A CN110032208B (zh) | 2019-05-20 | 2019-05-20 | 一种用于水下侦查与摄影无人机及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910417180.6A CN110032208B (zh) | 2019-05-20 | 2019-05-20 | 一种用于水下侦查与摄影无人机及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110032208A CN110032208A (zh) | 2019-07-19 |
CN110032208B true CN110032208B (zh) | 2024-01-26 |
Family
ID=67242586
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910417180.6A Active CN110032208B (zh) | 2019-05-20 | 2019-05-20 | 一种用于水下侦查与摄影无人机及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110032208B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110686680A (zh) * | 2019-10-30 | 2020-01-14 | 中仿智能科技(上海)股份有限公司 | 一种模拟飞行器集群的导航定位系统及方法 |
CN112540619A (zh) * | 2020-11-12 | 2021-03-23 | 中国海洋大学 | 一种水下航行器姿态调整方法、装置及水下航行器 |
CN112730404A (zh) * | 2020-12-14 | 2021-04-30 | 河海大学 | 多自由度水体监测与增氧机器人 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103224021A (zh) * | 2013-03-19 | 2013-07-31 | 北京航空航天大学 | 一种适用于跨海空两栖无人机的变机翼后掠角的气动式折叠装置 |
CN105035303A (zh) * | 2015-08-19 | 2015-11-11 | 无锡觅睿恪科技有限公司 | 折叠型航拍飞行器 |
CN108563234A (zh) * | 2018-05-09 | 2018-09-21 | 深圳市吉影科技有限公司 | 一种水下无人机自平衡控制方法及系统 |
CN109018400A (zh) * | 2018-08-08 | 2018-12-18 | 深圳市南硕明泰科技有限公司 | 一种装有多种侦检仪器的无人机 |
CN109163721A (zh) * | 2018-09-18 | 2019-01-08 | 河北美泰电子科技有限公司 | 姿态测量方法及终端设备 |
CN109204802A (zh) * | 2018-11-09 | 2019-01-15 | 易蕾 | 一种降落稳定性好的无人机 |
-
2019
- 2019-05-20 CN CN201910417180.6A patent/CN110032208B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103224021A (zh) * | 2013-03-19 | 2013-07-31 | 北京航空航天大学 | 一种适用于跨海空两栖无人机的变机翼后掠角的气动式折叠装置 |
CN105035303A (zh) * | 2015-08-19 | 2015-11-11 | 无锡觅睿恪科技有限公司 | 折叠型航拍飞行器 |
CN108563234A (zh) * | 2018-05-09 | 2018-09-21 | 深圳市吉影科技有限公司 | 一种水下无人机自平衡控制方法及系统 |
CN109018400A (zh) * | 2018-08-08 | 2018-12-18 | 深圳市南硕明泰科技有限公司 | 一种装有多种侦检仪器的无人机 |
CN109163721A (zh) * | 2018-09-18 | 2019-01-08 | 河北美泰电子科技有限公司 | 姿态测量方法及终端设备 |
CN109204802A (zh) * | 2018-11-09 | 2019-01-15 | 易蕾 | 一种降落稳定性好的无人机 |
Also Published As
Publication number | Publication date |
---|---|
CN110032208A (zh) | 2019-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110032208B (zh) | 一种用于水下侦查与摄影无人机及其控制方法 | |
CN106428479B (zh) | 一种无人遥控水下机器人及其控制方法 | |
CN108549399B (zh) | 飞行器偏航角修正方法、装置及飞行器 | |
CN105676867B (zh) | 一种rov水下机器人悬浮姿态稳定控制方法 | |
CN105045293B (zh) | 云台控制方法、外部载体控制方法及云台 | |
CN106774362A (zh) | 一种柔性六自由度绳牵引的船模水池试验控制方法和系统 | |
CN109823571A (zh) | 一种遥感微纳卫星的多阶段姿态控制方法 | |
CN108488572A (zh) | 一种主动式防抖云台及其控制方法 | |
CN204979196U (zh) | 水下多轴机器人 | |
CN110001840B (zh) | 一种基于视觉传感器的多种路况下的两轮自平衡车运动控制方法 | |
Fu et al. | A miniature video stabilization system for flapping-wing aerial vehicles | |
CN104991571B (zh) | 一种云台增稳装置及方法 | |
CN110758694A (zh) | 一种面向考古作业的水下机器人及其矢量控制方法 | |
CN109079799A (zh) | 一种基于仿生的机器人感知控制系统及控制方法 | |
CN206639050U (zh) | 三轴微型云台 | |
CN210201937U (zh) | 一种影像采集装置 | |
CN107145167B (zh) | 一种基于数字图像处理技术的视频目标跟踪方法 | |
CN107065926A (zh) | 全向避障装置、云台、云台的控制方法及避障控制方法 | |
CN111977006B (zh) | 一种关节角的初始化方法、装置及飞行器 | |
Duecker et al. | HippoCampusX–A hydrobatic open-source micro AUV for confined environments | |
CN111930148A (zh) | 基于机器视觉的无人机目标跟踪系统及方法 | |
CN106292297B (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
CN116149193B (zh) | 一种基于视觉的旋翼无人机抗扰动控制方法及系统 | |
CN108758301A (zh) | 一种双级驱动陀螺稳定云台及其控制方法 | |
Mahony et al. | Visual servoing using linear features for under-actuated rigid body dynamics |
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 |