CN113581439B - 一种全向无人艇及其控制系统、方法 - Google Patents

一种全向无人艇及其控制系统、方法 Download PDF

Info

Publication number
CN113581439B
CN113581439B CN202110974824.9A CN202110974824A CN113581439B CN 113581439 B CN113581439 B CN 113581439B CN 202110974824 A CN202110974824 A CN 202110974824A CN 113581439 B CN113581439 B CN 113581439B
Authority
CN
China
Prior art keywords
sector
control
ref
current
vector
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
Application number
CN202110974824.9A
Other languages
English (en)
Other versions
CN113581439A (zh
Inventor
徐雍
李桂聪
饶红霞
彭慧
鲁仁全
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong University of Technology
Original Assignee
Guangdong University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangdong University of Technology filed Critical Guangdong University of Technology
Priority to CN202110974824.9A priority Critical patent/CN113581439B/zh
Publication of CN113581439A publication Critical patent/CN113581439A/zh
Application granted granted Critical
Publication of CN113581439B publication Critical patent/CN113581439B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63H—MARINE PROPULSION OR STEERING
    • B63H21/00—Use of propulsion power plant or units on vessels
    • B63H21/21—Control means for engine or transmission, specially adapted for use on marine vessels
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B3/00—Hulls characterised by their structure or component parts
    • B63B3/14—Hull parts
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B35/00—Vessels or similar floating structures specially adapted for specific purposes and not otherwise provided for
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
    • B63G7/00—Mine-sweeping; Vessels characterised thereby
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63H—MARINE PROPULSION OR STEERING
    • B63H21/00—Use of propulsion power plant or units on vessels
    • B63H21/12—Use of propulsion power plant or units on vessels the vessels being motor-driven
    • B63H21/17—Use of propulsion power plant or units on vessels the vessels being motor-driven by electric motor
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02K—DYNAMO-ELECTRIC MACHINES
    • H02K7/00—Arrangements for handling mechanical energy structurally associated with dynamo-electric machines, e.g. structural association with mechanical driving motors or auxiliary dynamo-electric machines
    • H02K7/10—Structural association with clutches, brakes, gears, pulleys or mechanical starters
    • H02K7/116—Structural association with clutches, brakes, gears, pulleys or mechanical starters with gears
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/13—Observer control, e.g. using Luenberger observers or Kalman filters
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
    • H02P21/18—Estimation of position or speed
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/22—Current control, e.g. using a current control loop
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/08—Arrangements for controlling the speed or torque of a single motor
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/28—Arrangements for controlling current
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B35/00—Vessels or similar floating structures specially adapted for specific purposes and not otherwise provided for
    • B63B2035/006—Unmanned surface vessels, e.g. remotely controlled
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
    • B63G7/00—Mine-sweeping; Vessels characterised thereby
    • B63G2007/005—Unmanned autonomously operating mine sweeping vessels
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63H—MARINE PROPULSION OR STEERING
    • B63H21/00—Use of propulsion power plant or units on vessels
    • B63H21/21—Control means for engine or transmission, specially adapted for use on marine vessels
    • B63H2021/216—Control means for engine or transmission, specially adapted for use on marine vessels using electric control means

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Motors That Do Not Use Commutators (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明涉及一种全向无人艇及其控制系统，全向无人艇包括船头、船身和推进装置；所述船身为长方体结构，所述船头设置在所述船身的一端，所述船头为梯台结构；所述船身的底部的四个边角设有安装部；所述推进装置包括推进无刷电机、行星减速齿轮箱、掌舵无刷电机、共轴可旋转三相电压线和推进电机连杆；所述推进电机连杆的一端与所述掌舵无刷电机通过行星减速齿轮箱相连，所述推进电机连杆的另一端与所述推进无刷电机相连，所述共轴可旋转三相电压线设置在所述推进电机连杆内且与所述推进无刷电机相连。本发明解决普通水面无人艇结构单一、控制迟滞、抗风浪等级低、靠锚泊定位的一些缺点，构建一种全向无人艇装置的整体结构。

Description

一种全向无人艇及其控制系统、方法
技术领域
本发明涉及无人艇技术领域，具体涉及一种全向无人艇及其控制系统、方法。
背景技术
近些年来，随着信息和制造业技术的快速发展，涌现出了种类繁多、场景丰富的无人艇。无人水面艇在国防领域和民用方向具有广阔的应用前景。在国防领域，无人水面艇能够执行扫雷、反潜、侦查、电子战等多种高危作战任务，在精准迅速完成任务的同时又确保了士兵的人身安全。在民用方向，无人艇用于水域环境数据采集、资源探测和海洋工程实施，能够代替人员在危险水域下作业，减少人员工作的危险系数。随着任务类型的增多、应用场景的扩大，对无人艇的性能要求也进一步提升。无人艇的技术主要包括水面平台与动力管理、环境感知、自主控制、路径规划、网络化通信、多任务等。其中，水面平台与动力管理技术直接影响后面技术开发的进度与性能。目前的普通水面无人艇结构单一，多采用单体或者双体船作为基础，使用固定浆或者舵机控制的小幅度摆动浆作为动力推进，且电机控制多采用PWM脉宽调制器进行六步换向控制，同时，水下无刷电机由于考虑防水以及性能等因素难以加装电机传感器，导致无人艇控制精度低、控制迟滞、电机闭环性能差、抗风浪等级低、定点定位能力差，灵活度低、适用水域类型少，且执行任务单一等问题，同时也为后续的自主控制、路径规划、同域集群控制以及异域协同控制的开发增加难度。
发明内容
本发明的目的在于针对现有技术中的不足之处，提供一种适应场景广的全向无人艇及其控制系统、方法。
为达此目的，本发明采用以下技术方案：
一种全向无人艇，包括船头、船身和推进装置；
所述船身为长方体结构，所述船头设置在所述船身的一端，所述船头为梯台结构，所述船头的顶部斜面延伸至所述船身的顶部；
所述船身的底部的四个边角设有安装部，所述安装部包括方形的底板和连接柱，所述底板的四角通过连接柱与所述船身的底部相连，围成空腔结构；所述推进装置设置在所述空腔结构中；
所述推进装置包括推进无刷电机、行星减速齿轮箱、掌舵无刷电机、共轴可旋转三相电压线和推进电机连杆；所述推进电机连杆的一端与所述掌舵无刷电机通过行星减速齿轮箱相连，所述推进电机连杆的另一端与所述推进无刷电机相连，所述共轴可旋转三相电压线设置在所述推进电机连杆内且与所述推进无刷电机相连。
更进一步的说明，所述船体的顶部设有无人机起降平台，所述船体的底部的中部设有机械抓取单元。
更进一步的说明，控制系统包括控制模块、TSLAM三维建图与定位模块、无刷电机矢量控制模块和全向无人艇主控模块；
所述控制模块用于用户对无人艇发送指令、进行任务规划以及信息反馈接收；
所述全向无人艇主控模块用于传感测量、与控制模块、TSLAM三维建图与定位模块、无刷电机矢量控制模块进行通信交互；
所述TSLAM三维建图与定位模块用于进行定位以及三维建图；所述无刷电机矢量控制模块；
所述无刷电机矢量控制模块用于控制无人艇的四个推进装置的转速及方向。
一种全向无人艇的控制方法,包括如下步骤：
步骤一：获取无人艇主控设置的期望值，初始化共生生物算法的种群以及最大迭代数；
步骤二：执行共生生物算法进行个体Xbest搜索，通过最优个体的值对控制器的参数进行整定；
步骤三：对控制器输出值进行反Park变换、SVPWM算法，得到推进装置的矢量电压U(t)，推进装置开始执行转动；
步骤四：采集推进装置的三相电流，经过扩展卡尔曼滤波器的估计后得到推进装置的位置
Figure BDA0003226910810000031
和转速
Figure BDA0003226910810000032
重复完成步骤一到步骤三。
更进一步的说明，SVPWM算法包括如下步骤：
通过判断输入电压Uα、Uβ的值确定合成的矢量电压Uref所在的扇区，
当Uα>0，Uβ>0且Uβ/Uα<√3时，Uref落在第I扇区；
当Uβ>0且Uβ/Uα>√3；Uref落在第Ⅱ扇区；
当Uα<0，Uβ>0且-Uβ/Uα<√3；Uref落在第Ⅲ扇区；
当Uα<0，Uβ<0且Uβ/Uα<√3；Uref落在第Ⅳ扇区；：
当Uβ<0且-Uβ/Uα>√3；Uref落在第Ⅴ扇区；
当Uα>0，Uβ<0且-Uβ/Uα<√3；Uref落在第Ⅵ扇区；
再根据基准电压Udc以及Uα、Uβ计算出Uα、Uβ的对一个周期TS的Uref作用时长，作用时Tx、Ty长计算公式如下：
Figure BDA0003226910810000041
Figure BDA0003226910810000042
Figure BDA0003226910810000043
控制逆变桥电路合成指定扇区的矢量电压Uref。
更进一步的说明，步骤三包括如下步骤：
A1：对三相电枢绕组的任意两相电流ia、ib，通过Clarke变换，把三相电流变换到正交的直角坐标系α-β下，得到两相正交电流iα和iβ，通过Park变换将静止的两相正交坐标系α-β变换成跟随电机转子旋转的两相正交坐标系d-q，将强耦合、非线性的三相交流电流ia、ib、ic解耦成两相直流励磁电流id和转矩电流iq；具体变换公式如下
Figure BDA0003226910810000044
Figure BDA0003226910810000045
Figure BDA0003226910810000046
A2：采用基于id＝0磁场定向控制，实际id与期望值0做比较，由于期望值固定为0，电流环PI控制器足以进行稳定校正控制；使用分数阶模糊控制器对转矩电流iq进行校正控制，分数阶模糊控制器的控制律如下：
u(k)＝(f(E,CE)+IE)Ku
Figure BDA0003226910810000047
其中E、CE、IE分别为误差、误差的分数阶微分、误差的积分；
Dα为分数阶微分算子如下：
Figure BDA0003226910810000051
其中hα(k)为脉冲响应序列；
Tc为采样频率模糊控制规则如下：
如果E＝NM，CE＝NS，那么U＝NL；
其中，E是误差，CE是误差的分数阶导数，U是输出，NL、NM、NS、ZR、PS、PM和PL分别代表“负大”、“负中”、“负小”、“零”、“正小”、“正中”和“正大”；
A3：对电流环校正输出的电压Vd、Vq进行Park逆变换，得到Vα、Vβ；通过SVWPM技术得到目标矢量电压，控制无刷电机；矢量电压计算公式如下：
Figure BDA0003226910810000052
A4：在电流环外部增加速度环控制，将实际转速与参考转速进行比较，同样使用共生生物搜索算法优化的分数阶模糊控制进行电机的转速校正，输出参考电流iq；
A5：使用扩展卡尔曼滤波器EKF作为电机的观测器，估计电机的转角
Figure BDA0003226910810000053
和转速
Figure BDA0003226910810000054
其中观测器的输入分别为Vα、Vβ、iα、iβ、θ，输出为
Figure BDA0003226910810000055
A6：速度环与电流环的分数阶模糊控制共有待整定10个，分别为α1、kp1、kd1、ki1、ku1、α2、kp2、kd2、ki2、ku2；使用共生生物搜索算法SOS进行优化，待整定参数(α1,kp1,kd1,ki1,ku2,α2,kp2,kd2,ki2,ku2)表示了共生生物搜索算法SOS算法的搜索维度，考虑到被控系统的瞬态响应的震荡性要求最优指标法采用ITAE准则，评价模型J如下，其中e(t)表示闭环误差函数：
Figure BDA0003226910810000061
更进一步的说明，共生生物搜索算法SOS步骤如下：
S1：初始化生态系统中的生物个体N，定义最大迭代次数；
S2：在生物个体空间中，找到最优个体；
S3：种群进入互利共生阶段；
S4：种群进入偏利共生阶段；
S5：种群进入寄生阶段；
S6：计算种群中各个体的适应度，适者生存；
S7：判断是否满足最大迭代次数；是则是输出最优个体，否则继续迭代。更进一步的说明，共生生物搜索算法SOS的互利共生阶段：
Xinew＝Xi+rand(0,1)*(Xbest-Mutual_Vextor*BF1)
Xjnew＝Xj+rand(0,1)*(Xbest-Mutual_Vextor*BF2)
Figure BDA0003226910810000062
其中BF1、BF2是获利因子，取值1或0；
共生生物搜索算法SOS的偏利共生阶段：
Xinew＝Xi+rand(-1,1)*(Xbest-Xj)
其中，Xi在偏利共生阶段为单方面获利者，Xj不获利也不受到伤害；
共生生物搜索算法SOS：
Parasite_Vector＝Xi+rand(0,1)*Xi(pick)
使用人工寄生虫Parasite_Vector随机寄生个体Xi，并且对Xi进行复制和变异，如果Parasite_Vector比宿主Xi具有更好的适应值，则破坏宿主并将其替代，若相反则淘汰Parasite_Vector。
上述技术方案可以带来以下有益效果：
本专利首先着重解决普通水面无人艇结构单一、控制迟滞、抗风浪等级低、靠锚泊定位的一些缺点，构建一种全向无人艇装置的整体结构。其次，针对无刷电机矢量控制转矩脉动大，抗干扰性能差等问题，引入了分数阶模糊控制算法和共生生物搜索算法，设计改进型双环分数阶模糊控制器，并且利用共生生物搜索算法进行参数优化。最后，根据全向无人艇的结构特性、控制算法以及高精度定位和惯导，使得全向无人艇具备水面抗风浪厘米级动力定位功能。厘米级的动力定位使得无人艇能更稳定地进行无人机自动起降、水下机器人自动发射回收等异域无人系统协同控制以及同域无人系统的集群控制。
附图说明
图1是本发明的一个实施例的整体结构示意图；
图2是本发明的一个实施例的整体结构示意图；
图3是本发明的一个实施例的推进装置的结构示意图；
图4是本发明的系统模块示意图。
其中：船头1、船身2、推进装置3、推进无刷电机31、行星减速齿轮箱32、掌舵无刷电机33、共轴可旋转三相电压线34、推进电机连杆35、安装部4、底板41、连接柱42、无人机起降平台5、机械抓取单元6。
具体实施方式
下面结合附图并通过具体实施方式来进一步说明本发明的技术方案。
如图1-图3所示，一种全向无人艇，包括船头1、船身2和推进装置3；
所述船身2为长方体结构，所述船头1设置在所述船身2的一端，所述船头1为梯台结构，所述船头1的顶部斜面延伸至所述船身2的顶部；
所述船身2的底部的四个边角设有安装部4，所述安装部4包括方形的底板41和连接柱42，所述底板41的四角通过连接柱42与所述船身2的底部相连，围成空腔结构；所述推进装置3设置在所述空腔结构中；
所述推进装置3包括推进无刷电机31、行星减速齿轮箱32、掌舵无刷电机33、共轴可旋转三相电压线34和推进电机连杆35；所述推进电机连杆35的一端与所述掌舵无刷电机33通过行星减速齿轮箱32相连，所述推进电机连杆35的另一端与所述推进无刷电机31相连，所述共轴可旋转三相电压线34设置在所述推进电机连杆35内且与所述推进无刷电机31相连。
船头1的顶部为梯台结构，可以有效减少在行进过程中的阻力，船底的四个边角设置空腔结构，用以保护其中的推进装置3，每个推进装置3都可以独立控制驱动，通过行星减速齿轮箱32加大扭矩，控制推进无刷电机31的推进方向。共轴可旋转三相电压线34的结构使得推进无刷电机31可跟随电机连杆进行全向的旋转，进而无人艇可以获得全向的推力。无人艇有两种控制模式，全向控制模式下，四个掌舵无刷电机33输出相同，同步控制无人艇的艏向，四个推进无刷电机31输出相同，控制无人艇的推力；动力定位下，四个掌舵无刷电机33独立输出，同时，四个推进无刷电机31也独立输出，共同合成外部作用力的反力，稳定无人艇的位姿。本方案设计的全向无人艇装置在双体无人艇结构基础上，考虑在水域死角作业场景以及协同作用应用场景，设计了稳定可靠的全向四浆驱动结构来综合提升无人艇的自由度和速度来满足水域死角作业场景，同时在较大程度上改善机体的平稳性来充分满足在集群控制、异域无人系统协同作业需要，在大程度上提升了无人艇的整机性能。本方案设计的全向水下推进装置3，包括掌舵无刷电机33以及共轴可旋转三相电压线34，能够解决常规舵机转动死区，转动过程线材缠绕等弊端，实现水下推进器的全向转动，增加无人艇的自由度，大大提高了无人艇作业的灵活性。
更进一步的说明，所述船体的顶部设有无人机起降平台5，所述船体的底部的中部设有机械抓取单元6。
无人机起降平台5可以与无人机执行协同起降任务，机械抓取单元6可以水下机器人执行协同发射回收任务。两者拓展了无人艇的适用范围。
一种全向无人艇的控制系统，包括控制模块、TSLAM三维建图与定位模块、无刷电机矢量控制模块和全向无人艇主控模块；
所述控制模块用于用户对无人艇发送指令、进行任务规划以及信息反馈接收；
所述全向无人艇主控模块用于传感测量、与控制模块、TSLAM三维建图与定位模块、无刷电机矢量控制模块进行通信交互；
所述TSLAM三维建图与定位模块用于进行定位以及三维建图；所述无刷电机矢量控制模块；
所述无刷电机矢量控制模块用于控制无人艇的四个无刷电机的转速及方向。
本专利系统方案框图如图4所示，其主要分为四部分，分别是地面站\遥控器组成的控制模块、TSLAM三维建图与定位模块、无刷电机矢量控制模块和全向无人艇主控模块。其中用户以地面站、遥控器作为用户的控制端、任务规划端和信息反馈接收端；全向无人艇主控主要以高性能嵌入式STM32芯片为无人艇的主控，以惯性测量元件、磁力计等外设传感器作为无人艇的机载传感系统，并依靠5G模块作为系统的通信；实时TSLAM三维建图与定位模块则是由搭载了装有机器人操作系统的微型工控电脑，RTK的高精度厘米级的定位以及激光雷达实时三维建图。同时，全向无人艇主控模块可以获取微型工控电脑所依据建图与定位后的一些状态信息以及对其发送相应通信指令。用户先对环境进行遥控控制进行三维建图与定位，或者使用具有建图功能的无人机进行建图，建图完成后可以对无人艇进行任务规划，进行无人艇与无人机协同控制，同时收集当前作业时的实时三维图像等信息。用户可以使用地面站进行无人艇与无人机、无人艇与水下机器人的协同控制。将全向无人艇切换为动力定位模式，无人艇感知与其它异构智能体的相对位置，实现无人机与无人艇上自动起降或水下机器人与无人艇自动收发等协同控制。
一种全向无人艇的控制方法，包括如下步骤：
步骤一：获取无人艇主控设置的期望值，初始化共生生物算法的种群以及最大迭代数；
步骤二：执行共生生物算法进行个体Xbest搜索，通过最优个体的值对控制器的参数进行整定；
步骤三：对控制器输出值进行反Park变换、SVPWM算法，得到控制电机的矢量电压U(t)，电机开始执行转动；
步骤四：采集电机的三相电流，经过扩展卡尔曼滤波器的估计后得到电机的位置
Figure BDA0003226910810000101
和转速
Figure BDA0003226910810000102
重复完成步骤一到步骤三。
本方案设计的无刷电机改进式矢量控制算法，使用无传感器的控制方式，通过扩展卡尔曼滤波估计推进装置的转速和角度，通过坐标变换将耦合性强的非线性交流电解耦成线性的直流电，并且使用共生生物算法优化后的分数阶模糊控制器进行闭环校正控制，进而使得无刷电机输出期望的转速、转矩。从而对无人艇进行稳定地、快速响应地、灵活地控制，使得整个系统能够维持在长时间、跨度面积大、水域死角多、水域环境恶劣等环境下平稳精准高效地完成严格的作业要求。
更进一步的说明，SVPWM算法包括如下步骤：
通过判断输入电压Uα、Uβ的值确定合成的矢量电压Uref所在的扇区，
当Uα>0，Uβ>0且Uβ/Uα<√3时，Uref落在第I扇区；
当Uβ>0且Uβ/Uα>√3；Uref落在第Ⅱ扇区；
当Uα<0，Uβ>0且-Uβ/Uα<√3；Uref落在第Ⅲ扇区；
当Uα<0，Uβ<0且Uβ/Uα<√3；Uref落在第Ⅳ扇区；：
当Uβ<0且-Uβ/Uα>√3；Uref落在第Ⅴ扇区；
当Uα>0，Uβ<0且-Uβ/Uα<√3；Uref落在第Ⅵ扇区；
再根据基准电压Udc以及Uα、Uβ计算出Uα、Uβ的对一个周期TS的Uref作用时长，作用时Tx、Ty长计算公式如下：
Figure BDA0003226910810000111
Figure BDA0003226910810000112
Figure BDA0003226910810000113
控制逆变桥电路合成指定扇区的矢量电压Uref。
Figure BDA0003226910810000114
Figure BDA0003226910810000121
更进一步的说明，步骤三包括如下步骤：
A1：对三相电枢绕组的任意两相电流ia、ib，根据基尔霍夫电流定理KCL,可得ia+ib+ic＝0，因此知道任意两项电流ia、ib即可计算出ic。通过Clarke变换，把三相电流变换到正交的直角坐标系α-β下，得到两相正交电流iα和iβ，通过Park变换将静止的两相正交坐标系α-β变换成跟随电机转子旋转的两相正交坐标系d-q，将强耦合、非线性的三相交流电流ia、ib、ic解耦成两相直流励磁电流id和转矩电流iq；具体变换公式如下：
Figure BDA0003226910810000122
Figure BDA0003226910810000123
Figure BDA0003226910810000124
A2：采用基于id＝0磁场定向控制，实际id与期望值0做比较，由于期望值固定为0，电流环PI控制器足以进行稳定校正控制；使用分数阶模糊控制器对转矩电流iq进行校正控制，分数阶模糊控制器的控制律如下：
u(k)＝(f(E,CE)+IE)Ku
Figure BDA0003226910810000125
其中E、CE、IE分别为误差、误差的分数阶微分、误差的积分；
Dα为分数阶微分算子如下：
Figure BDA0003226910810000131
其中hα(k)为脉冲响应序列；
Tc为采样频率模糊控制规则如下：
如果E＝NM，CE＝NS，那么U＝NL；
其中，E是误差，CE是误差的分数阶导数，U是输出，NL、NM、NS、ZR、PS、PM和PL分别代表“负大”、“负中”、“负小”、“零”、“正小”、“正中”和“正大”；
A3：对电流环校正输出的电压Vd、Vq进行Park逆变换，得到Vα、Vβ；通过SVWPM技术得到目标矢量电压，控制无刷电机；矢量电压计算公式如下：
Figure BDA0003226910810000132
A4：在电流环外部增加速度环控制，将实际转速与参考转速进行比较，同样使用共生生物搜索算法优化的分数阶模糊控制进行电机的转速校正，输出参考电流iq；
A5：使用扩展卡尔曼滤波器EKF作为电机的观测器，估计电机的转角
Figure BDA0003226910810000133
和转速
Figure BDA0003226910810000134
其中观测器的输入分别为Vα、Vβ、iα、iβ、θ，输出为
Figure BDA0003226910810000135
A6：速度环与电流环的分数阶模糊控制共有待整定10个，分别为α1、kp1、kd1、ki1、ku1、α2、kp2、kd2、ki2、ku2；使用共生生物搜索算法SOS进行优化，待整定参数(α1,kp1,kd1,ki1,ku2,α2,kp2,kd2,ki2,ku2)表示了共生生物搜索算法SOS算法的搜索维度，考虑到被控系统的瞬态响应的震荡性要求最优指标法采用ITAE准则，评价模型J如下，其中e(t)表示闭环误差函数：
Figure BDA0003226910810000141
更进一步的说明，共生生物搜索算法SOS步骤如下：
S1：初始化生态系统中的生物个体N，定义最大迭代次数；
S2：在生物个体空间中，找到最优个体；
S3：种群进入互利共生阶段；
S4：种群进入偏利共生阶段；
S5：种群进入寄生阶段；
S6：计算种群中各个体的适应度，适者生存；
S7：判断是否满足最大迭代次数；是则是输出最优个体，否则继续迭代。
元启发式算法是一个基于直观或经验构造的算法，它可以在可接受的花费(指计算时间和空间)下给出问题的一个可行解，并且该可行解与最优解的偏离程度不一定可以事先预计。
(1)SOS算法是一种元启发式算法，相对于其他元启发式算法，SOS算法在较少的评价函数的情况下能够获得更好的结果。SOS算法的三个阶段操作简单，不需要使用调优参数提高性能的稳定性。
(2)同时，由于其具有鲁棒性强、结构简单、易于实现、求解能力强等优点，更适合做嵌入式的移植，尤其是无人艇上的应用。在无人艇系统上的运行，使得SOS算法的寻优结果更为准确，大大提升了无人艇控制系统的性能。
更进一步的说明，共生生物搜索算法SOS的互利共生阶段：
Xinew＝Xi+rand(0,1)*(Xbest-Mutual_Vextor*BF1)
Xjnew＝Xj+rand(0,1)*(Xbest-Mutual_Vextor*BF2)
Figure BDA0003226910810000151
其中BF1、BF2是获利因子，取值1或0；
共生生物搜索算法SOS的偏利共生阶段：
Xinew＝Xi+rand(-1,1)*(Xbest-Xj)
其中，Xi在偏利共生阶段为单方面获利者，Xj不获利也不受到伤害；
共生生物搜索算法SOS：
Parasite_Vector＝Xi+rand(0,1)*Xi(pick)
使用人工寄生虫Parasite_Vector随机寄生个体Xi，并且对Xi进行复制和变异，如果Parasite_Vector比宿主Xi具有更好的适应值，则破坏宿主并将其替代，若相反则淘汰Parasite_Vector。
以上内容仅为本发明的较佳实施例，对于本领域的普通技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，本说明书内容不应理解为对本发明的限制。

Claims (3)

1.一种全向无人艇的控制方法，其特征在于,包括如下步骤：
步骤一：获取无人艇主控设置的期望值，初始化共生生物算法的种群以及最大迭代数；
步骤二：执行共生生物算法进行个体Xbest搜索，通过最优个体的值对控制器的参数进行整定；
步骤三：对控制器输出值进行反Park变换、SVPWM算法，得到控制推进装置的矢量电压，电机开始执行转动；
步骤四：采集推进装置的三相电流，经过扩展卡尔曼滤波器的估计后得到推进装置的位置
Figure FDA0003486200280000011
和转速
Figure FDA0003486200280000012
重复完成步骤一到步骤三；
SVPWM算法包括如下步骤：
通过判断输入电压Uα、Uβ的值确定合成的矢量电压Uref所在的扇区，
当Uα>0，Uβ>0且Uβ/Uα<√3时，Uref落在第I扇区；
当Uβ>0且Uβ/Uα>√3；Uref落在第Ⅱ扇区；
当Uα<0，Uβ>0且-Uβ/Uα<√3；Uref落在第Ⅲ扇区；
当Uα<0，Uβ<0且Uβ/Uα<√3；Uref落在第Ⅳ扇区；
当Uβ<0且-Uβ/Uα>√3；Uref落在第V扇区；
当Uα>0，Uβ<0且-Uβ/Uα<√3；Uref落在第Ⅵ扇区；
若Uref落在第Ⅰ扇区，Tx＝-Z,Ty＝X；
若Uref落在第Ⅱ扇区，Tx＝Z,Ty＝Y；
若Uref落在第Ⅲ扇区，Tx＝X,Ty＝-Y；
若Uref落在第Ⅳ扇区，Tx＝-X,Ty＝Z；
若Uref落在第V扇区，Tx＝-Y,Ty＝-Z；
若Uref落在第Ⅵ扇区，Tx＝Y,Ty＝-X；
再根据基准电压Udc以及Uα、Uβ计算出Uα、Uβ的对一个周期TS的Uref作用时长，作用时长Tx、Ty计算公式如下：
Figure FDA0003486200280000021
Figure FDA0003486200280000022
Figure FDA0003486200280000023
控制逆变桥电路合成指定扇区的矢量电压Uref；
步骤三包括如下步骤：
A1：对三相电枢绕组的任意两相电流ia、ib，通过Clarke变换，把三相电流变换到正交的直角坐标系α-β下，得到两相正交电流iα和iβ，通过Park变换将静止的两相正交坐标系α-β变换成跟随电机转子旋转的两相正交坐标系d-q，将强耦合、非线性的三相交流电流ia、ib、ic解耦成两相直流励磁电流id和转矩电流iq；具体变换公式如下：
Figure FDA0003486200280000024
Figure FDA0003486200280000025
Figure FDA0003486200280000026
Figure FDA0003486200280000031
A2：采用基于id＝0磁场定向控制，实际id与期望值0做比较，由于期望值固定为0，电流环PI控制器足以进行稳定校正控制；使用分数阶模糊控制器对转矩电流iq进行校正控制，分数阶模糊控制器的控制律如下：
u(k)＝(f(E,CE)+IE)Ku
u(k)＝(f(Kpe,KdDαe)+KiIe)·Ku
其中E、CE、IE分别为误差、误差的分数阶微分、误差的积分，待整定参数Kp、Kd、Ki分别是调节比例控制、微分控制和积分控制的权重，待整定参数Ku是总输出的权重；
Dα为分数阶微分算子如下：
Figure FDA0003486200280000032
其中hα(k)为脉冲响应序列；
Tc为采样频率模糊控制规则如下：
如果E＝NM，CE＝NS，那么U＝NL；
其中，E是误差，CE是误差的分数阶导数，U是输出，NL、NM、NS、ZR、PS、PM和PL分别代表“负大”、“负中”、“负小”“零”、“正小”、“正中”和“正大”；
A3：对电流环校正输出的电压Vd、Vq进行Park逆变换，得到Vα、Vβ；通过SVWPM技术得到目标矢量电压，控制无刷电机；矢量电压计算公式如下：
Figure FDA0003486200280000041
其中f为电源频率；
A4：在电流环外部增加速度环控制，将实际转速与参考转速进行比较，同样使用共生生物搜索算法优化的分数阶模糊控制进行电机的转速校正，输出参考电流iq；
A5：使用扩展卡尔曼滤波器EKF作为电机的观测器，估计电机的转角
Figure FDA0003486200280000042
和转速
Figure FDA0003486200280000043
其中观测器的输入分别为Vα、Vβ、iα、iβ、θ，输出为
Figure FDA0003486200280000044
A6：速度环与电流环的分数阶模糊控制共有待整定10个，分别为α1、kp1、kd1、ki1、ku1、α2、kp2、kd2、ki2、ku2；使用共生生物搜索算法SOS进行优化，待整定参数(α1,kp1,kd1,ki1,ku2,α2,kp2,kd2,ki2,ku2)表示了共生生物搜索算法SOS算法的搜索维度，考虑到被控系统的瞬态响应的震荡性要求最优指标法采用ITAE准则，评价模型J如下，其中e(t)表示闭环误差函数：
Figure FDA0003486200280000045
2.根据权利要求1所述的一种全向无人艇的控制方法，其特征在于，共生生物搜索算法SOS步骤如下：
S1：初始化生态系统中的生物个体N，定义最大迭代次数；
S2：在生物个体空间中，找到最优个体；
S3：种群进入互利共生阶段；
S4：种群进入偏利共生阶段；
S5：种群进入寄生阶段；
S6：计算种群中各个体的适应度，适者生存；
S7：判断是否满足最大迭代次数；是则是输出最优个体，否则继续迭代。
3.根据权利要求2所述的一种全向无人艇的控制方法，其特征在于：共生生物搜索算法SOS的互利共生阶段：
Xinew＝Xi+rand(0,1)*(Xbest-Mutual_Vextor*BF1)
Xjnew＝Xj+rand(0,1)*(Xbest-Mutual_Vextor*BF2)
Figure FDA0003486200280000051
其中BF1、BF2是获利因子，取值1或0；
共生生物搜索算法SOS的偏利共生阶段：
Xinew＝Xi+rand(-1,1)*(Xbest-Xj)
其中，Xi在偏利共生阶段为单方面获利者，Xj不获利也不受到伤害；
共生生物搜索算法SOS：
Parasite_Vector＝Xi+rand(0,1)*Xi(pick)
使用人工寄生虫Parasite_Vector随机寄生个体Xi，并且对Xi进行复制和变异，如果Parasite_Vector比宿主Xi具有更好的适应值，则破坏宿主并将其替代，若相反则淘汰Parasite_Vector。
CN202110974824.9A 2021-08-24 2021-08-24 一种全向无人艇及其控制系统、方法 Active CN113581439B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110974824.9A CN113581439B (zh) 2021-08-24 2021-08-24 一种全向无人艇及其控制系统、方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110974824.9A CN113581439B (zh) 2021-08-24 2021-08-24 一种全向无人艇及其控制系统、方法

Publications (2)

Publication Number Publication Date
CN113581439A CN113581439A (zh) 2021-11-02
CN113581439B true CN113581439B (zh) 2022-03-25

Family

ID=78239171

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110974824.9A Active CN113581439B (zh) 2021-08-24 2021-08-24 一种全向无人艇及其控制系统、方法

Country Status (1)

Country Link
CN (1) CN113581439B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116300426B (zh) * 2023-05-10 2023-11-14 南通大学 一种带监督机制的推力分配方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102042835A (zh) * 2010-11-05 2011-05-04 中国海洋大学 自主式水下机器人组合导航系统
CN104015911A (zh) * 2014-05-26 2014-09-03 中国船舶重工集团公司第七○二研究所 全回转一体化推进装置
CN111457902A (zh) * 2020-04-10 2020-07-28 东南大学 基于激光slam定位的水域测量方法及系统
KR20200092791A (ko) * 2019-01-25 2020-08-04 한국전자통신연구원 무인 선박 운항 시스템 및 방법
CN112462020A (zh) * 2020-11-25 2021-03-09 烟台职业学院 风光互补型双体式无人水质监测船
CN113086104A (zh) * 2021-03-24 2021-07-09 深圳市人工智能与机器人研究院 一种可自主拼接的模块化全向无人船

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
ES2713688T3 (es) * 2014-05-01 2019-05-23 Blue Robotics Inc Impulsor eléctrico sumergible

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102042835A (zh) * 2010-11-05 2011-05-04 中国海洋大学 自主式水下机器人组合导航系统
CN104015911A (zh) * 2014-05-26 2014-09-03 中国船舶重工集团公司第七○二研究所 全回转一体化推进装置
KR20200092791A (ko) * 2019-01-25 2020-08-04 한국전자통신연구원 무인 선박 운항 시스템 및 방법
CN111457902A (zh) * 2020-04-10 2020-07-28 东南大学 基于激光slam定位的水域测量方法及系统
CN112462020A (zh) * 2020-11-25 2021-03-09 烟台职业学院 风光互补型双体式无人水质监测船
CN113086104A (zh) * 2021-03-24 2021-07-09 深圳市人工智能与机器人研究院 一种可自主拼接的模块化全向无人船

Also Published As

Publication number Publication date
CN113581439A (zh) 2021-11-02

Similar Documents

Publication Publication Date Title
Lu et al. Design, fabrication, and characterization of a multimodal hybrid aerial underwater vehicle
Griffiths Technology and applications of autonomous underwater vehicles
McEwen et al. Docking control system for a 54-cm-diameter (21-in) AUV
Wang et al. A bio-inspired robot with undulatory fins and its control methods
Horn et al. A study on configuration of propellers for multirotor-like hybrid aerial-aquatic vehicles
Claus et al. Analysis and development of a buoyancy-pitch based depth control algorithm for a hybrid underwater glider
CN113581439B (zh) 一种全向无人艇及其控制系统、方法
Shang et al. Swimming locomotion modeling for biomimetic underwater vehicle with two undulating long-fins
CN104648685A (zh) 基于智能手机的四旋翼飞行器指定路径航拍系统和方法
Bibuli et al. Path-following algorithms and experiments for an autonomous surface vehicle
CN109649590A (zh) 一种波浪能和太阳能综合发电四体无人艇
Lee et al. State-feedback control of an internal rotor for propelling and steering a flexible fish-inspired underwater vehicle
Struebig et al. Design and development of the efficient anguilliform swimming robot—MAR
Free et al. Bioinspired pursuit with a swimming robot using feedback control of an internal rotor
CN113799562A (zh) 一种可跨越障碍的水空两栖无人船及控制方法
CN109501984B (zh) 一种可折叠翼帆及水下无人平台
Zhou et al. The design and application of an unmanned surface vehicle powered by solar and wind energy
Yaakob et al. Development of unmanned surface vehicle (USV) for sea patrol and environmental monitoring
Schofield et al. Potential field implementation for move-to-victim behavior for a lifeguard assistant unmanned surface vehicle
Yue et al. Characteristics evaluation of the vertical motion of a spherical underwater robot
Rhif et al. A sliding mode multimodel control for a sensorless photovoltaic system
Eubank et al. Unattended operation of an autonomous seaplane for persistent surface and airborne ocean monitoring
Gao et al. Innovative design and motion mechanism analysis for a multi-moving state autonomous underwater vehicles
Liu et al. Adventure-I: A mini-AUV prototype for education and research
Krznar Modelling and control of hybrid propulsion systems for multirotor unmanned aerial vehicles

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