CN115258164A - 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 - Google Patents
一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 Download PDFInfo
- Publication number
- CN115258164A CN115258164A CN202210834850.6A CN202210834850A CN115258164A CN 115258164 A CN115258164 A CN 115258164A CN 202210834850 A CN202210834850 A CN 202210834850A CN 115258164 A CN115258164 A CN 115258164A
- Authority
- CN
- China
- Prior art keywords
- tilting
- fixed
- unmanned aerial
- aerial vehicle
- main
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 8
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 claims description 92
- 229910052799 carbon Inorganic materials 0.000 claims description 92
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 70
- AZDRQVAHHNSJOQ-UHFFFAOYSA-N alumane Chemical group [AlH3] AZDRQVAHHNSJOQ-UHFFFAOYSA-N 0.000 claims description 31
- 230000035939 shock Effects 0.000 claims description 11
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 claims description 7
- 229910052782 aluminium Inorganic materials 0.000 claims description 7
- 230000003993 interaction Effects 0.000 claims description 7
- 238000004891 communication Methods 0.000 claims description 6
- 239000007921 spray Substances 0.000 claims description 6
- 239000002131 composite material Substances 0.000 claims description 5
- 230000003139 buffering effect Effects 0.000 claims description 4
- 238000011217 control strategy Methods 0.000 claims description 4
- 239000011359 shock absorbing material Substances 0.000 claims description 4
- 238000013522 software testing Methods 0.000 claims description 4
- 230000002159 abnormal effect Effects 0.000 claims description 3
- 230000005611 electricity Effects 0.000 claims description 3
- 230000000630 rising effect Effects 0.000 claims description 3
- 230000004069 differentiation Effects 0.000 claims description 2
- 238000011065 in-situ storage Methods 0.000 claims description 2
- 230000010354 integration Effects 0.000 claims description 2
- 206010034719 Personality change Diseases 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 10
- 230000001133 acceleration Effects 0.000 description 9
- 238000005507 spraying Methods 0.000 description 7
- 230000000875 corresponding effect Effects 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 229920000049 Carbon (fiber) Polymers 0.000 description 4
- 239000004917 carbon fiber Substances 0.000 description 4
- 230000002452 interceptive effect Effects 0.000 description 4
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 description 4
- 239000000575 pesticide Substances 0.000 description 4
- 238000005299 abrasion Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 238000000889 atomisation Methods 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 239000003814 drug Substances 0.000 description 2
- 239000010914 pesticide waste Substances 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000000295 fuel oil Substances 0.000 description 1
- 239000007788 liquid Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000000149 penetrating effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 238000007670 refining Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 238000009827 uniform distribution Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- 238000005406 washing Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D1/00—Dropping, ejecting, releasing, or receiving articles, liquids, or the like, in flight
- B64D1/16—Dropping or releasing powdered, liquid, or gaseous matter, e.g. for fire-fighting
- B64D1/18—Dropping or releasing powdered, liquid, or gaseous matter, e.g. for fire-fighting by spraying, e.g. insecticides
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01M—CATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
- A01M7/00—Special adaptations or arrangements of liquid-spraying apparatus for purposes covered by this subclass
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C1/00—Fuselages; Constructional features common to fuselages, wings, stabilising surfaces or the like
- B64C1/06—Frames; Stringers; Longerons ; Fuselage sections
- B64C1/061—Frames
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/04—Helicopters
- B64C27/08—Helicopters with two or more rotors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C27/00—Rotorcraft; Rotors peculiar thereto
- B64C27/32—Rotors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C39/00—Aircraft not otherwise provided for
- B64C39/02—Aircraft not otherwise provided for characterised by special use
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D1/00—Dropping, ejecting, releasing, or receiving articles, liquids, or the like, in flight
- B64D1/02—Dropping, ejecting, or releasing articles
- B64D1/08—Dropping, ejecting, or releasing articles the articles being load-carrying devices
- B64D1/12—Releasing
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D27/00—Arrangement or mounting of power plants in aircraft; Aircraft characterised by the type or position of power plants
- B64D27/02—Aircraft characterised by the type or position of power plants
- B64D27/24—Aircraft characterised by the type or position of power plants using steam or spring force
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Mechanical Engineering (AREA)
- Pest Control & Pesticides (AREA)
- Insects & Arthropods (AREA)
- Wood Science & Technology (AREA)
- Zoology (AREA)
- Environmental Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Toys (AREA)
Abstract
本发明公开了一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法,包括主升动力结构、倾转动力结构、主体机架结构;主体机架结构位于中间段;主升动力结构分布在主体机架结构的左右两端,倾转动力结构对称分布在主体机架机构和主升动力结构之间;本发明的矢量式动力结构,航姿变化灵活,能够保证无人机作业更为平滑、精准,提高作业效率,同时适应国内地形多变的复杂作业环境。
Description
技术领域
本发明涉及无人机控制和农业植保领域,是一种通过倾转旋翼调整姿态的直线型多旋翼植保无人机及控制方法。
背景技术
近年来,农业领域众多技术变革促进我国开始由农业大国向农业强国转变,集约化农业、精细化农业的提出,要求将科技融于农业之中。在农业植保领域,植保无人机的涌现预示着植保无人机代替传统喷雾机进行田间植保作业已被广泛认可。植保无人机不仅拥有更高的作业效率,还拥有比人工喷雾更好的喷洒效果,然而,现阶段植保无人机在实际应用中仍存在着诸多问题。
现阶段植保无人机主要为四旋翼无人机、固定翼无人机、直升机等。多旋翼无人机采用电机驱动,虽然成本低,但是因为体型较小、带载能力差、作业喷幅窄,并且旋翼间扰流作用明显,作业效率差,无法满足高效精细化作业的需求。固定翼植保无人机飞行高度高,滞空时间长,但是下压风场小,雾滴穿透性差、附着率低。同时,固定翼需要经过专业训练的飞手,个体种植户一般无法使用。植保直升机采用燃油驱动,在一定程度上可弥补前两者的缺陷,但其成本较高,后期维护价格高昂,对于飞手的整体素质要求更高,对农户的经济压力较大。专利CN202023305357.0中提出的直线型多旋翼植保飞行器通过直线型的结构,有效拓展作业喷幅,减小旋翼扰流作用,但控制困难,需要多个姿态调整电机维持飞行器姿态稳定,能源利用率差。
发明内容
针对以上问题,本发明提出了一种直线型倾转翼植保无人机及控制方法,利用倾转式结构,有效结合了直线型飞行器作业喷幅宽和固定翼能源利用率高的优点,满足现代化农业的需求。直线型机械结构直接增加无人机作业喷雾面积,同时“一”字型旋翼布局有效减小干扰,使旋翼下压风场均匀充分作业,减少由于重复作业造成的农药浪费。倾转翼结构电机的能源利用率高,航姿变化灵活,能够保证无人机作业更为平滑、精准。
本发明公开一种基于倾转旋翼的直线型多旋翼植保无人机。该植保无人机主要针对我国分散型种植地块,在大面积连续作业场景,一次性作业喷幅大,作业效率高。
本发明的技术方案包括:一种基于倾转旋翼的直线型多旋翼植保无人机结构,包括主升动力结构、倾转动力结构、主体机架结构;主体机架结构位于中间段;主升动力结构分布在主体机架结构的左右两端,倾转动力结构对称分布在主体机架机构和主升动力结构之间;
主升动力结构包括主升桨叶1、主升电机2、主升电机固定板3、主升电调4、第一管夹、离心喷头6、分控固定板7、主升分控电路板8、主杆9;主升桨叶1通过螺丝和主升电机2固定,主升电机2通过螺丝固定于主升电机固定板3上,再通过第一管夹夹持,与下端的离心喷头6一起固定在主杆9上;主升电调4和主升分控板8分别固定在两块分控固定板7上,通过第一管夹固定在主杆9,主升分控板8接收来自控制板26的命令,向主升电调4给出信号,从驱动主升电机2转动,离心喷头6内部集成电机电调,可直接通过接收主升分控电路板8的PWM信号驱动调速;
倾转动力结构包括倾转碳板10、倾转分控电路板11、舵机固定铝件12、舵机13、倾转电调14、夹持铝件15、第二管夹、倾转电机固定板17、轴承固定铝件18、倾转碳管19、轴承20、倾转电机21、倾转桨叶22;倾转碳板10上部通过螺丝固定倾转分控板11和倾转电调14;两块倾转碳板10上部通过第一管夹固定在主杆9上;倾转碳板10下端的中间部位设有倾转碳管19,倾转碳管19两端通过两个轴承20、两个第二管夹固定,轴承固定铝件18用于固定轴承20,两个夹持铝件15一方面共同箍住倾转碳管19,另一方面倾转碳管19上有一个穿孔,使夹持铝件15固定位置相对一致;靠近倾转碳管19一端的位置设有舵机固定铝件12,舵机固定铝件12固定舵机13,舵机13输出轴嵌套在夹持铝件15的凹槽内,带动整个倾转碳管19转动;倾转电机21上通过螺帽固定倾转桨叶22;倾转电机固定板17上倾转电机21的安装孔,可连接两个第二管夹固定在倾转碳管19上;
主体机架结构包括水平仪23、惯性导航模块24、减震垫25、控制板26、GPS天线27、烧录器28、遥控器接收机29、三通30、小电池31、小电池固定板32、水泵固定板33、水泵34、机载电池35、电池固定板36、横杆37、插销板38、水箱固定板39、脚架碳管40、水箱41、水位计42、起落碳管43、固定碳板44;惯性导航模块24、烧录器28、遥控器接收机29、水位计42通过控制板26上的接口和控制板26连接,向控制板26传递数据,小电池31通过控制板26上的电池接口,给控制板26和上述传感器供电;水平仪23、减震垫25、控制板26、GPS天线27、烧录器28、接收器29一起通过螺丝和固定碳板44硬连接;两个脚架碳管40通过三通30连接固定在主杆9;两个固定碳板44通过四个第一管夹、螺丝螺母固定在主杆9上;水泵固定板33通过两个第一管夹固定在脚架碳管40上,其上有水泵34的定位安装孔,方便水泵34的固定;小电池31通过电池扎带绑定在小电池固定板32上,可快速更换;小电池固定板32通过两个第一管夹固定在主杆9上;插销板38和水箱固定板39有相同的管夹定位孔,通过四个第一管夹固定在横杆37上,横杆37通过三通30与脚架碳管40连接;机载电池35是无人机主要的供电模块,通过电池扎带固定在电池固定板36上,电池固定板36通过滑槽与插销板38连接;水箱固定板39上有水箱41的定位安装孔,便于水箱固定;水位计42位于水箱41底部,依据超声波原理测量水箱的水位高度;两个脚架碳管40通过两个三通30分别与起落碳管43固定连接,用于无人机的落地缓冲。
进一步,所述夹持铝件15采用长舵臂的结构,可有效减少舵机13高频转动的齿轮磨损,同时倾转碳板10上留有足够裕量的空间,方便舵机13连接的夹持铝件15的360度转动。
进一步,惯性导航模块24通过三层减震材料与减震垫25粘连在一起;水平仪23用来对无人机初始角度进行零偏校准;GPS天线27用于惯性导航模块24接收GNSS数据;烧录器28用来无人机的软件测试;接收器29负责接收遥控器指令,将数据传输给控制板26。
进一步,插销板38上有滑槽结构,和提拉插销的定位孔,便于电池的快速更换。
本发明的一种基于倾转旋翼的直线型多旋翼植保无人机结构控制方法,包括以下步骤:
步骤1,分别建立无人机的三轴转动和平动动力学模型;
步骤2,主控芯片初始化,外接传感器初始化;
步骤3,无人机传感器自检,若自检不正常则通过外拓灯带显示报警并重复步骤3,若正常则进行步骤4;
步骤4,等待使用人机交互解锁,无人机从自锁状态切换到等待起飞状态;
步骤5,接收人机交互数据,无人机进行任务切换,任务具体为姿态模式、定高模式、定点模式以及一键降落模式,当GPS信号弱或丢失时,会强制从定点模式切换成定高模式。姿态模式下,无人机将读取和控制姿态角度、角速度相关信息;定高模式下,无人机将读取和控制姿态角度、角速度、速度和飞行高度信息;定点模式下,无人机将读取和控制姿态角度、角速度、速度、位置信息并支持航迹规划和跟踪功能;一键降落模式下,无人机会结束当前任务,原地慢慢下降;根据步骤1所建立的倾转翼植保无人机动力学模型,采用PID和自抗扰控制器相结合、串级控制和并级控制相结合的复合控制方式;为应对超长机身带来的控制信号容易丢失的问题,采用基于CAN通讯的主控-分控的主从控制策略;
步骤6,无人机安全着陆后,系统控制关闭,返回步骤4。
本发明的主升桨叶1为32寸碳纤维复合桨叶,负责提供持续稳定的下压风场和升力。主升电机2水平固定向主升桨叶1提供动力。针对不同电机旋转易产生耦合,设置主升电机2转速相同、转向相反,消除耦合。本发明的倾转桨叶22为22寸碳纤维复合桨叶,负责提供俯仰和偏航变化的升力。倾转电机21通过螺丝螺母固定在倾转电机固定板17上,并通过25mm管夹16固定于倾转碳管19上,保证电机与舵机同轴转动。通过控制舵机带动电机改变转向,完成俯仰角与偏航角的变化,增加整机的灵活性和续航时间。机身中部配有脚架碳管40,提供起飞与降落稳定点。机载电池35存放在机架横向碳杆伸出电池固定板36上端,作业药箱41固定在平面下端,确保整机重心位于主杆中下方,利于平衡控制。
考虑到直线型倾转多旋翼植保无人机采用一根3米长的碳管主杆9作为主要的承载、移动平台,信号线的排布较长易受干扰,本发明采用一种基于CAN总线通讯的主发从控的交互控制。控制板26为感知、运算和控制的主控板,倾转分控电路板11则通过CAN总线接受主控板指令,直接控制电机和舵机作相应的动作。
本发明控制方式用PID和自抗扰控制器相结合、串级控制和并级控制相结合的复合控制方式。倾转翼植保无人机在X轴方向可通过调整倾转旋翼直接获得相应的力,而不需要像寻常多旋翼无人机只能通过调整相应的姿态角来实现。该控制方式具体为将倾转翼植保无人机姿态控制与位置控制分为独立的两个控制体系,每个控制结构为串级反馈控制,然后将两个控制结果相加组合成并级控制。姿态控制由角度控制器、角速度控制器、角加速度控制器串级构成,角度数据与角速度数据由组合导航算法估计得到,角加速度由自抗扰控制算法中的微分跟踪器估计得到。位置控制与姿态控制类似,由位置控制器、速度控制器、加速度控制器串级组成,位置信息和速度信息由组合导航算法估计得到,加速度信息由微分跟踪器估计得到。
本发明主要应用于植保作业过程中的药液喷洒和颗粒播撒,针对各类平原、山地、丘陵等多样性和复杂性地形,能够满足多方向自主作业。与目前市面上多旋翼植保无人机不同,本发明采用有别于传统无人机的直线型飞行结构,两个主升电机2与两个倾转电机21等间距分布,保证了下洗风场的均匀分布,减少旋翼间扰流,使雾滴产生穿透力的同时更加均匀附着于作物冠层。对于不同作业场所可采用不同作业方式,针对小型地块或地势崎岖地形,采用单机作业,由操作员手动控制,携带与地块匹配的药箱和电池直接完成植保任务,体现植保作业的灵活性和可操作性。对于大型地块,主杆长度可根据作业需求调节,按场地规格灵活增大喷洒幅宽,提升作业效率。
本发明相比传统的植保无人机,创新点在于:
(1)“一”字形动力分布,主升动力结构、倾转动力结构、主体机架结构;主体机架结构位于中间段;主升动力结构分布在主体机架结构的左右两端,倾转动力结构对称分布在主体机架机构和主升动力结构之间;减小旋翼间的扰流作用,拓宽了喷幅,使旋翼下压风场均匀充分作业,减少由于重复作业造成的农药浪费,作业效果好。
(2)矢量式动力结构,航姿变化灵活,能够保证无人机作业更为平滑、精准,提高作业效率,同时适应国内地形多变的复杂作业环境。
(3)主发从控的交互控制,既可以保证长距离通讯不易受干扰,又可以通过实时监测与检验算法降低系统风险。
附图说明
图1为本发明整体结构示意图;
图2为本发明主升旋翼与喷杆连接部件示意图;
图3为本发明倾转动力结构示意图;(a)一面倾转动力结构示意图;(b)为另一面倾转动力结构示意图;
图4为本发明主体机架结构上部具体结构示意图;
图5为本发明主体机架结构示意图;
图6为本发明主发从控的交互控制示意图;
图7为本发明动力学模型尺寸标注图;
图8为本发明的控制系统框图;
图9为本发明的控制流程图;
图2中,1-主升桨叶、2-主升电机、3-主升电机固定板、4-主升电调、5-40mm管夹、6-离心喷头、7-分控固定板、8-主升分控板、9-主杆。
图3中,10-倾转碳板、11-倾转分控板、12-舵机固定铝件、13-舵机、14-倾转电调、15-夹持铝件、16-25mm管夹、17-倾转电机固定板、18-轴承固定铝件、19-倾转碳管、20-轴承、21-倾转电机、22-倾转桨叶。
图4中,23-水平仪、24-惯性导航模块、25-减震垫、26-控制板、27-GPS天线、28-烧录器、29-接收器。
图5中,30-三通、31-小电池、32-小电池固定板、33-水泵固定板、34-水泵、35-机载电池、36-电池固定板、37-横杆、38-插销板、39-水箱固定板、40-脚架碳管、41-水箱、42-水位计、43-起落碳管、44-固定碳板。
具体实施方式
本发明的一种基于倾转旋翼的直线型多旋翼植保无人机结构,包括主升动力结构、倾转动力结构、主体机架结构;主升动力结构包括主升桨叶1、主升电机2、主升电机固定板3、主升电调4、40mm管夹5(第一管夹)、离心喷头6、分控固定板7、主升分控电路板8、碳纤维主杆9;主升桨叶1优选32寸桨叶,通过螺丝和主升电机2固定。主升电机2通过螺丝固定于主升电机固定板3上,再通过40mm管夹5夹持,与离心喷头6一起固定在主杆9上。主升电机固定板3兼容市场上的大部分的电机安装孔,具有一定普适性。所述离心喷头6能够适用于多品种农药,雾化可调节,快速更换,有效提高本发明的植保效率。主升电调4和主升分控板8分别固定在两块分控固定板7上,通过40mm管夹5固定在主杆9,保证主升桨叶1的旋转不会受到干扰。单个主升分控板8可以控制1个主升电机2、1个离心喷头6。主升分控板8接收来自控制板26的命令,向主升电调4给出信号,从驱动主升电机2转动。离心喷头6内部集成电机电调,可直接通过接收主升分控板8的PWM信号驱动调速。
倾转动力结构包括倾转碳板10、倾转分控电路板11、舵机固定铝件12、舵机13、倾转电调14、夹持铝件15、25mm管夹16、倾转电机固定板17、轴承固定铝件18、倾转碳管19、轴承20、倾转电机21、倾转桨叶22;倾转碳板10上通过螺丝固定倾转分控板11和倾转电调14;两块倾转碳板10通过40mm管夹5固定在主杆9上;倾转碳管19通过两个轴承20、两个25mm管夹(第二管夹)固定在两块倾转碳板中间;所述轴承采用内径25毫米,外径37毫米的标准轴承,便于舵机13转动;两个夹持铝件15一方面共同箍住倾转碳管19,另一方面倾转碳管19上有一个穿孔,使夹持铝件15固定位置相对一致;舵机13输出轴嵌套在夹持铝件15的凹槽内,带动整个倾转碳管19转动;所述夹持铝件15采用长舵臂的结构,可有效减少舵机13高频转动的齿轮磨损,同时倾转碳板10上留有足够裕量的空间,方便舵机13连接的夹持铝件15的360度转动;倾转电机21上通过螺帽固定倾转桨叶22,;倾转电机固定板17上倾转电机21的安装孔,可连接两个25mm管夹16固定在倾转碳管19上。
主体机架结构包括水平仪23、惯性导航模块24、减震垫25、控制板26、GPS天线27、烧录器28、遥控器接收机29、三通30、小电池31、小电池固定板32、水泵固定板33、水泵34、机载电池35、电池固定板36、横杆37、插销板38、水箱固定板39、脚架碳管40、水箱41、水位计42、起落碳管43、固定碳板44。水平仪23、减震垫25、控制板26、GPS天线27、烧录器28、接收器29一起通过螺丝和固定碳板44硬连接。惯性导航模块24通过三层减震材料与减震垫25粘连在一起;水平仪23用来对无人机初始角度进行零偏校准;GPS天线27用于惯性导航模块24接收GNSS数据;烧录器28用来无人机的软件测试;接收器29负责接收遥控器指令,将数据传输给控制板26。两个脚架碳管40通过三通30连接固定在主杆9;两个固定碳板44通过四个40mm管夹5、螺丝螺母固定在主杆9上;水泵固定板33通过两个40mm管夹5固定在脚架碳管40,其上有水泵34的定位安装孔,方便水泵34的固定;小电池31通过电池扎带绑定在小电池固定板32上,可快速更换;小电池固定板32通过两个40mm管夹5固定在主杆9上;插销板38和水箱固定板39有相同的管夹定位孔,通过四个40mm管夹5固定在横杆37上,横杆37通过三通30与脚架碳管40连接;插销板38上有滑槽结构,和提拉插销的定位孔,便于电池的快速更换;机载电池35是无人机主要的供电模块,通过电池扎带固定在电池固定板36上,电池固定板36通过滑槽与插销板38连接;水箱固定板39上有水箱41的定位安装孔,便于水箱固定;水位计42位于水箱41底部,依据超声波原理测量水箱的水位高度;两个脚架碳管40通过两个三通30分别与起落碳管43固定连接,用于无人机的落地缓冲。
下面结合附图和实例对本发明作更进一步的说明。
图1所示的是本发明整体结构示意图。本发明采用3米长度的直径40毫米的碳纤维管作为主体,对称搭载2个垂直于机身朝下的倾转结构,该设计提高了倾转桨叶22的风场利用效率。
图2所示的是本发明的主升动力结构示意图。主升桨叶1优选32寸桨叶,是主要的升力来源。主升电机2通过螺丝固定于主升电机固定板3上,再通过40mm管夹5夹持,与离心喷头6一起固定在主杆9上。主升电机固定板3兼容市场上的大部分的电机安装孔,具有一定普适性。所述离心喷头6能够适用于多品种农药,雾化可调节,快速更换,有效提高本发明的植保效率。主升电调4和主升分控板8分别固定在两块分控固定板7上,通过40mm管夹5固定在主杆9,保证主升桨叶1的旋转不会受到干扰。单个主升分控板8可以控制1个主升电机2、1个离心喷头6。主升分控板8接收来自控制板26的命令,向主升电调4给出信号,从驱动主升电机2转动。离心喷头6内部集成电机电调,可直接通过接收主升分控板8的PWM信号驱动调速。
图3为本发明倾转动力结构示意图。本发明倾转碳板10上通过螺丝固定倾转分控板11和倾转电调14;两块倾转碳板10通过40mm管夹5固定在主杆9上;倾转碳管19通过两个轴承20、两个25mm管夹固定在两块倾转碳板中间;所述轴承采用内径25毫米,外径37毫米的标准轴承,便于舵机13转动;两个夹持铝件15一方面共同箍住倾转碳管19,另一方面倾转碳管19上有一个穿孔,使夹持铝件15固定位置相对一致;舵机13输出轴嵌套在夹持铝件15的凹槽内,带动整个倾转碳管19转动;所述夹持铝件15采用长舵臂的结构,可有效减少舵机13高频转动的齿轮磨损,同时倾转碳板10上留有足够裕量的空间,方便舵机13连接的夹持铝件15的360度转动;倾转电机21上通过螺帽固定倾转桨叶22,;倾转电机固定板17上倾转电机21的安装孔,可连接两个25mm管夹16固定在倾转碳管19上。
图4为本发明主体机架上部具体结构示意图,展示的是本发明主要的控制与测试模块。水平仪23、减震垫25、控制板26、GPS天线27、烧录器28、接收器29一起和固定碳板44硬连接。惯性导航模块24通过三层减震材料与减震垫25粘连在一起;水平仪23用来对无人机初始角度进行零偏校准;GPS天线27用于惯性导航模块24接收GNSS数据;烧录器28用来无人机的软件测试;接收器29负责接收遥控器指令,将数据传输给控制板26。
图5为本发明主体机架结构示意图。两个脚架碳管40通过三通30连接固定在主杆9;两个固定碳板44通过四个40mm管夹5、螺丝螺母固定在主杆9上;水泵固定板33通过两个40mm管夹5固定在脚架碳管40,其上有水泵34的定位安装孔,方便水泵34的固定;小电池31通过电池扎带绑定在小电池固定板32上,可快速更换;小电池固定板32通过两个40mm管夹5固定在主杆9上;插销板38和水箱固定板39有相同的管夹定位孔,通过四个40mm管夹5固定在横杆37上,横杆37通过三通30与脚架碳管40连接;插销板38上有滑槽结构,和提拉插销的定位孔,便于电池的快速更换;机载电池35是无人机主要的供电模块,通过电池扎带固定在电池固定板36上,电池固定板36通过滑槽与插销板38连接;水箱固定板39上有水箱41的定位安装孔,便于水箱固定;水位计42位于水箱41底部,依据超声波原理测量水箱的水位高度;两个脚架碳管40通过两个三通30分别与起落碳管43固定连接,用于无人机的落地缓冲。
图6为本发明主发从控的交互控制示意图。为应对超长机身带来的控制信号容易丢失的问题,本发明采用基于CAN通讯的主控-分控的主从控制策略,设计了实时检测、实时校验的算法,保证无人机在飞行时控制信号稳定可靠。控制板26为感知、运算和控制的主控板,倾转分控电路板11则通过CAN总线接受主控板指令,直接控制电机和舵机作相应的动作。两者之间实时监测与检验,当主控板发现分控板丢失时,会通过上层嵌入式系统板利用人机交互向使用者提供警报信息。同时分控板1、2(主升分控板8)监测到主控板(控制板26)丢失时,会立即进入保护机制,停止所有的电机和舵机控制,防止出现误动作伤害人员生命安全。
图7为本发明动力学模型尺寸标注图。本发明使用欧拉角θ、ψ描述无人机姿态,即机载坐标系与地面惯性坐标系之间的夹角。地面惯性坐标系采用东北天坐标系,其中,倾转翼植保无人机的质心为机载坐标系原点,X轴垂直于机臂指向机头,Y轴平行于机臂指向机头左侧,Z轴垂直于机臂向上。图7中,倾转电机距离主杆的长度为L1,主杆距离重心的长度为L2,倾转力臂长度为L3,主升力臂长度为L4,电机厚度为L5,左右舵机偏离垂直位置的角度分别为θL、θR(沿+Y方向观察,顺时针旋转为正),无人机总质量为m,重力加速度为g。本发明基于机体坐标系的三轴扭矩和四个旋翼产生的升力F=[FL2 FL1FR1 FR2]T进行动力学分析,得到三轴转动动力学模型:
其中,Ktorque表示空气反扭矩系数,反应了旋翼转动产生的升力和空气摩擦产生的反扭矩之间的关系。
同时建立无人机的三轴平动动力学模型:
图9为本发明的控制流程图。整个系统的执行步骤为:
步骤一,主控芯片初始化,外接传感器初始化。
步骤二,无人机传感器自检,若自检不正常则通过外拓灯带显示报警并重复步骤二,若正常则进行步骤三。
步骤三,等待使用人机交互解锁,无人机从自锁状态切换到等待起飞状态。
步骤四,接收人机交互数据,无人机进行任务切换,任务具体为姿态模式、定高模式、定点模式以及一键降落模式。当GPS信号弱或丢失时,会强制从定点模式切换成定高模式。姿态模式下,无人机将读取和控制姿态角度、角速度相关信息;定高模式下,无人机将读取和控制姿态角度、角速度、速度和飞行高度信息;定点模式下,无人机将读取和控制姿态角度、角速度、速度、位置信息并支持航迹规划和跟踪功能;一键降落模式下,无人机会结束当前任务,原地慢慢下降。
图8为本发明的控制系统框图,根据图7所建立的倾转翼植保无人机动力学模型,采用PID和自抗扰控制器相结合、串级控制和并级控制相结合的复合控制方式。倾转翼植保无人机在X轴方向可通过调整倾转旋翼直接获得相应的力,而不需要像寻常多旋翼无人机只能通过调整相应的姿态角来实现。该控制方式具体为将倾转翼植保无人机姿态控制与位置控制分为独立的两个控制体系,每个控制结构为串级反馈控制,然后将两个控制结果相加组合成并级控制。姿态控制由角度控制器、角速度控制器、角加速度控制器串级构成,角度数据与角速度数据由组合导航算法估计得到,角加速度由自抗扰控制算法中的微分跟踪器估计得到。位置控制与姿态控制类似,由位置控制器、速度控制器、加速度控制器串级组成,位置信息和速度信息由组合导航算法估计得到,加速度信息由微分跟踪器估计得到。为应对超长机身带来的控制信号容易丢失的问题,本发明采用上述提到的基于CAN通讯的主控-分控的主从控制策略。
步骤五,无人机安全着陆后,系统控制关闭,返回步骤三。
Claims (5)
1.一种基于倾转旋翼的直线型多旋翼植保无人机结构,其特征在于,包括主升动力结构、倾转动力结构、主体机架结构;主体机架结构位于中间段;主升动力结构分布在主体机架结构的左右两端,倾转动力结构对称分布在主体机架机构和主升动力结构之间;
主升动力结构包括主升桨叶1、主升电机2、主升电机固定板3、主升电调4、第一管夹、离心喷头6、分控固定板7、主升分控电路板8、主杆9;主升桨叶1通过螺丝和主升电机2固定,主升电机2通过螺丝固定于主升电机固定板3上,再通过第一管夹夹持,与下端的离心喷头6一起固定在主杆9上;主升电调4和主升分控板8分别固定在两块分控固定板7上,通过第一管夹固定在主杆9,主升分控板8接收来自控制板26的命令,向主升电调4给出信号,从驱动主升电机2转动,离心喷头6内部集成电机电调,可直接通过接收主升分控电路板8的PWM信号驱动调速;
倾转动力结构包括倾转碳板10、倾转分控电路板11、舵机固定铝件12、舵机13、倾转电调14、夹持铝件15、第二管夹、倾转电机固定板17、轴承固定铝件18、倾转碳管19、轴承20、倾转电机21、倾转桨叶22;倾转碳板10上部通过螺丝固定倾转分控板11和倾转电调14;两块倾转碳板10上部通过第一管夹固定在主杆9上;倾转碳板10下端的中间部位设有倾转碳管19,倾转碳管19两端通过两个轴承20、两个第二管夹固定,轴承固定铝件18用于固定轴承20,两个夹持铝件15一方面共同箍住倾转碳管19,另一方面倾转碳管19上有一个穿孔,使夹持铝件15固定位置相对一致;靠近倾转碳管19一端的位置设有舵机固定铝件12,舵机固定铝件12固定舵机13,舵机13输出轴嵌套在夹持铝件15的凹槽内,带动整个倾转碳管19转动;倾转电机21上通过螺帽固定倾转桨叶22;倾转电机固定板17上倾转电机21的安装孔,可连接两个第二管夹固定在倾转碳管19上;
主体机架结构包括水平仪23、惯性导航模块24、减震垫25、控制板26、GPS天线27、烧录器28、遥控器接收机29、三通30、小电池31、小电池固定板32、水泵固定板33、水泵34、机载电池35、电池固定板36、横杆37、插销板38、水箱固定板39、脚架碳管40、水箱41、水位计42、起落碳管43、固定碳板44;惯性导航模块24、烧录器28、遥控器接收机29、水位计42通过控制板26上的接口和控制板26连接,向控制板26传递数据,小电池31通过控制板26上的电池接口,给控制板26和上述传感器供电;水平仪23、减震垫25、控制板26、GPS天线27、烧录器28、接收器29一起通过螺丝和固定碳板44硬连接;两个脚架碳管40通过三通30连接固定在主杆9;两个固定碳板44通过四个第一管夹、螺丝螺母固定在主杆9上;水泵固定板33通过两个第一管夹固定在脚架碳管40上,其上有水泵34的定位安装孔,方便水泵34的固定;小电池31通过电池扎带绑定在小电池固定板32上,可快速更换;小电池固定板32通过两个第一管夹固定在主杆9上;插销板38和水箱固定板39有相同的管夹定位孔,通过四个第一管夹固定在横杆37上,横杆37通过三通30与脚架碳管40连接;机载电池35是无人机主要的供电模块,通过电池扎带固定在电池固定板36上,电池固定板36通过滑槽与插销板38连接;水箱固定板39上有水箱41的定位安装孔,便于水箱固定;水位计42位于水箱41底部,依据超声波原理测量水箱的水位高度;两个脚架碳管40通过两个三通30分别与起落碳管43固定连接,用于无人机的落地缓冲。
2.根据权利要求1所述的一种基于倾转旋翼的直线型多旋翼植保无人机结构,其特征在于,所述夹持铝件15采用长舵臂的结构,可有效减少舵机13高频转动的齿轮磨损,同时倾转碳板10上留有足够裕量的空间,方便舵机13连接的夹持铝件15的360度转动。
3.根据权利要求1所述的一种基于倾转旋翼的直线型多旋翼植保无人机结构,其特征在于,惯性导航模块24通过三层减震材料与减震垫25粘连在一起;水平仪23用来对无人机初始角度进行零偏校准;GPS天线27用于惯性导航模块24接收GNSS数据;烧录器28用来无人机的软件测试;接收器29负责接收遥控器指令,将数据传输给控制板26。
4.根据权利要求1所述的一种基于倾转旋翼的直线型多旋翼植保无人机结构,其特征在于,插销板38上有滑槽结构,和提拉插销的定位孔,便于电池的快速更换。
5.根据权利要求1所述的一种基于倾转旋翼的直线型多旋翼植保无人机结构控制方法,其特征在于,包括以下步骤:
步骤1,分别建立无人机的三轴转动和平动动力学模型;
步骤2,主控芯片初始化,外接传感器初始化;
步骤3,无人机传感器自检,若自检不正常则通过外拓灯带显示报警并重复步骤3,若正常则进行步骤4;
步骤4,等待使用人机交互解锁,无人机从自锁状态切换到等待起飞状态;
步骤5,接收人机交互数据,无人机进行任务切换,任务具体为姿态模式、定高模式、定点模式以及一键降落模式,当GPS信号弱或丢失时,会强制从定点模式切换成定高模式;姿态模式下,无人机将读取和控制姿态角度、角速度相关信息;定高模式下,无人机将读取和控制姿态角度、角速度、速度和飞行高度信息;定点模式下,无人机将读取和控制姿态角度、角速度、速度、位置信息并支持航迹规划和跟踪功能;一键降落模式下,无人机会结束当前任务,原地慢慢下降;根据步骤1所建立的倾转翼植保无人机动力学模型,采用PID和自抗扰控制器相结合、串级控制和并级控制相结合的复合控制方式;为应对超长机身带来的控制信号容易丢失的问题,采用基于CAN通讯的主控-分控的主从控制策略;
步骤6,无人机安全着陆后,系统控制关闭,返回步骤4。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210834850.6A CN115258164A (zh) | 2022-07-15 | 2022-07-15 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
GB2314658.2A GB2623883A (en) | 2022-07-15 | 2023-04-24 | Linear multi-rotor plant protection unmanned aerial vehicle structure based on tilt rotors and control method therefor |
PCT/CN2023/090241 WO2024012000A1 (zh) | 2022-07-15 | 2023-04-24 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210834850.6A CN115258164A (zh) | 2022-07-15 | 2022-07-15 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115258164A true CN115258164A (zh) | 2022-11-01 |
Family
ID=83765872
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210834850.6A Pending CN115258164A (zh) | 2022-07-15 | 2022-07-15 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115258164A (zh) |
WO (1) | WO2024012000A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116301026A (zh) * | 2023-01-13 | 2023-06-23 | 中国建筑一局(集团)有限公司 | 一种复杂环境下四旋翼无人机大机动敏捷飞行方法 |
WO2024012000A1 (zh) * | 2022-07-15 | 2024-01-18 | 江苏大学 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
CN117416504A (zh) * | 2023-12-19 | 2024-01-19 | 浙江大学 | 一种高扭矩密度的双自锁旋翼倾转机构 |
GB2623883A (en) * | 2022-07-15 | 2024-05-01 | Univ Jiangsu | Linear multi-rotor plant protection unmanned aerial vehicle structure based on tilt rotors and control method therefor |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101767943B1 (ko) * | 2015-05-08 | 2017-08-17 | 광주과학기술원 | 추력의 방향 설정이 가능한 멀티로터 타입의 무인 비행체 |
CN112352759A (zh) * | 2020-10-26 | 2021-02-12 | 江苏大学 | 一种多旋翼喷杆结构及其控制方法 |
CN214356673U (zh) * | 2020-12-15 | 2021-10-08 | 广州极飞科技股份有限公司 | 一种旋翼倾转驱动装置及无人机 |
CN113955114A (zh) * | 2021-11-23 | 2022-01-21 | 江苏大学 | 一种基于重心自适应调节装置的直线型无人机结构 |
CN115258164A (zh) * | 2022-07-15 | 2022-11-01 | 江苏大学 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
-
2022
- 2022-07-15 CN CN202210834850.6A patent/CN115258164A/zh active Pending
-
2023
- 2023-04-24 WO PCT/CN2023/090241 patent/WO2024012000A1/zh unknown
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024012000A1 (zh) * | 2022-07-15 | 2024-01-18 | 江苏大学 | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 |
GB2623883A (en) * | 2022-07-15 | 2024-05-01 | Univ Jiangsu | Linear multi-rotor plant protection unmanned aerial vehicle structure based on tilt rotors and control method therefor |
CN116301026A (zh) * | 2023-01-13 | 2023-06-23 | 中国建筑一局(集团)有限公司 | 一种复杂环境下四旋翼无人机大机动敏捷飞行方法 |
CN117416504A (zh) * | 2023-12-19 | 2024-01-19 | 浙江大学 | 一种高扭矩密度的双自锁旋翼倾转机构 |
CN117416504B (zh) * | 2023-12-19 | 2024-03-12 | 浙江大学 | 一种高扭矩密度的双自锁旋翼倾转机构 |
Also Published As
Publication number | Publication date |
---|---|
WO2024012000A1 (zh) | 2024-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115258164A (zh) | 一种基于倾转旋翼的直线型多旋翼植保无人机结构及控制方法 | |
CN204270115U (zh) | 一种植保无人机专用飞控系统 | |
CN101515178B (zh) | 基于can总线的主从负担式余度无人飞机自动驾驶仪 | |
US20120286102A1 (en) | Remotely controlled vtol aircraft, control system for control of tailless aircraft, and system using same | |
CN104597912A (zh) | 一种六旋翼无人直升机跟踪飞行控制系统及方法 | |
CN106945827B (zh) | 一种浮体抛离式两栖四旋翼无人机 | |
CN204399482U (zh) | 一种双旋翼共轴式安全防撞电动无人植保机 | |
CN204440169U (zh) | 微小型无人直升机多模态自主飞行的控制系统 | |
CN104407586A (zh) | 一种驱动解耦植保无人机的控制系统及控制方法 | |
CN106114854A (zh) | 一种无人驾驶航空器 | |
CN106114853A (zh) | 一种无人驾驶航空器 | |
CN103847963B (zh) | 一种无人驾驶动力三角翼飞行器 | |
CN208470114U (zh) | 一种植保无人飞机喷头主动平衡装置 | |
CN106527484B (zh) | 一种基于机电一体化的无人机飞行航线管理系统 | |
CN203727649U (zh) | 施药无人直升机 | |
CN102814047A (zh) | 双旋翼遥控模型直升机的自主返回系统及控制方法 | |
CN108706099A (zh) | 一种倾转三轴复合翼无人机及其控制方法 | |
CN108750120A (zh) | 一种植保无人飞机喷头主动平衡装置及调节方法 | |
CN100390020C (zh) | 超视距自主飞行无人驾驶直升机系统 | |
CN109896003A (zh) | 一种垂直起降倾转三旋翼无人机 | |
CN110091993B (zh) | 一种无人机的农药喷施控制系统 | |
CN206031791U (zh) | 一种适用于多旋翼无人机的喷杆调控装置 | |
CN204314726U (zh) | 一种六旋翼无人直升机跟踪飞行控制系统 | |
CN109901607A (zh) | 一种多旋翼无人机专用飞控系统 | |
CN117485556A (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 |