[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN112180380B - Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller - Google Patents

Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller Download PDF

Info

Publication number
CN112180380B
CN112180380B CN202010907742.8A CN202010907742A CN112180380B CN 112180380 B CN112180380 B CN 112180380B CN 202010907742 A CN202010907742 A CN 202010907742A CN 112180380 B CN112180380 B CN 112180380B
Authority
CN
China
Prior art keywords
unmanned spacecraft
servo motor
control coefficient
brushless motor
rotor
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
CN202010907742.8A
Other languages
Chinese (zh)
Other versions
CN112180380A (en
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.)
South China University of Technology SCUT
Original Assignee
South China University of Technology SCUT
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 South China University of Technology SCUT filed Critical South China University of Technology SCUT
Priority to CN202010907742.8A priority Critical patent/CN112180380B/en
Publication of CN112180380A publication Critical patent/CN112180380A/en
Application granted granted Critical
Publication of CN112180380B publication Critical patent/CN112180380B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C35/00Flying-boats; Seaplanes
    • B64C35/005Flying-boats; Seaplanes with propellers, rudders or brakes acting in the water
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64CAEROPLANES; HELICOPTERS
    • B64C35/00Flying-boats; Seaplanes
    • B64C35/008Amphibious sea planes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/30Assessment of water resources

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Acoustics & Sound (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention discloses an ultrasonic underwater detection method for an unmanned airship driven by an air rotor and a propeller in a cooperative manner. The method comprises the following steps: receiving a control command to obtain a detection fixed point position; the flight reaches a detection fixed point; measuring and recording the gesture of the unmanned airship by using a gesture instrument, and counting the wave motion direction; controlling the unmanned airship to face to be perpendicular to the wave motion direction; controlling the unmanned airship to navigate around the detection fixed point; controlling an ultrasonic microarray to collect water area parameters; maintaining the attitude of the unmanned airship; if the unmanned airship needs to be scanned and detected, changing the rolling angle and the yaw angle of the unmanned airship and detecting; if the fixed-point water area detection is completed, receiving a control command and flying to the next detection fixed point, otherwise continuing to navigate and detect. The invention can improve the detection speed and the detection precision of the unmanned airship.

Description

空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller

技术领域technical field

本发明主要涉及无人船水域探测领域,具体涉及一种空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法。The invention mainly relates to the field of unmanned water area detection, in particular to an ultrasonic underwater detection method for an unmanned spaceship driven by an aerial rotor and a propeller.

背景技术Background technique

无人船是一种可以无需遥控,借助精确卫星定位和自身传感即可按照预设任务在水面航行的全自动水面机器人,英文名称为unmanned surface vessel,英文缩写为USV,无人船多用于测绘、水文和水质监测。用无人船代替人力可以大大地减少人力和提高效率,在以往的探测任务中,探测人员需要自身携带探测设备,搭载船艇前往探测地点进行水域探测,在探测过程中可能会出现船艇触礁,水域污染,天气恶劣等情况,威胁探测人员自身的安全,同时在一些空间狭窄,探测困难的环境下,探测员很难前往探测地点进行探测,无人船可以替代探测人员进行探测水域任务,探测人员可以通过远程操控无人船进行探测任务,也可以在一些环境下,让无人船自主智能地进行探测任务。An unmanned ship is a fully automatic surface robot that can sail on the water surface according to preset tasks with the help of precise satellite positioning and self-sensing without remote control. The English name is unmanned surface vessel, and the English abbreviation is USV. Unmanned ships are mostly used for Surveying, hydrology and water quality monitoring. Replacing manpower with unmanned ships can greatly reduce manpower and improve efficiency. In the past detection missions, the detection personnel need to carry their own detection equipment and carry boats to the detection location for water detection. During the detection process, the boat may run aground. , water pollution, bad weather and other conditions threaten the safety of the detectors themselves. At the same time, in some environments where the space is narrow and the detection is difficult, it is difficult for the detectors to go to the detection site for detection. Detectors can remotely control unmanned ships to carry out detection tasks, and in some environments, let unmanned ships carry out detection tasks autonomously and intelligently.

现有的无人船通过螺旋桨推动无人船在水面上航行,这种方式的航行速度普遍比较慢,降低探测效率。The existing unmanned ships propel the unmanned ships to sail on the water surface through propellers. The speed of sailing in this way is generally relatively slow, which reduces the detection efficiency.

现有的无人船在水面航行时容易受到波浪的影响导致船体出现摇摆,当使用超声微阵列进行水下探测时,这种波浪带来的晃动,使得水下探测模块在发送和接收信号两个时刻的姿态有比较大的变化,影响接收水下目标反射的超声回波信号,导致探测精度低。Existing unmanned ships are easily affected by waves when navigating on the water surface, causing the hull to sway. When ultrasonic microarrays are used for underwater detection, the shaking caused by the waves makes the underwater detection module transmit and receive signals. The attitude at each moment has a relatively large change, which affects the reception of the ultrasonic echo signal reflected by the underwater target, resulting in low detection accuracy.

无人船在使用超声微阵列进行水下探测时,超声微阵列向待测水域发射特定频谱结构的超声信号,超声微阵列接收水下目标反射的超声回波信号,进而计算出水域的各种参数。现有的无人船只能进行定点定向的水域探测,只能通过移动位置的方式来获取更大范围的水域参数。When an unmanned ship uses an ultrasonic microarray for underwater detection, the ultrasonic microarray transmits ultrasonic signals with a specific frequency spectrum structure to the water area to be measured, and the ultrasonic microarray receives the ultrasonic echo signals reflected by the underwater target, and then calculates various parameters of the water area. parameter. Existing unmanned ships can only conduct fixed-point and directional water area detection, and can only obtain a wider range of water area parameters by moving their positions.

发明内容Contents of the invention

本发明的目的是为了克服无人船容易受自然地理环境或人造工程屏障的限制、水下探测速度慢、探测时容易受到波浪影响而降低探测精度、水下探测时探测方式单一缺陷,提供一种空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,能方便快速地抵达探测水域,可控制无人飞船平衡,可控制无人飞船进行探测扫描,能降低吃水量,减少航行阻力,加快航行速度。The purpose of the present invention is to overcome the defects that the unmanned ship is easily limited by the natural geographical environment or artificial engineering barriers, the underwater detection speed is slow, the detection accuracy is easily affected by waves during detection, and the detection method is single during underwater detection. An aerial rotor and propeller cooperatively drive an unmanned spacecraft ultrasonic underwater detection method, which can reach the detection water area conveniently and quickly, can control the unmanned spacecraft balance, can control the unmanned spacecraft to perform detection and scanning, can reduce draft, reduce navigation resistance, and accelerate sailing speed.

本发明解决上述问题所采用的技术方案如下。The technical solution adopted by the present invention to solve the above problems is as follows.

一种空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,包括以下步骤:An aerial rotor and propeller cooperatively drive an unmanned spacecraft ultrasonic underwater detection method, comprising the following steps:

S1、接收控制命令得到探测定点位置;S1. Receive the control command to obtain the detection fixed-point position;

S2、使用飞行的方式到达探测定点;S2. Arrive at the detection point by means of flight;

S3、到达探测定点后,控制空中旋翼和螺旋桨静止一段时间,并使用姿态仪测量记录无人飞船的姿态变化率,统计波浪运动方向;S3. After arriving at the detection point, control the rotor and propeller in the air to stand still for a period of time, and use the attitude meter to measure and record the attitude change rate of the unmanned spacecraft, and count the direction of wave motion;

S4、控制无人飞船朝向垂直于波浪运动方向;S4. Control the direction of the unmanned spacecraft to be perpendicular to the direction of wave motion;

S5、控制无人飞船在探测定点周围航行;S5. Control the unmanned spacecraft to navigate around the detection point;

S6、控制超声微阵列采集水域参数;S6, controlling the ultrasonic microarray to collect water parameters;

S7、在控制超声微阵列采集水域参数时,保持无人飞船姿态;S7. When controlling the ultrasonic microarray to collect water parameters, maintain the attitude of the unmanned spacecraft;

S8、若需要进行扫描探测,改变无人飞船翻滚角和偏航角并进行保持,并返回步骤S6;S8. If scanning detection is required, change the roll angle and yaw angle of the unmanned spacecraft and keep it, and return to step S6;

S9、判断是否完成该定点周围水域环境探测,若否,返回步骤S5移动至该定点周围水域的另一位置进行探测;若是,返回步骤S1进行下一个探测点的水域探测。S9. Determine whether the detection of the water environment around the fixed point is completed. If not, return to step S5 and move to another location in the water area around the fixed point for detection; if yes, return to step S1 for water detection at the next detection point.

进一步地,所述步骤S1的探测定点位置是来自于远程用户指定的探测定点位置或者是来自于无人飞船根据路径规划得到的下一次探测定点的位置。Further, the detection fixed-point position in the step S1 is from the detection fixed-point position specified by the remote user or from the next detection fixed-point position obtained by the unmanned spacecraft according to the path planning.

进一步地,所述步骤S2的过程为:Further, the process of step S2 is:

无人飞船控制无人飞船上方空中旋翼转动提供推力Fz,推动无人飞船离开水面,其中无人飞船距离水面高度由分布在船底的超声微阵列得到,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:The unmanned spacecraft controls the rotation of the air rotors above the unmanned spacecraft to provide thrust F z to push the unmanned spacecraft away from the water surface. The height of the unmanned spacecraft from the water surface is obtained by the ultrasonic microarray distributed at the bottom of the ship. Brush motor throttle value and servo motor throttle value to control the orientation of each air rotor:

其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为无刷电机推力控制系数,/>为伺服电机零偏控制系数;Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the brushless motor thrust control coefficient, /> is the zero bias control coefficient of the servo motor;

无人飞船再控制无人飞船上方空中旋翼产生翻滚角力矩和俯仰角力矩τθ,改变无人飞船翻滚角和俯仰角,无人飞船上方空中旋翼转动产生的推力Fz因为翻滚角和俯仰角的变化产生水平的推力,使无人飞船水平飞行,其中无人飞船当前水平位置由卫星定位仪得到,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:The unmanned spacecraft then controls the air rotor above the unmanned spacecraft to generate roll angular moment and the pitch angle torque τ θ , changing the roll angle and pitch angle of the unmanned spacecraft, the thrust F z produced by the rotation of the air rotor above the unmanned spacecraft produces a horizontal thrust due to the change of the roll angle and pitch angle, so that the unmanned spacecraft flies horizontally, where The current horizontal position of the unmanned spacecraft is obtained by the satellite locator. At this time, the throttle value of the brushless motor controlling the rotation speed of each air rotor and the throttle value of the servo motor controlling the orientation of each air rotor are:

其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为无刷电机推力控制系数,/>为伺服电机零偏控制系数,/>为无刷电机翻滚角力矩控制系数,/>为无刷电机俯仰角力矩控制系数,/>为伺服电机翻滚角力矩控制系数,/>为伺服电机俯仰角力矩控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the brushless motor thrust control coefficient, /> is the zero bias control coefficient of the servo motor, /> is the brushless motor roll angle torque control coefficient, /> is the brushless motor pitch angle torque control coefficient, /> is the servo motor roll angle torque control coefficient, /> is the pitch angle torque control coefficient of the servo motor.

进一步地,所述步骤S3的过程为:使用姿态仪测量记录无人飞船的偏航角和俯仰角,并删除偏航角和俯仰角小于阈值的值,得到n组数据,由下式统计得到波浪运动方向和无人飞船船体的夹角α:Further, the process of step S3 is: use the attitude instrument to measure and record the yaw angle and pitch angle of the unmanned spacecraft, and delete the value of the yaw angle and pitch angle less than the threshold value to obtain n sets of data, which are obtained by the following statistics The angle α between the wave motion direction and the hull of the unmanned spacecraft:

其中为第i组无人飞船偏航角,θi为第i组无人飞船俯仰角,n为数据个数。in is the yaw angle of the i-th unmanned spacecraft, θ i is the pitch angle of the i-th unmanned spacecraft, and n is the number of data.

进一步地,所述步骤S4的过程为:控制无人飞船上方的空中旋翼产生偏航角力矩τψ,使无人飞船顺时针旋转此时无人飞船朝向与波浪运动方向垂直,其中,α为波浪运动方向和无人飞船船体的夹角,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:Further, the process of step S4 is: controlling the aerial rotor above the unmanned spacecraft to generate yaw angle torque τ ψ , so that the unmanned spacecraft rotates clockwise At this time, the orientation of the unmanned spacecraft is perpendicular to the direction of wave motion, where α is the angle between the direction of wave motion and the hull of the unmanned spacecraft. At this time, the throttle value of the brushless motor that controls the rotation speed of each air rotor and the servo that controls the orientation of each air rotor The motor throttle value is:

其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,psi,0为伺服电机零偏控制系数,为无刷电机偏航角力矩控制系数,/>为伺服电机偏航角力矩控制系数。Where m i is the throttle value of the i-th brushless motor, s i is the throttle value of the i-th servo motor, p si,0 is the zero-bias control coefficient of the servo motor, is the brushless motor yaw angle torque control coefficient, /> is the servo motor yaw angle torque control coefficient.

进一步地,所述步骤S5的过程为:控制无人飞船尾部下方的螺旋桨转动,提供向前推力Tf,推动无人飞船向前航行,控制无人飞船上方的空中旋翼产生偏航角力矩τψ和推力Fz,产生的偏航角力矩τψ用来控制航行方向,产生的推力Fz用来控制吃水量,其中无人飞船当前吃水量由分布在船底的压力计得到,此时控制各个空中旋翼转动速度的无刷电机油门值、控制各个空中旋翼朝向的伺服电机油门值和控制螺旋桨转动的水下无刷电机油门值为:Further, the process of step S5 is: control the rotation of the propeller under the tail of the unmanned spacecraft, provide forward thrust Tf, push the unmanned spacecraft to sail forward, and control the air rotor above the unmanned spacecraft to generate yaw angle torque τ ψ and thrust F z , the generated yaw angle moment τ ψ is used to control the navigation direction, and the generated thrust F z is used to control the draft. The current draft of the unmanned spacecraft is obtained by the pressure gauge distributed at the bottom of the ship. Throttle values of brushless motors for air rotor rotation speed, servo motor throttle values for controlling the orientation of each air rotor and underwater brushless motor throttle values for propeller rotation:

mu=kTf公式(10)mu = kT f formula (10)

其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为无刷电机推力控制系数,/>为伺服电机零偏控制系数,/>为无刷电机偏航角力矩控制系数,/>为伺服电机偏航角力矩控制系数,mu为水下无刷电机油门值,k为向前推力控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the brushless motor thrust control coefficient, /> is the zero bias control coefficient of the servo motor, /> is the brushless motor yaw angle torque control coefficient, /> is the yaw angle torque control coefficient of the servo motor, mu is the throttle value of the underwater brushless motor, and k is the forward thrust control coefficient.

进一步地,所述步骤S6的过程为:超声微阵列发送探测信号,根据接收到的探测信号,计算水域参数:基于超声接收回波与发射波信号的频偏计算水流速度;基于超声接收回波与发射波信号的时延计算水深;基于超声接收回波与发射波信号的时延、反射系数、波达方向参数,结合无人飞船的水面地理位置,反演水底的地形地貌。Further, the process of step S6 is: the ultrasonic microarray sends detection signals, and calculates the parameters of the water area according to the received detection signals: calculates the water flow velocity based on the frequency offset between the ultrasonic received echo and the transmitted wave signal; based on the ultrasonic received echo Calculate the water depth with the time delay of the transmitted wave signal; based on the time delay, reflection coefficient, and direction of arrival parameters of the ultrasonic received echo and transmitted wave signal, combined with the water surface location of the unmanned spacecraft, the topography of the bottom of the water is inverted.

进一步地,所述步骤S7的过程为:无人飞船以高频率采集姿态仪,得到无人飞船姿态、当检测到无人飞船姿态发生微小变化时,即刻控制空中旋翼产生翻滚角力矩俯仰角力矩τθ、偏航角力矩τψ;翻滚角力矩/>俯仰角力矩τθ、偏航角力矩τψ分别用于纠正无人飞船翻转角、俯仰角、偏航角,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:Further, the process of step S7 is: the unmanned spacecraft collects the attitude instrument at a high frequency to obtain the attitude of the unmanned spacecraft, and when a slight change in the attitude of the unmanned spacecraft is detected, the air rotor is immediately controlled to generate a roll angular moment Pitch angle moment τ θ , yaw angle moment τ ψ ; roll angle moment/> The pitch angle torque τ θ and the yaw angle torque τ ψ are used to correct the flip angle, pitch angle, and yaw angle of the unmanned spacecraft respectively. At this time, the throttle value of the brushless motor that controls the rotation speed of each air rotor and the control of the orientation of each air rotor The throttle value of the servo motor is:

其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为伺服电机零偏控制系数,/>为无刷电机翻滚角力矩控制系数,/>为无刷电机俯仰角力矩控制系数,为无刷电机偏航角力矩控制系数,/>为伺服电机翻滚角力矩控制系数,/>为伺服电机俯仰角力矩控制系数,/>为伺服电机偏航角力矩控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the zero bias control coefficient of the servo motor, /> is the brushless motor roll angle torque control coefficient, /> is the brushless motor pitch angle torque control coefficient, is the brushless motor yaw angle torque control coefficient, /> is the servo motor roll angle torque control coefficient, /> is the pitch angle torque control coefficient of the servo motor, /> is the servo motor yaw angle torque control coefficient.

进一步地,所述步骤S8的过程为:无人飞船控制空中旋翼产生翻滚角力矩偏航角力矩τψ,旋转无人飞船至指定翻滚角、指定偏航角,无人飞船船底超声微阵列会随着无人飞船的旋转而改变探测方向,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:Further, the process of step S8 is: the unmanned spacecraft controls the air rotor to generate the roll angular moment Yaw angle torque τ ψ , rotate the unmanned spacecraft to the specified roll angle and specified yaw angle, the ultrasonic microarray on the bottom of the unmanned spacecraft will change the detection direction with the rotation of the unmanned spacecraft, and at this time control the rotational speed of each rotor in the air Throttle value of the brushless motor and the servo motor throttle value controlling the orientation of each air rotor:

其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为伺服电机零偏控制系数,/>为无刷电机翻滚角力矩控制系数,/>为无刷电机俯仰角力矩控制系数,为无刷电机偏航角力矩控制系数,/>为伺服电机翻滚角力矩控制系数,/>为伺服电机俯仰角力矩控制系数,/>为伺服电机偏航角力矩控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the zero bias control coefficient of the servo motor, /> is the brushless motor roll angle torque control coefficient, /> is the brushless motor pitch angle torque control coefficient, is the brushless motor yaw angle torque control coefficient, /> is the servo motor roll angle torque control coefficient, /> is the pitch angle torque control coefficient of the servo motor, /> is the servo motor yaw angle torque control coefficient.

本发明相对于现有技术具有如下的优点及效果:Compared with the prior art, the present invention has the following advantages and effects:

(1)通过控制无人飞船空中旋翼产生的力矩来平衡无人飞船,保持超声微阵列探测方向,提高探测精度。(1) Balance the unmanned spacecraft by controlling the torque generated by the air rotor of the unmanned spacecraft, maintain the detection direction of the ultrasonic microarray, and improve the detection accuracy.

(2)通过控制无人飞船空中旋翼产生的力矩来主动改变无人飞船姿态,进而改变超声微阵列探测方向,实现扫描探测的功能;(2) Actively change the attitude of the unmanned spacecraft by controlling the torque generated by the air rotor of the unmanned spacecraft, and then change the detection direction of the ultrasonic microarray to realize the function of scanning detection;

(3)无人飞船空中旋翼产生的偏航角力矩和向上的推力可结合螺旋桨,实现控制吃水量的水面航行任务;(3) The yaw angle moment and upward thrust generated by the air rotor of the unmanned spacecraft can be combined with the propeller to realize the surface navigation task of controlling the draft;

(4)无人飞船空中旋翼转动产生推力控制无人飞船飞行,飞行所受阻力小于水面航行阻力,运动速度快。(4) The rotation of the rotor in the air of the unmanned spacecraft generates thrust to control the flight of the unmanned spacecraft. The resistance suffered by the flight is less than that of the water surface navigation, and the movement speed is fast.

附图说明Description of drawings

图1是本发明公开的一种空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法流程图;Fig. 1 is a flow chart of an ultrasonic underwater detection method for unmanned spaceships cooperatively driven by aerial rotors and propellers disclosed by the present invention;

图2是本发明实施中两旋翼无人飞船俯视图;Fig. 2 is a top view of the two-rotor unmanned spacecraft in the implementation of the present invention;

图3是本发明实施中两旋翼无人飞船右视图;Fig. 3 is the right view of the two-rotor unmanned spacecraft in the implementation of the present invention;

图4是本发明实施中两旋翼无人飞船剖视图。Fig. 4 is a sectional view of a two-rotor unmanned spacecraft in the implementation of the present invention.

具体实施方式Detailed ways

为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments It is a part of embodiments of the present invention, but not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the protection scope of the present invention.

实施例Example

本实施例将以两旋翼无人飞船为例,该两旋翼无人飞船船体结构如图2、图3、图4所示。该两旋翼无人飞船船体上方分布有一号伺服电机5、二号伺服电机6、一号无刷电机3、二号无刷电机4、一号空中旋翼1、二号空中旋翼2、尾部下方分布有1个无刷电机7和1个螺旋桨8,底部有超声微阵列10和压力传感器11,内壁有姿态仪12和卫星定位接收机13,顶部有卫星定位接收机天线9。该两旋翼无人飞船船体上方分布的一号伺服电机5、二号伺服电机6、一号无刷电机3、二号无刷电机4、一号空中旋翼1、二号空中旋翼2,连接方式为一号伺服电机5、二号伺服电机6通过支架固定在船体上方支架上,一号伺服电机5转轴固定有一号无刷电机3,二号伺服电机6转轴固定有二号无刷电机4,一号无刷电机3转轴固定一号空中旋翼1,二号无刷电机4转轴固定二号空中旋翼2。一号无刷电机3控制第一空中旋翼1正转,二号无刷电机4控制第二空中旋翼2反转。该两旋翼无人飞船船体上方的一号无刷电机3、二号无刷电机4和尾部下方的1个无刷电机7的油门值为0时,电机静止,油门值为1000时,电机达到最高转速。伺服电机油门值为500时,伺服电机转轴角度为90度,即一号伺服电机5、二号伺服电机6转轴上固定的一号无刷电机3、二号无刷电机4转轴垂直于船底,当伺服电机油门值为0时,伺服电机转轴角度为0度,即一号伺服电机5转轴上固定的一号无刷电机3转轴朝向船尾,即二号伺服电机6转轴上固定的二号无刷电机4转轴朝向船头。当伺服电机油门值为1000时,伺服电机转轴角度为180度,即一号伺服电机5转轴上固定的一号无刷电机3转轴朝向船头,即二号伺服电机6转轴上固定的二号无刷电机4转轴朝向船尾。This embodiment will take a two-rotor unmanned spacecraft as an example, and the hull structure of the two-rotor unmanned spacecraft is shown in FIG. 2 , FIG. 3 , and FIG. 4 . There are No. 1 servo motor 5, No. 2 servo motor 6, No. 1 brushless motor 3, No. 2 brushless motor 4, No. 1 air rotor 1, No. 2 air rotor 2, and distribution under the tail of the two-rotor unmanned spaceship. There is a brushless motor 7 and a propeller 8, an ultrasonic microarray 10 and a pressure sensor 11 at the bottom, an attitude indicator 12 and a satellite positioning receiver 13 on the inner wall, and a satellite positioning receiver antenna 9 at the top. The No. 1 servo motor 5, No. 2 servo motor 6, No. 1 brushless motor 3, No. 2 brushless motor 4, No. 1 air rotor 1, and No. 2 air rotor 2 distributed above the hull of the two-rotor unmanned spaceship. The No. 1 servo motor 5 and the No. 2 servo motor 6 are fixed on the bracket above the hull through brackets, the No. 1 servo motor 5 is fixed to the No. 1 brushless motor 3, and the No. 2 servo motor 6 is fixed to the No. 2 brushless motor 4. The No. 1 brushless motor 3 rotating shafts fix the No. 1 aerial rotor 1, and the No. 2 brushless motor 4 rotating shafts fix the No. 2 aerial rotor 2. No. 1 brushless motor 3 controls the first aerial rotor 1 to rotate forward, and No. 2 brushless motor 4 controls the second aerial rotor 2 to rotate backward. When the throttle value of No. 1 brushless motor 3, No. 2 brushless motor 4, and 1 brushless motor 7 below the tail of the hull of the two-rotor unmanned spaceship was 0, the motor was stationary, and when the throttle value was 1000, the motor reached maximum speed. When the throttle value of the servo motor is 500, the rotation axis angle of the servo motor is 90 degrees, that is, the rotation shafts of the No. 1 brushless motor 3 and No. 2 brushless motor 4 fixed on the shafts of the No. 1 servo motor 5 and No. 2 servo motor 6 are perpendicular to the bottom of the ship. When the servo motor throttle value is 0, the angle of the servo motor shaft is 0 degrees, that is, the No. 1 brushless motor 3 shaft fixed on the No. 1 servo motor 5 shaft is facing the stern, that is, the No. Brush motor 4 rotating shafts are towards the bow. When the throttle value of the servo motor is 1000, the angle of the servo motor shaft is 180 degrees, that is, the shaft of the No. 1 brushless motor 3 fixed on the shaft of No. 1 servo motor 5 is facing the bow, that is, the shaft of No. 2 servo motor 6 is fixed on the shaft of No. The 4 rotating shafts of the brushless motor are towards the stern.

如图1所示,该空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法的控制过程如下:As shown in Figure 1, the control process of the air rotor and propeller cooperatively driving the ultrasonic underwater detection method of the unmanned spacecraft is as follows:

S1、接收控制命令得到探测定点位置(xd,yd)。S1. Obtain the detection fixed point position (x d , y d ) by receiving the control command.

S2、使用飞行的方式到达探测定点(xd,yd)。控制无人飞船飞行步骤为:起飞、平飞、降落。S2. Arrive at the detection fixed point (x d , y d ) by flying. The steps to control the flight of the unmanned spacecraft are: takeoff, level flight, and landing.

起飞:无人飞船控制一号空中旋翼1、二号空中旋翼2产生推力Fz,推动无人飞船离开水面。平飞:控制无人飞船上方空中旋翼1、二号空中旋翼2产生翻滚角力矩和俯仰角力矩τθ,改变无人飞船翻滚角和俯仰角,无人飞船空中旋翼1、二号空中旋翼2转动产生的推力Fz因为翻滚角和俯仰角的变化产生水平的推力,使无人飞船水平飞行。降落:减小推力Fz。其中无人飞船距离水面高度由分布在船底的超声微阵列得到,无人飞船当前水平位置由卫星定位仪得到。Take-off: the unmanned spacecraft controls the No. 1 air rotor 1 and the No. 2 air rotor 2 to generate thrust F z to push the unmanned spacecraft away from the water surface. Level flight: control the air rotor 1 and the second air rotor 2 above the unmanned spacecraft to generate roll angular moment and the pitch angle torque τ θ , changing the roll angle and pitch angle of the unmanned spacecraft, the thrust F z produced by the rotation of the unmanned spacecraft air rotor 1 and the second air rotor 2 will produce horizontal thrust due to the change of the roll angle and pitch angle, so that the unmanned The human spaceship flies horizontally. Landing: reduce thrust F z . The height of the unmanned spacecraft from the water surface is obtained by the ultrasonic microarray distributed on the bottom of the ship, and the current horizontal position of the unmanned spacecraft is obtained by the satellite locator.

S3、到达探测定点(xd,yd)后,控制一号空中旋翼1、二号空中旋翼2和螺旋桨8静止一段时间,使用姿态仪测量记录无人飞船的(偏航角,俯仰角),并删除偏航角,俯仰角较小的值,得到n组数据,由下式统计得到波浪运动方向和无人飞船船体的夹角α:S3. After reaching the detection fixed point (x d , y d ), control No. 1 air rotor 1, No. 2 air rotor 2 and propeller 8 to stand still for a period of time, and use the attitude instrument to measure and record the (yaw angle, pitch angle) of the unmanned spacecraft , and delete the smaller values of yaw angle and pitch angle to obtain n sets of data, and obtain the angle α between the direction of wave motion and the hull of the unmanned spacecraft by the following statistics:

其中为第i组无人飞船偏航角,θi为第i组无人飞船俯仰角,n为数据个数。in is the yaw angle of the i-th unmanned spacecraft, θ i is the pitch angle of the i-th unmanned spacecraft, and n is the number of data.

S4、控制无人飞船上方的一号空中旋翼1、二号空中旋翼2产生偏航角力矩τψ,使无人飞船顺时针旋转此时无人飞船朝向与波浪运动方向垂直。S4. Control the No. 1 air rotor 1 and No. 2 air rotor 2 above the unmanned spacecraft to generate yaw angle torque τ ψ , so that the unmanned spacecraft rotates clockwise At this time, the orientation of the unmanned spaceship is perpendicular to the wave motion direction.

S5、控制无人飞船在探测定点周围航行。控制无人飞船水面航行步骤为:控制无人飞船尾部下方的螺旋桨转动,提供向前推力Tf,推动无人飞船向前航行,控制无人飞船上方的一号空中旋翼1、二号空中旋翼2产生偏航角力矩τψ和推力Fz,产生的偏航角力矩τψ用来控制航行方向,产生的推力Fz用来控制吃水量,无人飞船当前吃水量由分布在船底的压力计得到。S5. Control the unmanned spacecraft to navigate around the detection point. The steps of controlling the surface navigation of the unmanned spacecraft are: control the rotation of the propeller under the tail of the unmanned spacecraft, provide forward thrust Tf, push the unmanned spacecraft to sail forward, and control the No. 1 air rotor 1 and No. 2 air rotor 2 above the unmanned spacecraft. Generate yaw angle torque τ ψ and thrust F z , the generated yaw angle torque τ ψ is used to control the sailing direction, and the generated thrust F z is used to control the draft. The current draft of the unmanned spacecraft is determined by the pressure gauge distributed at the bottom of the ship get.

S6、控制超声微阵列发送探测信号,根据接收到的探测信号,计算水域参数:基于超声接收回波与发射波信号的频偏计算水流速度;基于超声接收回波与发射波信号的时延计算水深;基于超声接收回波与发射波信号的时延、反射系数、波达方向等参数,结合无人飞船的水面地理位置,反演水底的地形地貌。S6. Control the ultrasonic microarray to send the detection signal, and calculate the water area parameters according to the received detection signal: calculate the water flow velocity based on the frequency offset between the ultrasonic received echo and the transmitted wave signal; calculate the time delay based on the ultrasonic received echo and transmitted wave signal Water depth: based on parameters such as time delay, reflection coefficient, and direction of arrival of ultrasonic received echo and transmitted wave signal, combined with the geographical position of the water surface of the unmanned spacecraft, the topography of the bottom of the water is inverted.

S7、在控制超声微阵列采集水域参数时,保持无人飞船姿态。保持无人飞船姿态过程为:无人飞船以高频率采集姿态仪,得到无人飞船姿态、当检测到无人飞船姿态发生微小变化时,即刻控制一号空中旋翼1、二号空中旋翼2产生翻滚角力矩俯仰角力矩τθ、偏航角力矩τψ;翻滚角力矩/>俯仰角力矩τθ、偏航角力矩τψ分别用于纠正无人飞船翻转角、俯仰角、偏航角。S7. Maintain the attitude of the unmanned spacecraft when controlling the ultrasonic microarray to collect water parameters. The process of maintaining the attitude of the unmanned spacecraft is: the unmanned spacecraft collects the attitude instrument at a high frequency to obtain the attitude of the unmanned spacecraft, and when a slight change in the attitude of the unmanned spacecraft is detected, it immediately controls the No. roll angle moment Pitch angle moment τ θ , yaw angle moment τ ψ ; roll angle moment/> The pitch angle moment τ θ and the yaw angle moment τ ψ are used to correct the flip angle, pitch angle and yaw angle of the unmanned spacecraft respectively.

S8、若需要进行扫描探测,无人飞船控制一号空中旋翼1、二号空中旋翼2产生翻滚角力矩偏航角力矩τψ,旋转无人飞船至指定翻滚角、指定偏航角;无人飞船船底超声微阵列会随着无人飞船的旋转而改变探测方向。并返回步骤S6。S8. If scanning detection is required, the unmanned spacecraft controls No. 1 aerial rotor 1 and No. 2 aerial rotor 2 to generate roll angular moment The yaw angle torque τ ψ , rotate the unmanned spacecraft to the specified roll angle and specified yaw angle; the ultrasonic microarray on the bottom of the unmanned spacecraft will change the detection direction with the rotation of the unmanned spacecraft. And return to step S6.

S9、判断是否完成该定点周围水域环境探测,若否,返回步骤S5移动至该定点周围水域的另一位置进行探测。若是,返回步骤S1进行下一个探测点的水域探测。S9. Judging whether the detection of the water environment around the fixed point is completed, if not, return to step S5 and move to another location of the water area around the fixed point for detection. If yes, return to step S1 for water detection at the next detection point.

其中,推力Fz、翻滚角力矩俯仰角力矩τθ、偏航角力矩τψ是通过控制分布在无人飞船上方一号空中旋翼1、二号空中旋翼2的转速和朝向产生的;使无人飞船产生推力Fz、翻滚角力矩/>俯仰角力矩τθ、偏航角力矩τψ时,对应的无刷电机油门值和伺服电机油门值为:Among them, thrust F z , roll angular moment The pitch angle moment τ θ and the yaw angle moment τ ψ are generated by controlling the rotation speed and orientation of No. 1 air rotor 1 and No. 2 air rotor 2 distributed above the unmanned spacecraft; making the unmanned spacecraft generate thrust F z , roll angle Moment /> When pitch angle torque τ θ and yaw angle torque τ ψ , the corresponding brushless motor throttle value and servo motor throttle value are:

s1=-τθψ+500 公式(3-1)s 1 =-τ θψ +500 Formula (3-1)

s2=τθψ+500 公式(3-2)s 2θψ +500 Formula (3-2)

其中,m1为一号无刷电机3的油门值,m2为二号无刷电机4的油门值,s1为一号伺服电机5的油门值,s2为二号伺服电机6的油门值。Among them, m1 is the throttle value of No. 1 brushless motor 3, m2 is the throttle value of No. 2 brushless motor 4, s1 is the throttle value of No. 1 servo motor 5, and s2 is the throttle value of No. 2 servo motor 6 value.

其中,向前推力Ff是通过控制分布在无人飞船尾部下方的螺旋桨转速产生的;螺旋桨固定在一个水下无刷电机上,水下无刷电机油门值决定螺旋桨转速;使无人飞船产生向前的推力Tf时,对应的无刷电机油门值为:Among them, the forward thrust F f is generated by controlling the speed of the propeller distributed under the tail of the unmanned spacecraft; the propeller is fixed on an underwater brushless motor, and the throttle value of the underwater brushless motor determines the propeller speed; the unmanned spacecraft generates For forward thrust Tf, the corresponding brushless motor throttle value is:

mu=Tf 公式(4)mu = T f formula (4)

其中mu为无人飞船尾部下方的水下无刷电机7的油门值。Wherein mu is the throttle value of the underwater brushless motor 7 under the tail of the unmanned spacecraft.

综上所述,本发明通过控制无人飞船空中旋翼产生的力矩来平衡无人飞船,保持超声微阵列探测方向,提高探测精度;无人飞船空中旋翼产生的力矩还可用来主动改变无人飞船姿态,进而改变超声微阵列探测方向,实现扫描探测的功能;无人飞船空中旋翼产生的偏航角力矩和向上的推力可结合螺旋桨,实现控制吃水量的水面航行任务;无人飞船空中旋翼转动产生推力控制无人飞船飞行,飞行所受阻力小于水面航行阻力,运动速度快。In summary, the present invention balances the unmanned spacecraft by controlling the moment generated by the rotor in the air of the unmanned spacecraft, maintains the detection direction of the ultrasonic microarray, and improves the detection accuracy; the moment generated by the rotor in the air of the unmanned spacecraft can also be used to actively change the direction of the unmanned spacecraft attitude, and then change the detection direction of the ultrasonic microarray to realize the function of scanning detection; the yaw angle moment and upward thrust generated by the air rotor of the unmanned spacecraft can be combined with the propeller to realize the water surface navigation task of controlling the draft; the rotation of the air rotor of the unmanned spacecraft Thrust is generated to control the flight of the unmanned spacecraft, the flight resistance is less than that of water surface navigation, and the movement speed is fast.

上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。The above-mentioned embodiment is a preferred embodiment of the present invention, but the embodiment of the present invention is not limited by the above-mentioned embodiment, and any other changes, modifications, substitutions, combinations, Simplifications should be equivalent replacement methods, and all are included in the protection scope of the present invention.

Claims (8)

1.一种空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,包括以下步骤:1. an aerial rotor and propeller cooperatively drive unmanned spacecraft ultrasonic underwater detection method, it is characterized in that, comprises the following steps: S1、接收控制命令得到探测定点位置;S1. Receive the control command to obtain the detection fixed-point position; S2、使用飞行的方式到达探测定点,过程为:S2. Arrive at the detection point by means of flight, the process is: 无人飞船控制无人飞船上方空中旋翼转动提供推力Fz,推动无人飞船离开水面,其中无人飞船距离水面高度由分布在船底的超声微阵列得到,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:The unmanned spacecraft controls the rotation of the air rotors above the unmanned spacecraft to provide thrust F z to push the unmanned spacecraft away from the water surface. The height of the unmanned spacecraft from the water surface is obtained by the ultrasonic microarray distributed at the bottom of the ship. Brush motor throttle value and servo motor throttle value to control the orientation of each air rotor: 其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为无刷电机推力控制系数,/>为伺服电机零偏控制系数;Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the brushless motor thrust control coefficient, /> is the zero bias control coefficient of the servo motor; 无人飞船再控制无人飞船上方空中旋翼产生翻滚角力矩和俯仰角力矩τθ,改变无人飞船翻滚角和俯仰角,无人飞船上方空中旋翼转动产生的推力Fz因为翻滚角和俯仰角的变化产生水平的推力,使无人飞船水平飞行,其中无人飞船当前水平位置由卫星定位仪得到,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:The unmanned spacecraft then controls the air rotor above the unmanned spacecraft to generate roll angular moment and the pitch angle torque τ θ , changing the roll angle and pitch angle of the unmanned spacecraft, the thrust F z produced by the rotation of the air rotor above the unmanned spacecraft produces a horizontal thrust due to the change of the roll angle and pitch angle, so that the unmanned spacecraft flies horizontally, where The current horizontal position of the unmanned spacecraft is obtained by the satellite locator. At this time, the throttle value of the brushless motor controlling the rotation speed of each air rotor and the throttle value of the servo motor controlling the orientation of each air rotor are: 其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为无刷电机推力控制系数,/>为伺服电机零偏控制系数,/>为无刷电机翻滚角力矩控制系数,/>为无刷电机俯仰角力矩控制系数,/>为伺服电机翻滚角力矩控制系数,/>为伺服电机俯仰角力矩控制系数;Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the brushless motor thrust control coefficient, /> is the zero bias control coefficient of the servo motor, /> is the brushless motor roll angle torque control coefficient, /> is the brushless motor pitch angle torque control coefficient, /> is the servo motor roll angle torque control coefficient, /> is the pitch angle torque control coefficient of the servo motor; S3、到达探测定点后,控制空中旋翼和螺旋桨静止一段时间,并使用姿态仪测量记录无人飞船的姿态变化率,统计波浪运动方向;S3. After arriving at the detection point, control the rotor and propeller in the air to stand still for a period of time, and use the attitude meter to measure and record the attitude change rate of the unmanned spacecraft, and count the direction of wave motion; S4、控制无人飞船朝向垂直于波浪运动方向;S4. Control the direction of the unmanned spacecraft to be perpendicular to the direction of wave motion; S5、控制无人飞船在探测定点周围航行;S5. Control the unmanned spacecraft to navigate around the detection point; S6、控制超声微阵列采集水域参数;S6, controlling the ultrasonic microarray to collect water parameters; S7、在控制超声微阵列采集水域参数时,保持无人飞船姿态;S7. When controlling the ultrasonic microarray to collect water parameters, maintain the attitude of the unmanned spacecraft; S8、若需要进行扫描探测,改变无人飞船翻滚角和偏航角并进行保持,并返回步骤S6;S8. If scanning detection is required, change the roll angle and yaw angle of the unmanned spacecraft and keep it, and return to step S6; S9、判断是否完成该定点周围水域环境探测,若否,返回步骤S5移动至该定点周围水域的另一位置进行探测;若是,返回步骤S1进行下一个探测点的水域探测。S9. Determine whether the detection of the water environment around the fixed point is completed. If not, return to step S5 and move to another location in the water area around the fixed point for detection; if yes, return to step S1 for water detection at the next detection point. 2.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S1的探测定点位置是来自于远程用户指定的探测定点位置或者是来自于无人飞船根据路径规划得到的下一次探测定点的位置。2. The aerial rotor and propeller cooperatively drive the ultrasonic underwater detection method of the unmanned spacecraft according to claim 1, wherein the detection fixed-point position of the step S1 is from the detection fixed-point position specified by the remote user or from the The position of the next detection fixed point obtained by the unmanned spacecraft according to the path planning. 3.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S3的过程为:使用姿态仪测量记录无人飞船的偏航角和俯仰角,并删除偏航角和俯仰角小于阈值的值,得到n组数据,由下式统计得到波浪运动方向和无人飞船船体的夹角α:3. The aerial rotor and propeller cooperatively drive the ultrasonic underwater detection method of the unmanned spacecraft according to claim 1, wherein the process of the step S3 is: use the attitude instrument to measure and record the yaw angle and the pitch of the unmanned spacecraft Angle, and delete the value of yaw angle and pitch angle less than the threshold value, get n sets of data, and get the angle α between the direction of wave motion and the hull of the unmanned spacecraft by the following statistics: 其中为第i组无人飞船偏航角,θi为第i组无人飞船俯仰角,n为数据个数。in is the yaw angle of the i-th unmanned spacecraft, θ i is the pitch angle of the i-th unmanned spacecraft, and n is the number of data. 4.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S4的过程为:控制无人飞船上方的空中旋翼产生偏航角力矩τψ,使无人飞船顺时针旋转此时无人飞船朝向与波浪运动方向垂直,其中,α为波浪运动方向和无人飞船船体的夹角,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:4. The aerial rotor and propeller cooperatively drive the ultrasonic underwater detection method of the unmanned spacecraft according to claim 1, wherein the process of the step S4 is: controlling the aerial rotor above the unmanned spacecraft to generate the yaw angle moment τ ψ , making the unmanned spacecraft rotate clockwise At this time, the orientation of the unmanned spacecraft is perpendicular to the direction of wave motion, where α is the angle between the direction of wave motion and the hull of the unmanned spacecraft. At this time, the throttle value of the brushless motor that controls the rotation speed of each air rotor and the servo that controls the orientation of each air rotor The motor throttle value is: 其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为伺服电机零偏控制系数,/>为无刷电机偏航角力矩控制系数,/>为伺服电机偏航角力矩控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the zero bias control coefficient of the servo motor, /> is the brushless motor yaw angle torque control coefficient, /> is the servo motor yaw angle torque control coefficient. 5.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S5的过程为:控制无人飞船尾部下方的螺旋桨转动,提供向前推力Tf,推动无人飞船向前航行,控制无人飞船上方的空中旋翼产生偏航角力矩τψ和推力Fz,产生的偏航角力矩τψ用来控制航行方向,产生的推力Fz用来控制吃水量,其中无人飞船当前吃水量由分布在船底的压力计得到,此时控制各个空中旋翼转动速度的无刷电机油门值、控制各个空中旋翼朝向的伺服电机油门值和控制螺旋桨转动的水下无刷电机油门值为:5. The aerial rotor and propeller cooperatively driving the ultrasonic underwater detection method of unmanned spacecraft according to claim 1, wherein the process of step S5 is: controlling the rotation of the propeller under the tail of the unmanned spacecraft to provide forward thrust Tf, pushes the unmanned spacecraft to sail forward, controls the air rotor above the unmanned spacecraft to generate yaw angle torque τ ψ and thrust F z , the generated yaw angle torque τ ψ is used to control the navigation direction, and the generated thrust F z is used to To control the draft, the current draft of the unmanned spacecraft is obtained by the pressure gauge distributed at the bottom of the ship. At this time, the throttle value of the brushless motor controlling the rotation speed of each air rotor, the throttle value of the servo motor controlling the orientation of each air rotor and the rotation of the propeller The throttle value of the underwater brushless motor is: mu=kTf公式(10)mu = kT f formula (10) 其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为无刷电机推力控制系数,/>为伺服电机零偏控制系数,/>为无刷电机偏航角力矩控制系数,/>为伺服电机偏航角力矩控制系数,mu为水下无刷电机油门值,k为向前推力控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the brushless motor thrust control coefficient, /> is the zero bias control coefficient of the servo motor, /> is the brushless motor yaw angle torque control coefficient, /> is the yaw angle torque control coefficient of the servo motor, mu is the throttle value of the underwater brushless motor, and k is the forward thrust control coefficient. 6.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S6的过程为:超声微阵列发送探测信号,根据接收到的探测信号,计算水域参数;基于超声接收回波与发射波信号的频偏计算水流速度;基于超声接收回波与发射波信号的时延计算水深;基于超声接收回波与发射波信号的时延、反射系数、波达方向参数,结合无人飞船的水面地理位置,反演水底的地形地貌。6. The aerial rotor and propeller cooperatively driving the ultrasonic underwater detection method of the unmanned spacecraft according to claim 1, characterized in that, the process of the step S6 is: the ultrasonic microarray sends detection signals, and according to the received detection signals, Calculation of water parameters; calculation of water flow velocity based on the frequency offset of ultrasonic received echo and transmitted wave signals; calculation of water depth based on time delay of ultrasonic received echo and transmitted wave signals; time delay and reflection coefficient of ultrasonic received echo and transmitted wave signals , DOA parameters, combined with the water surface location of the unmanned spacecraft, to invert the topography of the bottom of the water. 7.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S7的过程为:无人飞船以高频率采集姿态仪,得到无人飞船姿态、当检测到无人飞船姿态发生微小变化时,即刻控制空中旋翼产生翻滚角力矩俯仰角力矩τθ、偏航角力矩τψ;翻滚角力矩/>俯仰角力矩τθ、偏航角力矩τψ分别用于纠正无人飞船翻转角、俯仰角、偏航角,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:7. The aerial rotor and propeller cooperatively driving the ultrasonic underwater detection method of the unmanned spacecraft according to claim 1, characterized in that, the process of the step S7 is: the unmanned spacecraft collects the attitude instrument at a high frequency to obtain the unmanned spacecraft Attitude, when a slight change in the attitude of the unmanned spacecraft is detected, the air rotor is immediately controlled to generate a roll angular moment Pitch angle moment τ θ , yaw angle moment τ ψ ; roll angle moment/> The pitch angle torque τ θ and the yaw angle torque τ ψ are used to correct the flip angle, pitch angle, and yaw angle of the unmanned spacecraft respectively. At this time, the throttle value of the brushless motor that controls the rotation speed of each air rotor and the control of the orientation of each air rotor The throttle value of the servo motor is: 其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为伺服电机零偏控制系数,/>为无刷电机翻滚角力矩控制系数,/>为无刷电机俯仰角力矩控制系数,/>为无刷电机偏航角力矩控制系数,/>为伺服电机翻滚角力矩控制系数,/>为伺服电机俯仰角力矩控制系数,/>为伺服电机偏航角力矩控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the zero bias control coefficient of the servo motor, /> is the brushless motor roll angle torque control coefficient, /> is the brushless motor pitch angle torque control coefficient, /> is the brushless motor yaw angle torque control coefficient, /> is the servo motor roll angle torque control coefficient, /> is the pitch angle torque control coefficient of the servo motor, /> is the servo motor yaw angle torque control coefficient. 8.根据权利要求1所述的空中旋翼与螺旋桨协同驱动无人飞船超声水下探测方法,其特征在于,所述步骤S8的过程为:无人飞船控制空中旋翼产生翻滚角力矩偏航角力矩τψ,旋转无人飞船至指定翻滚角、指定偏航角,无人飞船船底超声微阵列会随着无人飞船的旋转而改变探测方向,此时控制各个空中旋翼转动速度的无刷电机油门值和控制各个空中旋翼朝向的伺服电机油门值为:8. The aerial rotor and propeller cooperatively driving the ultrasonic underwater detection method of the unmanned spacecraft according to claim 1, wherein the process of step S8 is: the unmanned spacecraft controls the aerial rotor to generate a rolling angular moment Yaw angle torque τ ψ , rotate the unmanned spacecraft to the specified roll angle and specified yaw angle, the ultrasonic microarray on the bottom of the unmanned spacecraft will change the detection direction with the rotation of the unmanned spacecraft, and at this time control the rotational speed of each rotor in the air Throttle value of the brushless motor and the servo motor throttle value controlling the orientation of each air rotor: 其中mi为第i个无刷电机油门值,si为第i个伺服电机油门值,为伺服电机零偏控制系数,/>为无刷电机翻滚角力矩控制系数,/>为无刷电机俯仰角力矩控制系数,/>为无刷电机偏航角力矩控制系数,/>为伺服电机翻滚角力矩控制系数,/>为伺服电机俯仰角力矩控制系数,/>为伺服电机偏航角力矩控制系数。Where m i is the throttle value of the ith brushless motor, s i is the throttle value of the ith servo motor, is the zero bias control coefficient of the servo motor, /> is the brushless motor roll angle torque control coefficient, /> is the brushless motor pitch angle torque control coefficient, /> is the brushless motor yaw angle torque control coefficient, /> is the servo motor roll angle torque control coefficient, /> is the pitch angle torque control coefficient of the servo motor, /> is the servo motor yaw angle torque control coefficient.
CN202010907742.8A 2020-09-02 2020-09-02 Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller Active CN112180380B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010907742.8A CN112180380B (en) 2020-09-02 2020-09-02 Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010907742.8A CN112180380B (en) 2020-09-02 2020-09-02 Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller

Publications (2)

Publication Number Publication Date
CN112180380A CN112180380A (en) 2021-01-05
CN112180380B true CN112180380B (en) 2023-07-18

Family

ID=73924061

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010907742.8A Active CN112180380B (en) 2020-09-02 2020-09-02 Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller

Country Status (1)

Country Link
CN (1) CN112180380B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113093795B (en) * 2021-03-30 2022-04-22 华南理工大学 A semi-automatic wireless control method and device for unmanned watercraft
CN113093770B (en) * 2021-03-30 2022-03-29 华南理工大学 Surface take-off control method for multi-rotor unmanned spacecraft based on wave assessment
US20220380043A1 (en) * 2021-05-25 2022-12-01 Hydronalix, Inc. Unmanned aerial vehicle with underwater sonar scanning capability

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104724284A (en) * 2015-03-25 2015-06-24 朱威 Multi-rotor-wing submersible unmanned aerial vehicle and control method thereof
CN206031779U (en) * 2016-09-20 2017-03-22 南京信息工程大学 Four rotors small -size sampling boat that can fly
CN106986011A (en) * 2017-04-24 2017-07-28 西北工业大学 A kind of many latent unmanned vehicles of rotor sky
CN107065898A (en) * 2016-12-06 2017-08-18 北京臻迪科技股份有限公司 A kind of unmanned boat navigation control method and system under water
KR101845964B1 (en) * 2016-11-29 2018-04-05 한국해양과학기술원 Amphibious Drone To Explore Underwater And Midair
CN108859638A (en) * 2018-08-15 2018-11-23 长沙神弓信息科技有限公司 A kind of amphibious detection helicopter of No Tail Rotor high speed single rotor and its control method
CN109324629A (en) * 2017-07-31 2019-02-12 上海交通大学 Air, surface and underwater multi-dwelling vehicle and its control method
CN109946702A (en) * 2019-04-04 2019-06-28 广州丰谱信息技术有限公司 The ultrasonic undersea detection imaging system of machine ship one
CN110319811A (en) * 2019-06-27 2019-10-11 华南理工大学 A kind of underwater simple beam detected with high accuracy system and method for adaptive rough wave effect

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6951063B2 (en) * 2016-09-26 2021-10-20 川崎重工業株式会社 Attitude control method for underwater vehicle and underwater vehicle

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104724284A (en) * 2015-03-25 2015-06-24 朱威 Multi-rotor-wing submersible unmanned aerial vehicle and control method thereof
CN206031779U (en) * 2016-09-20 2017-03-22 南京信息工程大学 Four rotors small -size sampling boat that can fly
KR101845964B1 (en) * 2016-11-29 2018-04-05 한국해양과학기술원 Amphibious Drone To Explore Underwater And Midair
CN107065898A (en) * 2016-12-06 2017-08-18 北京臻迪科技股份有限公司 A kind of unmanned boat navigation control method and system under water
CN106986011A (en) * 2017-04-24 2017-07-28 西北工业大学 A kind of many latent unmanned vehicles of rotor sky
CN109324629A (en) * 2017-07-31 2019-02-12 上海交通大学 Air, surface and underwater multi-dwelling vehicle and its control method
CN108859638A (en) * 2018-08-15 2018-11-23 长沙神弓信息科技有限公司 A kind of amphibious detection helicopter of No Tail Rotor high speed single rotor and its control method
CN109946702A (en) * 2019-04-04 2019-06-28 广州丰谱信息技术有限公司 The ultrasonic undersea detection imaging system of machine ship one
CN110319811A (en) * 2019-06-27 2019-10-11 华南理工大学 A kind of underwater simple beam detected with high accuracy system and method for adaptive rough wave effect

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
关于水陆两栖救援飞行装置的探索;范昌明;《中国水运》;第19卷(第6期);第74-75页 *
旋翼型两栖无人机的发展现状及其在近海破障作战中的应用分析;齐铎等;《飞航导弹》(第11期);第43-47页 *

Also Published As

Publication number Publication date
CN112180380A (en) 2021-01-05

Similar Documents

Publication Publication Date Title
CN112180380B (en) Ultrasonic underwater detection method for unmanned spacecraft driven by aerial rotor and propeller
US11260949B2 (en) Marine vessel station keeping systems and methods
US3771483A (en) Apparatus and method for the automatic navigation of a sailing vessel
WO2017099219A1 (en) Route setting method for underwater vehicle, underwater vehicle optimum control method using same, and underwater vehicle
JP5581718B2 (en) Position calibration method for underwater vehicle
FI123871B (en) Procedures and systems for measuring movements in six degrees of freedom
CN110286390A (en) A specified path wind speed measurement method, device and wind radar calibration method
CN112631283A (en) Control system and control method for water-air amphibious unmanned aircraft
EP3696078A1 (en) A method and system for piloting an unmanned marine surface vessel
CN213262902U (en) Unmanned spaceship water area detection device with four rotors and single propeller
JP2022145659A (en) Coupling system between water surface relay machine and underwater vehicle, and operation method for the same
CN109030862A (en) A kind of gyroscope balancing device and its angle adaptive equalization adjusting method for ultrasonic aerovane
CN111813133A (en) An autonomous landing method for UAV ships based on relatively precise single-point positioning
EP0772787B1 (en) A system for underwater survey operations
US11486989B2 (en) Speed sensor calibration systems and methods
KR101827742B1 (en) Asv(autonomous surface vehicle) for shallow water survey competent movement and horizontal maintenance using drone
WO2022047669A1 (en) Ultrasound underwater detection method for air rotor and propeller co-driven unmanned aerial vehicle
CN108762289B (en) An Attitude Control Method for Flying Nodes for Underwater Seismic Wave Detection
JPH06289132A (en) Ones own position measuring type sonobuoy device and its position computing system
JP2023042263A (en) Method of inspecting wind turbine generator system
US3691978A (en) Apparatus for the automatic navigation of a sailing vessel
JP7279898B2 (en) SONAR SYSTEM, POSITION DIFFERENCE DETECTION METHOD AND PROGRAM
US20230259085A1 (en) Trim management system
AU2012200886A1 (en) System and method for determining the position of an underwater vehicle
US12197714B2 (en) Dynamically zoomed gauges systems and methods

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