WO2024098334A1 - Thruster, water area movable device and stabilization control method therefor, and storage medium - Google Patents

Thruster, water area movable device and stabilization control method therefor, and storage medium Download PDF

Info

Publication number
WO2024098334A1
WO2024098334A1 PCT/CN2022/131174 CN2022131174W WO2024098334A1 WO 2024098334 A1 WO2024098334 A1 WO 2024098334A1 CN 2022131174 W CN2022131174 W CN 2022131174W WO 2024098334 A1 WO2024098334 A1 WO 2024098334A1
Authority
WO
WIPO (PCT)
Prior art keywords
rotating part
propeller
target
rotating
hull
Prior art date
Application number
PCT/CN2022/131174
Other languages
French (fr)
Chinese (zh)
Inventor
王海洋
陈观富
刘岳峰
Original Assignee
广东逸动科技有限公司
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 广东逸动科技有限公司 filed Critical 广东逸动科技有限公司
Priority to CN202280005741.1A priority Critical patent/CN117015500A/en
Priority to PCT/CN2022/131174 priority patent/WO2024098334A1/en
Publication of WO2024098334A1 publication Critical patent/WO2024098334A1/en

Links

Images

Definitions

  • the present application relates to the field of power technology for mobile equipment in water areas, and in particular, to a propeller, a mobile equipment in water areas, a roll reduction control method thereof, and a storage medium.
  • a propeller is a power device for movable devices in water areas such as ships, and is used to propel movable devices in water areas.
  • the power units of some mobile equipment in waters have a pitching axis and a steering axis, which can achieve the pitching and steering of the propeller to adjust the longitudinal inclination angle of the hull and the steering angle of the hull.
  • the current propellers cannot achieve attitude adjustments in more dimensions, resulting in insufficient flexibility in adjusting the hull's sailing attitude.
  • the present application provides a propeller with high flexibility in adjusting the operating state of a hull, as well as a movable device in water areas, a method for anti-rolling control of a movable device in water areas, and a storage medium.
  • the present application provides a propeller, comprising: a first rotating part, a second rotating part, a third rotating part and a propeller; the first rotating part is used to connect to a hull, and has at least one first rotational degree of freedom relative to the hull; the second rotating part is connected to the first rotating part, and has at least one second rotational degree of freedom relative to the first rotating part; the third rotating part is connected to the second rotating part, and has at least one third rotational degree of freedom relative to the second rotating part; the propeller is connected to the third rotating part, and can rotate relative to the third rotating part.
  • the first rotating part and the hull are connected in a manner with rotational freedom
  • the second rotating part and the first rotating part are connected in a manner with rotational freedom
  • the third rotating part and the second rotating part are also connected in a manner with rotational freedom.
  • the present application also provides a movable device in water areas, including a hull, an inertial navigation module and the aforementioned propeller.
  • the inertial navigation module is fixed to the hull and is used to sense the motion data of the hull.
  • the propeller is connected to the hull, and the propeller is provided with a main control module electrically connected to the inertial navigation module.
  • the main control module is used to perform attitude resolution on the motion data of the movable device in water areas and generate a balance control instruction, and the balance control instruction includes an angle control instruction and a displacement control instruction.
  • the angle control instruction is used to instruct the first rotating part, the second rotating part and/or the third rotating part to adjust the attitude to control the propeller to push the hull to turn to the target angle
  • the displacement control instruction is used to indicate the rotation speed and direction of the propeller to control the propeller to push the hull to move the target displacement.
  • the present application also provides a method for stabilizing the rolling of a mobile device in water area, which is used for stabilizing the rolling of the mobile device in water area.
  • the method for stabilizing the rolling of a mobile device in water area comprises:
  • the angle control instruction is used to instruct the first rotating part, the second rotating part and/or the third rotating part to adjust their posture to control the propeller to push the hull to turn to the target angle
  • the displacement control instruction indicates the rotation speed and direction of the propeller to control the propeller to push the hull to move the target displacement
  • the present application also provides a storage medium, which includes computer instructions.
  • the storage medium stores computer-readable instructions, and when the computer-readable instructions are executed by a processor, the aforementioned anti-rolling control method for a movable device in water area is implemented.
  • FIG1 is a schematic diagram of the structure of a mobile device for use in water areas according to an embodiment of the present application
  • FIG2 is a schematic structural diagram of another embodiment of the mobile device for use in water areas of the present application.
  • FIG3 is a schematic structural diagram of another embodiment of the mobile device for use in water areas of the present application.
  • FIG4 is a schematic structural diagram of a mobile device for use in water areas according to an embodiment of the present application when two thrusters are provided;
  • FIG5 is a control principle diagram of a movable device in water area in an embodiment of the present application.
  • FIG6 is a flow chart of a method for controlling the rolling stabilization of a mobile equipment in water area according to an embodiment of the present application
  • FIG. 7 is a schematic diagram of three types of rotational swings and three types of translational shaking of a movable device in water areas.
  • the third plane 20 is the third plane 20
  • the third motor 64 is the third motor 64
  • this embodiment provides a movable device 300 in waters, which may be a commercial ship, passenger ship, yacht, fishing boat, sailboat, civilian ship or other types of water transportation vehicles.
  • the movable device 300 in waters includes a hull 310 and a propeller 100 .
  • the hull 310 can provide a certain buoyancy, so that the movable device 300 in the water area can float on the water surface.
  • the specific structure of the hull 310 can be set as needed.
  • the propeller 100 is installed on the hull 310 to provide propulsion to push the mobile device 300 in the water.
  • the installation position of the propeller 100 can be set as needed, for example, non-limitingly, the method of installing it at the tail of the hull 310 shown in FIG. 1 is adopted.
  • the propeller 100 includes a first rotating part 11, a second rotating part 12, a third rotating part 13 and a propeller 14.
  • the propeller 14 can be driven to rotate to generate a propulsion force.
  • the first rotating part 11 is used to be connected to the hull 310, and has at least one first rotational degree of freedom relative to the hull 310.
  • the second rotating part 12 is connected to the first rotating part 11, and has at least one second rotational degree of freedom relative to the first rotating part 11.
  • the third rotating part 13 is connected to the second rotating part 12, and has at least one third rotational degree of freedom relative to the second rotating part 12.
  • the propeller 14 is connected to the third rotating part 13, and can rotate relative to the third rotating part 13.
  • the first rotating part 11 and the hull 310 are connected in a manner with rotational freedom
  • the second rotating part 12 and the first rotating part 11 are connected in a manner with rotational freedom
  • the third rotating part 13 and the second rotating part 12 are also connected in a manner with rotational freedom. This allows for more flexible adjustment of the position and posture of the propeller 14 connected at the end, which is beneficial for adjusting the operating state of the movable equipment 300 in the water area.
  • the propeller 100 further includes a prime mover 15, which is fixed to the third rotating part 13 and is used to drive the propeller 14 to rotate.
  • the prime mover 15 is a motor
  • the propeller 100 further includes a driver 16, which is electrically connected to the prime mover 15 and is used to drive the prime mover 15 to operate.
  • the location of the driver 16 can be set as needed, such as being set on the second rotating part 12 as shown in the figure, and is not limited here.
  • the prime mover 15 is fixed to the portion where the third rotating portion 13 is connected to the propeller 14 , and is connected to the shaft of the propeller 14 .
  • the prime mover 15 is fixed to the third rotating part 13 away from the propeller 14, and the propeller 100 further includes a transmission mechanism 17 connecting the prime mover 15 and the propeller 14.
  • the transmission mechanism 17 can be a gear transmission mechanism 17, a belt transmission mechanism, a chain transmission mechanism or other transmission mechanisms.
  • the prime mover 15 drives the propeller 14 to rotate through the transmission mechanism 17 to generate propulsion.
  • the first rotating part 11 can rotate in the first plane 18 relative to the hull 310 to adjust the pitch angle of the propeller 14;
  • the second rotating part 12 can rotate in the second plane 19 relative to the first rotating part 11 to adjust the steering angle of the propeller 14;
  • the third rotating part 13 can rotate in the third plane 20 relative to the second rotating part 12 to adjust the swing angle of the propeller 14;
  • the first plane 18, the second plane 19 and the third plane 20 are perpendicular to each other.
  • the length direction of the movable device 300 in water area (i.e., the front and rear direction of the hull 310) is defined as the first direction X
  • the width direction of the movable device 300 in water area i.e., the lateral direction of the hull 310) is defined as the second direction Y
  • the height direction of the movable device 300 in water area is defined as the third direction Z.
  • the aforementioned first plane 18 is a plane perpendicular to the second direction Y
  • the propeller 14 can be driven by the third rotating part 13, the second rotating part 12 and the first rotating part 11 to rotate relative to the hull 310 around the rotation axis of the first rotating part 11 (parallel to the second direction Y) (the rotation direction is shown by the first bidirectional rotating arrow 41 in the figure), so as to realize the raising or lowering of the propeller 14 to adjust the pitch angle, or to lift the propeller 14 out of the water when necessary.
  • the aforementioned second plane 19 is a plane perpendicular to the third direction Z.
  • the propeller 14 can be driven by the third rotating part 13 and the second rotating part 12 to rotate relative to the first rotating part 11 around the rotation axis of the second rotating part 12 (parallel to the third direction Z) (the rotation direction is shown by the second bidirectional rotation arrow 42 in the figure), thereby realizing the steering of the propeller 14 to adjust the rotation angle, which is used to change the forward direction of the hull 310.
  • the third plane 20 is a plane perpendicular to the first direction X.
  • the propeller 14 can be driven by the third rotating part 13 to rotate relative to the second rotating part 12 around the rotation axis of the third rotating part 13 (parallel to the first direction X) (the rotation direction is shown in the third bidirectional rotation arrow 43 in the figure), so as to realize the lateral swing of the propeller 14 to adjust the swing angle, which is used to change the draft of the propeller 14 and can play a role in controlling the lateral swing (i.e., rolling) of the hull 310.
  • the implementation method of controlling the lateral swing can be that when the hull 310 swings sideways, the propeller 14 swings in the direction opposite to the swing direction of the hull 310 to slow down the swing of the hull 310.
  • the specific structures of the first rotating part 11, the second rotating part 12 and the third rotating part 13 can be set as needed.
  • the first rotating part 11 includes a first bracket 21 and a first rotating shaft 22.
  • the axial direction of the first rotating shaft 22 is parallel to the second direction Y, and the first direction X, the second direction Y and the third direction Z are perpendicular to each other.
  • the first bracket 21 is rotatably connected to the stern of the hull 310 through the first rotating shaft 22, and the second rotating part 12 is connected to the first bracket 21.
  • the first rotating part 11 further includes a clamp 23 , which is detachably connected to the rear of the hull 310 , the first rotating shaft 22 is disposed on the clamp 23 , and the first bracket 21 is connected to the first rotating shaft 22 and can rotate with the first rotating shaft 22 .
  • an external force drives the first rotating shaft 22 to rotate relative to the clamp 23, thereby driving the first bracket 21, the second rotating part 12 connected to the first bracket 21, and the third rotating part 13 and the propeller 14 to rotate and warp together.
  • the first rotating shaft 22 can be replaced with a crank connecting rod mechanism on the basis of the embodiment shown in Figure 1, and the first bracket 21 can rotate relative to the clamp 23 through the crank connecting rod mechanism to drive the propeller 14 to adjust the warping angle relative to the hull 310, thereby adjusting the longitudinal inclination angle of the hull 310.
  • the first rotating part 11 also includes a first driving member 24, which is connected to the first rotating shaft 22 and is used to drive the first bracket 21 to rotate via the first rotating shaft 22.
  • the first driving member 24 is fixedly connected to the fixture 23, and its output shaft is connected to the first rotating shaft 22 through a coupling, so that when the first driving member 24 is running, it can drive the first rotating shaft 22 to rotate, and then drive the first bracket 21 to rotate.
  • the first driving member 24 can be a motor or a hydraulic driver or other equipment that can achieve rotational drive.
  • the first bracket 21 can also include a portion spaced from the fixture 23 along the first direction X, and a warping telescopic cylinder 24a is provided as the first driving member 24, the warping telescopic cylinder 24a is installed on the fixture 23, and the telescopic end of the warping telescopic cylinder 24a is connected to the first bracket 21 and can drive the first bracket 21 and the first rotating shaft 22 to rotate relative to the fixture 23 by extending or shortening to achieve warping.
  • the second rotating part 12 includes a second bracket 25 and a second rotating shaft 26, and the axis direction of the second rotating shaft 26 is parallel to the third direction Z.
  • the second bracket 25 is connected to the first bracket 21 through the second rotating shaft 26, and the third rotating part 13 is rotatably connected to the second bracket 25.
  • the lower end of the second rotating shaft 26 is connected to the first bracket 21, and the upper end is connected to the second bracket 25.
  • the second rotating part 12 also includes a second driving member 27, and the second driving member 27 is connected to the second rotating shaft 26, and is used to drive the second bracket 25 to rotate through the second rotating shaft 26.
  • the second driving member 27 can be a motor or a hydraulic drive or other equipment capable of realizing rotational drive.
  • the second driving member 27 can be used to drive the second bracket 25 to rotate relative to the first bracket 21 around the axis of the second rotating shaft 26, thereby driving the propeller 14 to turn relative to the hull 310, so that when the propeller 14 rotates, the hull 310 is adjusted to sail and turn.
  • the second bracket 25 is connected to a tiller handle 25a, which can be used by an operator to manually control the second bracket 25 to rotate around the second rotation axis 26 to achieve navigation and steering control of the hull 310. It can also be used by an operator to manually control the second bracket 25 and the first bracket 21 connected to the second bracket 25 and the first rotation axis 22 to rotate relative to the clamp 23 to achieve tilting control.
  • the driving control of the first driving member 24 (or the lifting and telescopic cylinder 24a) and the manual control of the operator through the tiller handle 25a can independently realize the lifting of the propeller 14; the driving control of the second driving member 27 and the manual control of the operator through the tiller handle 25a can independently realize the steering of the propeller 14.
  • the second bracket 25 includes a first connecting arm 28 and a second connecting arm 29.
  • the first connecting arm 28 is connected to the second rotating shaft 26 and extends in a direction perpendicular to the axis of the second rotating shaft 26.
  • the second connecting arm 29 is fixedly connected to the first connecting arm 28 and extends in a direction perpendicular to the first connecting arm 28.
  • the extension direction of the second connecting arm 29 is parallel to the axis of the second rotating shaft 26.
  • the third rotating portion 13 is connected to one end of the second connecting arm 29 away from the first connecting arm 28.
  • first connecting arm 28 and the second connecting arm 29 are connected to form an inverted L-shaped second bracket 25, the first connecting arm 28 extends toward the rear of the hull 310, and the second connecting arm 29 extends downward from the extended end of the first connecting arm 28.
  • the third rotating part 13 includes a third bracket 30 and a third rotating shaft 31, and the axial direction of the third rotating shaft 31 is parallel to the first direction X.
  • the third bracket 30 is connected to the second bracket 25 through the third rotating shaft 31, and the propeller 14 is rotatably connected to the third bracket 30.
  • the third rotating part 13 also includes a third driving member 32, and the third driving member 32 is connected to the third rotating shaft 31, and is used to drive the third bracket 30 to rotate through the third rotating shaft 31.
  • the third driving member 32 can be a motor or a hydraulic drive or other equipment that can achieve rotational drive.
  • the third rotating shaft 31 extends to the rear of the hull 310, and the third bracket 30 extends roughly along the third direction Z, with its upper end connected to the protruding end of the third rotating shaft 31 and the lower end used to install the propeller 14.
  • the third driving member 32 can drive the third bracket 30 to rotate around the third rotating axis 31 relative to the second bracket 25, thereby driving the propeller 14 to swing laterally relative to the hull, and can adjust the left and right swinging posture of the hull, thereby realizing multi-dimensional adjustment of the hull posture.
  • the propeller 100 further includes a power output shaft 34 rotatably disposed on the third bracket 30, and the propeller 14 is connected to the power output shaft 34 and obtains the rotation torque through the power output shaft 34.
  • the power output shaft 34 is driven by the aforementioned prime mover 15.
  • the propeller 100 also includes a torsion power machine fixed to the first rotating part 11, or the second rotating part 12, or the third rotating part 13, and the torsion power machine is used to provide rotational torque for at least one of the first rotating part 11, the second rotating part 12 and the third rotating part 13.
  • the propeller 100 in this embodiment also has an additional swinging degree of freedom, which can realize lateral swinging.
  • it can also realize the vertical lifting and lowering of the propeller 14, and on the other hand, the swinging degree of freedom can be combined with the rotation degree of freedom to reduce the swaying of the hull 310. Therefore, in this embodiment, the newly added third degree of freedom can realize the rotation of three degrees of freedom, so that the propeller 100 can reduce the swaying in all directions.
  • the propeller 100 can also be folded by swinging the degree of freedom to save more space.
  • the second connecting arm 29 and the third bracket 30 are both configured as a rod-shaped structure along the third direction Z, and the two are rotatably connected at the junction by a third rotation axis 31.
  • the third bracket 30 can be rotated and folded around the third rotation axis 31, so that the size of the propeller 100 in the third direction Z is reduced, which is convenient for packaging and transportation.
  • Fig. 3 shows that the movable device 300 in water area adopts another propeller 200.
  • the propeller 200 is different from the aforementioned propeller 100 in that the first rotating part 11, the second rotating part 12 and the third rotating part 13 have two or more rotational degrees of freedom, such as the first rotating part 11, the second rotating part 12 and the third rotating part 13 all have three rotational degrees of freedom.
  • the first rotating part 11 has three first rotational degrees of freedom relative to the hull 310, and the three first rotational degrees of freedom are respectively arranged in three first rotational planes perpendicular to each other.
  • the first rotating part 11 includes a first rotating joint 51 and a first steering arm 52 connected to the first rotating joint 51, and the first rotating joint 51 is provided with three first steering shafts 53 connected in sequence, and the three first steering shafts 53 are perpendicular to each other.
  • One end of the first steering arm 52 is connected to the hull 310 via the three first steering shafts 53, and the other end of the first steering arm 52 is connected to the second rotating part 12.
  • the first rotating part 11 also includes three first motors 54, and the three first motors 54 are respectively used to drive the three first steering shafts 53 to rotate, so as to drive the first steering arm 52 to rotate relative to the hull 310.
  • the second rotating part 12 has three second rotational degrees of freedom relative to the first rotating part 11, and the three second rotational degrees of freedom are respectively arranged in three second rotational planes perpendicular to each other.
  • the second rotating part 12 includes a second rotating joint 56 and a second steering arm 57 connected to the second rotating joint 56, the second rotating joint 56 is provided with three second steering shafts 58 connected in sequence, the three second steering shafts 58 are perpendicular to each other, one end of the second steering arm 57 is connected to the first rotating part 11 via the three second steering shafts 58, and the other end of the second steering arm 57 is connected to the third rotating part 13.
  • the second rotating part 12 also includes three second motors 59, and the three second motors 59 are respectively used to drive the three second steering shafts 58 to rotate, so as to drive the second steering arm 57 to rotate relative to the first rotating part 11.
  • the third rotating part 13 has three third rotational degrees of freedom relative to the second rotating part 12, and the three third rotational degrees of freedom are respectively arranged in three third rotational planes perpendicular to each other.
  • the third rotating part 13 includes a third rotating joint 61 and a third steering arm 62 connected to the third rotating joint 61, and the third rotating joint 61 is provided with three third steering shafts 63 connected in sequence, and the three third steering shafts 63 are perpendicular to each other.
  • One end of the third steering arm 62 is connected to the second rotating part 12 via the three third steering shafts 63, and the other end of the third steering arm 62 is connected to the propeller 14.
  • the third rotating part 13 also includes three third motors 64, and the three third motors 64 are respectively used to drive the three third steering shafts 63 to rotate, so as to drive the third steering arm 62 to rotate relative to the second rotating part 12.
  • the first rotating joint 51, the second rotating joint 56, and the third rotating joint 61 mentioned above may adopt a common rotating structure capable of realizing rotation of three mutually perpendicular axes, such as a universal joint with three rotational degrees of freedom, which is not limited here.
  • the mobile device 300 in water area further includes an inertial navigation module 320, which is fixed to the hull 310 and is used to sense the motion data of the hull 310.
  • the inertial navigation module 320 is an inertial navigation module, and the specific model can be selected as needed.
  • the propeller 100 is provided with a main control module 70 electrically connected to the inertial navigation module 320.
  • the main control module 70 is used to perform attitude calculation on the motion data of the movable device in the water area and generate a balance control instruction, which includes an angle control instruction and a displacement control instruction.
  • the angle control instruction is used to instruct the first rotating part 11, the second rotating part 12 and/or the third rotating part 13 to adjust the attitude so as to control the propeller 14 to push the hull 310 to turn to the target angle
  • the displacement control instruction is used to instruct the rotation speed and direction of the propeller 14 so as to control the propeller 14 to push the hull 310 to move the target displacement.
  • the balance control instruction also includes a rotation speed control instruction; the rotation speed control instruction indicates the rotation speed of the target rotating part in the target rotation direction.
  • the aforementioned angle control instruction includes a target rotation direction and a target rotation part; the target rotation direction indicates the rotation direction of the target rotation part, and the target rotation part indicates the rotation of at least one of the first rotation part 11, the second rotation part 12, and the third rotation part 13.
  • the angle control instruction also includes a target steering angle value, and the target steering angle value indicates the angle value of the target rotation part rotating in the target rotation direction.
  • the propeller can be provided as one or more.
  • the propeller can be provided at the middle position in the width direction of the tail of the hull 310; when multiple propellers are provided, the multiple propellers can be provided at intervals along the width direction of the hull 310.
  • the propeller can be the aforementioned propeller 100 or propeller 200.
  • FIG. 4 shows a simplified view of a mobile device 300 for use in waters with two propellers.
  • the two propellers are respectively arranged at the stern of a hull 310 and at both sides of the stern of the hull 310 in the width direction.
  • the provision of multiple thrusters not only improves the power source of the movable device 300 in the water area, but also makes the control more flexible.
  • the propeller used in the movable device 300 in the water area in this embodiment realizes rotation with more degrees of freedom by setting an additional third rotating part 13, and can more flexibly adjust the position and posture of the propeller 14, which is conducive to adjusting the operating state of the movable device 300 in the water area.
  • This embodiment also provides a method for stabilizing a movable device in water area, which is used for stabilizing the movable device 300 mentioned above.
  • the stabilization mentioned here refers to reducing the rotational sway or translational movement of the movable device 300 in water area.
  • the method for stabilizing a movable device in water area provided in this embodiment can well control the harmful sway of the hull 310, thereby improving the stability and riding comfort of the hull 310.
  • FIG5 shows a control principle diagram of the movable device 300 in the water area in this embodiment.
  • the inertial navigation module 320, the first driving member 24, the second driving member 27, the third driving member 32, and the prime mover 15 are electrically connected to the main control module 70 respectively.
  • the inertial navigation module 320 can transmit the motion data of the movable device in the water area sensed by it to the main control module 70, and the main control module 70 performs attitude settlement based on the motion data of the movable device in the water area, obtains a balance control instruction, and can control the operation of the first driving member 24, the second driving member 27, the third driving member 32, and the prime mover 15 through the balance control instruction, thereby controlling the movable device 300 in the water area to the desired position attitude or motion data.
  • the anti-rolling control method for a mobile device in water area includes the following steps:
  • the motion data of the movable device for water area acquired by the inertial navigation module 320 includes angular velocity, acceleration, magnetic field direction and Euler angle in the preset coordinate system of the movable device for water area 300.
  • the preset coordinate system of the movable device for water area 300 is constructed by taking the center of gravity of the movable device for water area 300 as the origin of the coordinate, the length direction of the movable device for water area 300 as the X axis, the width direction of the movable device for water area 300 as the Y axis, and the height direction of the movable device for water area 300 as the Z axis.
  • S2 Calculate the attitude of the motion data of the mobile equipment in the water area and generate balance control instructions
  • the balance control instruction includes an angle control instruction and a displacement control instruction.
  • the angle control instruction is used to instruct the first rotating part 11, the second rotating part 12 and/or the third rotating part 13 to adjust their postures so as to control the propeller 14 to push the hull 310 to turn to a target angle;
  • the displacement control instruction indicates the speed and direction of the propeller 14 so as to control the propeller 14 to push the hull 310 to move to a target displacement.
  • the quaternion method is used to perform attitude calculation on the motion data of the movable device for water areas, so as to obtain attitude data of the movable device for water areas 300; optionally, the attitude data of the movable device for water areas 300 includes a pitch angle, a roll angle and/or a yaw angle.
  • the angle control instruction includes a target rotation direction, a target rotation part and a target steering angle value, wherein the target steering angle value indicates the angle value of the target rotation part rotating in the target rotation direction; the target rotation direction indicates the rotation direction of the target rotation part; and the target rotation part indicates that at least one of the first rotation part 11, the second rotation part 12 and the third rotation part 13 rotates.
  • the third rotating part 13 of the propeller 100 is used as the target rotating part, and the target rotating part is controlled to rotate to the target steering angle value to control the propeller 14 to push the hull 310 to turn to the target angle.
  • the first rotation part 11 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target turning angle value, so as to control the propeller 14 to push the hull 310 to turn to the target angle.
  • the second rotation part 12 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to turn to the target angle.
  • the third rotation part 13 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to translate along the sway direction.
  • the second rotation part 12 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to translate along the surge direction.
  • the first rotating part 11 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to translate along the heave direction.
  • the aforementioned roll direction, pitch direction and bow swing direction refer to the reciprocating swing of the movable device 300 in the water area around the X-axis, Y-axis and Z-axis respectively;
  • the aforementioned surge direction, sway direction and vertical swing direction refer to the translation of the movable device 300 in the water area along the X-axis, Y-axis and Z-axis, which can be understood in conjunction with Figure 7.
  • control flow is executed cyclically, that is, the above steps S1 and S2 are performed again.
  • the present embodiment also includes a storage medium including computer instructions.
  • the storage medium stores computer-readable instructions.
  • the computer-readable instructions are executed by a processor, the aforementioned anti-rolling control method for a mobile device in water area is implemented.
  • the storage medium in this embodiment is applied to the main control module 70 of the mobile device 300 in water areas.
  • the main control module 70 reads and runs the computer-readable instructions stored in the storage medium, and executes the aforementioned anti-roll control method for the mobile device in water areas.
  • the main control module 70 in this embodiment includes but is not limited to structures such as a motor driver, a driving controller, a power management controller, and a temperature management controller.
  • the main control module 70 can also be used to interact with other modules on the mobile device 300 in water areas.

Landscapes

  • Toys (AREA)
  • Chemical & Material Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Combustion & Propulsion (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)

Abstract

A thruster, a water area movable device and a stabilization control method therefor, and a storage medium. The thruster comprises a first rotating part (11), a second rotating part (12), a third rotating part (13), and a propeller (14). The first rotating part (11) is connected to a hull (310) and has at least one first rotational degree of freedom relative to the hull (310). The second rotating part (12) is connected to the first rotating part (11) and has at least one second rotational degree of freedom relative to the first rotating part (11). The third rotating part (13) is connected to the second rotating part (12) and has at least one third rotational degree of freedom relative to the second rotating part (12). The propeller (14) is connected to the third rotating part (13) and can rotate relative to the third rotating part (13). The thruster can flexibly adjust the operation state of the water area movable device.

Description

推进器、水域可移动设备及其减摇控制方法以及存储介质Propeller, movable device in water area, anti-roll control method and storage medium thereof 技术领域Technical Field
本申请涉及水域可移动设备动力技术领域,具体而言,涉及推进器、水域可移动设备及其减摇控制方法以及存储介质。The present application relates to the field of power technology for mobile equipment in water areas, and in particular, to a propeller, a mobile equipment in water areas, a roll reduction control method thereof, and a storage medium.
背景技术Background technique
推进器,作为如船舶等水域可移动设备的动力装置,用于推动水域可移动设备在水域活动。A propeller is a power device for movable devices in water areas such as ships, and is used to propel movable devices in water areas.
一些水域可移动设备的动力装置具有起翘轴和转向轴,能够实现螺旋桨的起翘和转向动作,以调整船体的纵倾角,以及调整船体的转向角。然而,当船体面临更复杂的姿态调整时,目前的推进器并不能实现更多维度的姿态调整,导致对船体航行姿态调整的灵活性不够高。The power units of some mobile equipment in waters have a pitching axis and a steering axis, which can achieve the pitching and steering of the propeller to adjust the longitudinal inclination angle of the hull and the steering angle of the hull. However, when the hull faces more complex attitude adjustments, the current propellers cannot achieve attitude adjustments in more dimensions, resulting in insufficient flexibility in adjusting the hull's sailing attitude.
发明内容Summary of the invention
本申请提供对船体运行状态调整的灵活性高的推进器,以及水域可移动设备、水域可移动设备减摇控制方法及存储介质。The present application provides a propeller with high flexibility in adjusting the operating state of a hull, as well as a movable device in water areas, a method for anti-rolling control of a movable device in water areas, and a storage medium.
本申请提供一种推进器,包括:第一转动部、第二转动部、第三转动部及螺旋桨;所述第一转动部用于连接于船体,并相对所述船体具有至少一个第一转动自由度;所述第二转动部连接于所述第一转动部,并相对所述第一转动部具有至少一个第二转动自由度;所述第三转动部连接于所述第二转动部,并相对所述第二转动部具有至少一个第三转动自由度;所述螺旋桨连接所述第三转动部,并能够相对所述第三转动部旋转。The present application provides a propeller, comprising: a first rotating part, a second rotating part, a third rotating part and a propeller; the first rotating part is used to connect to a hull, and has at least one first rotational degree of freedom relative to the hull; the second rotating part is connected to the first rotating part, and has at least one second rotational degree of freedom relative to the first rotating part; the third rotating part is connected to the second rotating part, and has at least one third rotational degree of freedom relative to the second rotating part; the propeller is connected to the third rotating part, and can rotate relative to the third rotating part.
本申请的推进器中,第一转动部和船体之间为存在转动自由度的连接方式、第二转动部和第一转动部之间为存在转动自由度的连接方式,第三转动部和第二转动部之间也为存在转动自由度的连接方式,能够更灵活地调节连接在末端的螺旋桨的位置和姿态,利于灵活对水域可移动设备航行姿态的调整。In the propeller of the present application, the first rotating part and the hull are connected in a manner with rotational freedom, the second rotating part and the first rotating part are connected in a manner with rotational freedom, and the third rotating part and the second rotating part are also connected in a manner with rotational freedom. This allows for more flexible adjustment of the position and attitude of the propeller connected to the end, and facilitates flexible adjustment of the navigation attitude of movable equipment in water areas.
本申请还提供一种水域可移动设备,包括船体、惯导模块及前述推进器。所述惯导模块固定于所述船体,用于感测船体运动数据。所述推进器连接所述船体,所述推进器设有与所述惯导模块电连接的主控模块,所述主控模块用于将所述水域可移动设备的运动数据进行姿态解算,并产生平衡控制指令,所述平衡控制指令包括角度控制指令、位移控制指令。所述角度控制指令用于指示第一转动部、第二转动部和/或第三转动部调整姿态,以控制螺旋桨推动船体转向目标角度,所述位移控制指令用于指示所述螺旋桨的转速及转向,以控制螺旋桨推动所述船体移动目标位移。The present application also provides a movable device in water areas, including a hull, an inertial navigation module and the aforementioned propeller. The inertial navigation module is fixed to the hull and is used to sense the motion data of the hull. The propeller is connected to the hull, and the propeller is provided with a main control module electrically connected to the inertial navigation module. The main control module is used to perform attitude resolution on the motion data of the movable device in water areas and generate a balance control instruction, and the balance control instruction includes an angle control instruction and a displacement control instruction. The angle control instruction is used to instruct the first rotating part, the second rotating part and/or the third rotating part to adjust the attitude to control the propeller to push the hull to turn to the target angle, and the displacement control instruction is used to indicate the rotation speed and direction of the propeller to control the propeller to push the hull to move the target displacement.
本申请还提供一种水域可移动设备减摇控制方法,用于前述的水域可移动设备的减摇控制,水域可移动设备减摇控制方法包括:The present application also provides a method for stabilizing the rolling of a mobile device in water area, which is used for stabilizing the rolling of the mobile device in water area. The method for stabilizing the rolling of a mobile device in water area comprises:
获取惯导模块感测的水域可移动设备运动数据;Obtain the motion data of movable equipment in water area sensed by the inertial navigation module;
对所述水域可移动设备运动数据进行姿态解算,产生平衡控制指令,所述平衡控制指令包括角度控制指令和位移控制指令;Performing posture calculation on the motion data of the movable device in the water area to generate a balance control instruction, wherein the balance control instruction includes an angle control instruction and a displacement control instruction;
角度控制指令用于指示第一转动部、第二转动部和/或第三转动部调整姿态,以控制螺旋桨推动船体转向目标角度,所述位移控制指令指示所述螺旋桨的转速及转向,以控制螺旋桨推动所述船体移动目标位移。The angle control instruction is used to instruct the first rotating part, the second rotating part and/or the third rotating part to adjust their posture to control the propeller to push the hull to turn to the target angle, and the displacement control instruction indicates the rotation speed and direction of the propeller to control the propeller to push the hull to move the target displacement.
本申请还提供一种存储介质,所述存储介质包括计算机指令,所述存储介质上存储有计算机可读指令,所述计算机可读指令被处理器执行时实现前述的水域可移动设备减摇控制方法。The present application also provides a storage medium, which includes computer instructions. The storage medium stores computer-readable instructions, and when the computer-readable instructions are executed by a processor, the aforementioned anti-rolling control method for a movable device in water area is implemented.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
为了更清楚地说明本申请实施例的技术方案,下面将对实施例中的附图作简单地介绍,应当理解,以下附图仅示出了本申请的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings in the embodiments will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without creative work.
图1为本申请实施例的水域可移动设备的结构示意图;FIG1 is a schematic diagram of the structure of a mobile device for use in water areas according to an embodiment of the present application;
图2为本申请实施例的水域可移动设备的另一实施方式的结构示意图;FIG2 is a schematic structural diagram of another embodiment of the mobile device for use in water areas of the present application;
图3为本申请实施例的水域可移动设备的另一实施方式的结构示意图;FIG3 is a schematic structural diagram of another embodiment of the mobile device for use in water areas of the present application;
图4为本申请实施例的水域可移动设备的设置两个推进器时的结构示意图;FIG4 is a schematic structural diagram of a mobile device for use in water areas according to an embodiment of the present application when two thrusters are provided;
图5为本申请实施例中的水域可移动设备的控制原理图;FIG5 is a control principle diagram of a movable device in water area in an embodiment of the present application;
图6为本申请实施例中的水域可移动设备减摇控制方法的流程图;FIG6 is a flow chart of a method for controlling the rolling stabilization of a mobile equipment in water area according to an embodiment of the present application;
图7为水域可移动设备的三种旋转摆动和三种平移晃动的示意图。FIG. 7 is a schematic diagram of three types of rotational swings and three types of translational shaking of a movable device in water areas.
主要元件符号说明:Description of main component symbols:
水域可移动设备                     300Water movable equipment 300
船体                               310Hull                                   310
惯导模块                           320 Inertial navigation module 320
推进器                             100,200Thrusters                                100,200
第一方向                           XFirst Direction
第二方向                           YSecond direction Y
第三方向                           ZThe third direction Z
第一转动部                         11First rotating part 11
第二转动部                         12Second rotating part 12
第三转动部                         13The third rotating part 13
螺旋桨                             14 Propeller                                14
原动机                             15Prime mover                                15
驱动器                             16Drives                                 16
传动机构                           17 Transmission mechanism                           17
第一平面                           18 First plane                          18
第二平面                           19 Second plane                           19
第三平面                           20The third plane 20
第一支架                           21 First bracket                           21
第一转动轴                         22First rotating axis 22
夹具                               23 Clamp                               23
第一驱动件                         24 First driving member 24
起翘伸缩缸                         24aLifting telescopic cylinder                         24a
第二支架                            25 Second bracket                            25
舵柄                                25aTiller                                25a
第二转动轴                          26Second rotation axis 26
第二驱动件                          27Second driving member 27
第一连接臂                          28First connecting arm                          28
第二连接臂                          29Second connecting arm                          29
第三支架                            30The third bracket 30
第三转动轴                          31The third rotating axis 31
第三驱动件                          32Third driving member 32
动力输出轴                          34 Power output shaft                          34
第一双向旋转箭头                    41First two-way rotating arrow                    41
第二双向旋转箭头                    42Second bidirectional rotating arrow                    42
第三双向旋转箭头                    43The third bidirectional rotating arrow                    43
第一转动节                          51First rotating joint 51
第一转向臂                          52 First steering arm                          52
第一转向轴                          53First steering axis                          53
第一电机                            54 First Motor                            54
第二转动节                          56Second rotating joint                          56
第二转向臂                          57 Second steering arm                          57
第二转向轴                          58 Second steering axis 58
第二电机                            59 Second motor                            59
第三转动节                          61The third rotating joint 61
第三转向臂                          62 Third steering arm                          62
第三转向轴                          63Third steering axis 63
第三电机                            64The third motor 64
主控模块                            70 Main control module 70
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。The technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, rather than all of the embodiments.
需要说明的是,当元件被称为“固定于”另一个元件,它可以直接在另一个元件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元件,它可以是直接连接到另一个元件或者可能同时存在居中元件。当一个元件被认为是“设置于”另一个元件,它可以是直接设置在另一个元件上或者可能同时存在居中元件。本文所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的。It should be noted that when an element is referred to as being "fixed to" another element, it may be directly on the other element or there may also be a centered element. When an element is considered to be "connected to" another element, it may be directly connected to the other element or there may also be a centered element. When an element is considered to be "set on" another element, it may be directly set on the other element or there may also be a centered element. The terms "vertical", "horizontal", "left", "right" and similar expressions used herein are for illustrative purposes only.
除非另有定义,本文所使用的所有的技术和科学术语与属于本申请领域的技术人员通常理解的含义相同。本文中在本申请的说明书中所使用的术语只是为了描述具体的实施方式的目的,不是旨在于限制本申请。本文所使用的术语“或/及”包括一个或多个相关的所列项目的任意的和所有的组合。Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art of the present application. The terms used herein in the specification of the present application are only for the purpose of describing specific embodiments and are not intended to limit the present application. The term "or/and" used herein includes any and all combinations of one or more related listed items.
本申请的一些实施方式作详细说明。在不冲突的情况下,下述的实施方式及实施方式中的特征可以相互组合。Some embodiments of the present application are described in detail. In the absence of conflict, the following embodiments and features of the embodiments can be combined with each other.
实施例Example
参见图1,本实施例提供了一种水域可移动设备300,水域可移动设备300可以是商用船、客船、游艇、渔船、帆船、民船等各类水域交通工具。水域可移动设备300包括船体310和推进器100。1 , this embodiment provides a movable device 300 in waters, which may be a commercial ship, passenger ship, yacht, fishing boat, sailboat, civilian ship or other types of water transportation vehicles. The movable device 300 in waters includes a hull 310 and a propeller 100 .
船体310能够提供一定的浮力,使水域可移动设备300能够浮于水面。船体310的具体结构可以根据需要设置。The hull 310 can provide a certain buoyancy, so that the movable device 300 in the water area can float on the water surface. The specific structure of the hull 310 can be set as needed.
推进器100安装于船体310,用于提供推进力,以推动水域可移动设备300在水中移动。本实施例中,推进器100的安装位置可以根据需要设置,例如,非限制性地,采用图1示出的安装在船体310尾部的方式。The propeller 100 is installed on the hull 310 to provide propulsion to push the mobile device 300 in the water. In this embodiment, the installation position of the propeller 100 can be set as needed, for example, non-limitingly, the method of installing it at the tail of the hull 310 shown in FIG. 1 is adopted.
继续参见图1,本实施例中,推进器100包括第一转动部11、第二转动部12、第三转动部13及螺旋桨14。螺旋桨14可以受驱转动以产生推进力。1 , in this embodiment, the propeller 100 includes a first rotating part 11, a second rotating part 12, a third rotating part 13 and a propeller 14. The propeller 14 can be driven to rotate to generate a propulsion force.
其中,第一转动部11用于连接于船体310,并相对船体310具有至少一个第一转动自由度。第二转动部12连接于第一转动部11,并相对第一转动部11具有至少一个第二转动自由度。第三转动部13连接于第二转动部12,并相对第二转动部12具有至少一个第三转动自由度。螺旋桨14连接第三转动部13,并能够相对第三转动部13旋转。The first rotating part 11 is used to be connected to the hull 310, and has at least one first rotational degree of freedom relative to the hull 310. The second rotating part 12 is connected to the first rotating part 11, and has at least one second rotational degree of freedom relative to the first rotating part 11. The third rotating part 13 is connected to the second rotating part 12, and has at least one third rotational degree of freedom relative to the second rotating part 12. The propeller 14 is connected to the third rotating part 13, and can rotate relative to the third rotating part 13.
该推进器100中,第一转动部11和船体310之间为存在转动自由度的连接方式、第二转动部12和第一转动部11之间为存在转动自由度的连接方式,第三转动部13和第二转动部12之间也为存在转动自由度的连接方式,能够更灵活地调节连接在末端的螺旋桨14的位置和姿态,利于对水域可移动设备300运行状态的调整。In the propeller 100, the first rotating part 11 and the hull 310 are connected in a manner with rotational freedom, the second rotating part 12 and the first rotating part 11 are connected in a manner with rotational freedom, and the third rotating part 13 and the second rotating part 12 are also connected in a manner with rotational freedom. This allows for more flexible adjustment of the position and posture of the propeller 14 connected at the end, which is beneficial for adjusting the operating state of the movable equipment 300 in the water area.
本实施例中,推进器100还包括原动机15,原动机15固定于第三转动部13,用于驱动螺旋桨14旋转。可选地,原动机15为电机,推进器100还包括驱动器16,驱动器16电连接原动机15,用以驱动原动机15运行。驱动器16的设置位置可以根据需要设置,如图示设置在第二转动部12上,在此不做限定。In this embodiment, the propeller 100 further includes a prime mover 15, which is fixed to the third rotating part 13 and is used to drive the propeller 14 to rotate. Optionally, the prime mover 15 is a motor, and the propeller 100 further includes a driver 16, which is electrically connected to the prime mover 15 and is used to drive the prime mover 15 to operate. The location of the driver 16 can be set as needed, such as being set on the second rotating part 12 as shown in the figure, and is not limited here.
如图1示出的实施方式中,原动机15固定于第三转动部13连接螺旋桨14处,与螺旋桨14轴连接。In the embodiment shown in FIG. 1 , the prime mover 15 is fixed to the portion where the third rotating portion 13 is connected to the propeller 14 , and is connected to the shaft of the propeller 14 .
在另一种实施方式中,如图2,原动机15固定于第三转动部13远离螺旋桨14处,推进器100还包括连接原动机15和螺旋桨14的传动机构17。传动机构17可以是齿轮传动机构17、带传动机构、链传动机构或其他传动机构。原动机15通过传动机构17带动螺旋桨14转动以产生推进力。In another embodiment, as shown in FIG2 , the prime mover 15 is fixed to the third rotating part 13 away from the propeller 14, and the propeller 100 further includes a transmission mechanism 17 connecting the prime mover 15 and the propeller 14. The transmission mechanism 17 can be a gear transmission mechanism 17, a belt transmission mechanism, a chain transmission mechanism or other transmission mechanisms. The prime mover 15 drives the propeller 14 to rotate through the transmission mechanism 17 to generate propulsion.
本实施例中,第一转动部11能够相对船体310在第一平面18内转动,以调整螺旋桨14的俯仰角度;第二转动部12能够相对第一转动部11在第二平面19内转动,以调整螺旋桨14的转向角度;第三转动部13能够相对第二转动部12在第三平面20内转动,以调整螺旋桨14的摆动角度;第一平面18、第二平面19以及第三平面20互相垂直。In this embodiment, the first rotating part 11 can rotate in the first plane 18 relative to the hull 310 to adjust the pitch angle of the propeller 14; the second rotating part 12 can rotate in the second plane 19 relative to the first rotating part 11 to adjust the steering angle of the propeller 14; the third rotating part 13 can rotate in the third plane 20 relative to the second rotating part 12 to adjust the swing angle of the propeller 14; the first plane 18, the second plane 19 and the third plane 20 are perpendicular to each other.
为方便说明,定义水域可移动设备300的长度方向(即船体310的前后方向)为第一方向X、水域可移动设备300的宽度方向(即船体310的侧向)为第二方向Y、水域可移动设备300的高度方向为第三方向Z。For the convenience of explanation, the length direction of the movable device 300 in water area (i.e., the front and rear direction of the hull 310) is defined as the first direction X, the width direction of the movable device 300 in water area (i.e., the lateral direction of the hull 310) is defined as the second direction Y, and the height direction of the movable device 300 in water area is defined as the third direction Z.
如此,前述第一平面18即为垂直于第二方向Y的平面,螺旋桨14能够由第三转动部13、 第二转动部12和第一转动部11的带动而相对船体310绕第一转动部11的转动轴(平行于第二方向Y)旋转(旋转方向见图中的第一双向旋转箭头41),实现螺旋桨14的起翘或降下,以调整俯仰角度,或在需要时将螺旋桨14起翘至脱离水体。In this way, the aforementioned first plane 18 is a plane perpendicular to the second direction Y, and the propeller 14 can be driven by the third rotating part 13, the second rotating part 12 and the first rotating part 11 to rotate relative to the hull 310 around the rotation axis of the first rotating part 11 (parallel to the second direction Y) (the rotation direction is shown by the first bidirectional rotating arrow 41 in the figure), so as to realize the raising or lowering of the propeller 14 to adjust the pitch angle, or to lift the propeller 14 out of the water when necessary.
前述第二平面19即为垂直于第三方向Z的平面,螺旋桨14能够由第三转动部13和第二转动部12的带动而相对第一转动部11绕第二转动部12的转动轴(平行于第三方向Z)旋转(旋转方向见图中的第二双向旋转箭头42),实现螺旋桨14的转向,以调整转动角度,用于改变船体310前进的方向。The aforementioned second plane 19 is a plane perpendicular to the third direction Z. The propeller 14 can be driven by the third rotating part 13 and the second rotating part 12 to rotate relative to the first rotating part 11 around the rotation axis of the second rotating part 12 (parallel to the third direction Z) (the rotation direction is shown by the second bidirectional rotation arrow 42 in the figure), thereby realizing the steering of the propeller 14 to adjust the rotation angle, which is used to change the forward direction of the hull 310.
前述第三平面20即为垂直于第一方向X的平面,螺旋桨14能够由第三转动部13的带动而相对第二转动部12绕第三转动部13的转动轴(平行于第一方向X)旋转(旋转方向见图中的第三双向旋转箭头43),实现螺旋桨14的侧向摆动,以调整摆动角度,用于改变螺旋桨14的吃水深度并能够起到控制船体310侧向摇摆(即横摇)的作用。控制侧向摇摆的方式的实现方式可以为,在船体310侧向摇摆时,使螺旋桨14向与船体310摇摆方向相反的方向摆动,以减缓船体310的摇摆。The third plane 20 is a plane perpendicular to the first direction X. The propeller 14 can be driven by the third rotating part 13 to rotate relative to the second rotating part 12 around the rotation axis of the third rotating part 13 (parallel to the first direction X) (the rotation direction is shown in the third bidirectional rotation arrow 43 in the figure), so as to realize the lateral swing of the propeller 14 to adjust the swing angle, which is used to change the draft of the propeller 14 and can play a role in controlling the lateral swing (i.e., rolling) of the hull 310. The implementation method of controlling the lateral swing can be that when the hull 310 swings sideways, the propeller 14 swings in the direction opposite to the swing direction of the hull 310 to slow down the swing of the hull 310.
第一转动部11、第二转动部12和第三转动部13的具体结构可以根据需要设置。The specific structures of the first rotating part 11, the second rotating part 12 and the third rotating part 13 can be set as needed.
可选地,第一转动部11包括第一支架21和第一转动轴22。第一转动轴22的轴心方向平行于第二方向Y,第一方向X、第二方向Y和第三方向Z相互垂直。第一支架21通过第一转动轴22转动连接于船体310尾部,第二转动部12连接第一支架21。Optionally, the first rotating part 11 includes a first bracket 21 and a first rotating shaft 22. The axial direction of the first rotating shaft 22 is parallel to the second direction Y, and the first direction X, the second direction Y and the third direction Z are perpendicular to each other. The first bracket 21 is rotatably connected to the stern of the hull 310 through the first rotating shaft 22, and the second rotating part 12 is connected to the first bracket 21.
可选地,第一转动部11还包括夹具23,夹具23可拆卸连接船体310尾部,第一转动轴22设置于夹具23,第一支架21连接在第一转动轴22上,并能够随第一转动轴22转动。Optionally, the first rotating part 11 further includes a clamp 23 , which is detachably connected to the rear of the hull 310 , the first rotating shaft 22 is disposed on the clamp 23 , and the first bracket 21 is connected to the first rotating shaft 22 and can rotate with the first rotating shaft 22 .
在需要起翘时,外力带动第一转动轴22相对夹具23旋转,进而带动第一支架21、连接于第一支架21的第二转动部12以及后面的第三转动部13及螺旋桨14一起旋转起翘。当然,可以理解的是,在其他实施方式中,也可以是在图1所示实施例的基础上,将第一转动轴22替换成曲柄连杆机构,第一支架21可经曲柄连杆机构相对所述夹具23转动,以带动螺旋桨14相对船体310起翘角度调整,从而实现调整船体310纵倾角。When warping is required, an external force drives the first rotating shaft 22 to rotate relative to the clamp 23, thereby driving the first bracket 21, the second rotating part 12 connected to the first bracket 21, and the third rotating part 13 and the propeller 14 to rotate and warp together. Of course, it can be understood that in other embodiments, the first rotating shaft 22 can be replaced with a crank connecting rod mechanism on the basis of the embodiment shown in Figure 1, and the first bracket 21 can rotate relative to the clamp 23 through the crank connecting rod mechanism to drive the propeller 14 to adjust the warping angle relative to the hull 310, thereby adjusting the longitudinal inclination angle of the hull 310.
本实施例中,第一转动部11还包括第一驱动件24,第一驱动件24连接第一转动轴22,用于经第一转动轴22驱动第一支架21转动。例如,第一驱动件24固定连接在夹具23上,其输出轴通过联轴器连接第一转动轴22,以使第一驱动件24运行时能够带动第一转动轴22转动,进而带动第一支架21转动。第一驱动件24可以是电机或液压驱动器或其他能够实现旋转驱动的设备。在另一实施方式中,也可使第一支架21包括沿第一方向X与夹具23间隔的部分,并设置一起翘伸缩缸24a作为该第一驱动件24,该起翘伸缩缸24a安装于夹具23,且起翘伸缩缸24a的伸缩端连接于第一支架21并能够通过伸长或缩短来驱动第一支架21和第一转动轴22相对夹具23转动来实现起翘。In this embodiment, the first rotating part 11 also includes a first driving member 24, which is connected to the first rotating shaft 22 and is used to drive the first bracket 21 to rotate via the first rotating shaft 22. For example, the first driving member 24 is fixedly connected to the fixture 23, and its output shaft is connected to the first rotating shaft 22 through a coupling, so that when the first driving member 24 is running, it can drive the first rotating shaft 22 to rotate, and then drive the first bracket 21 to rotate. The first driving member 24 can be a motor or a hydraulic driver or other equipment that can achieve rotational drive. In another embodiment, the first bracket 21 can also include a portion spaced from the fixture 23 along the first direction X, and a warping telescopic cylinder 24a is provided as the first driving member 24, the warping telescopic cylinder 24a is installed on the fixture 23, and the telescopic end of the warping telescopic cylinder 24a is connected to the first bracket 21 and can drive the first bracket 21 and the first rotating shaft 22 to rotate relative to the fixture 23 by extending or shortening to achieve warping.
本实施例中,可选地,第二转动部12包括第二支架25和第二转动轴26,第二转动轴26的轴心方向平行于第三方向Z。第二支架25通过第二转动轴26连接第一支架21,第三转动部13转动连接第二支架25。如图1中示出的,第二转动轴26的下端连接于第一支架21,上端连接第二支架25。可选地,第二转动部12还包括第二驱动件27,第二驱动件27连接第二转动轴26,用于经第二转动轴26驱动第二支架25转动。第二驱动件27可以是电机或液压驱动器或其他能够实现旋转驱动的设备。利用第二驱动件27可驱动第二支架25绕第二转动轴26的轴心相对第一支架21转动,从而带动螺旋桨14相对船体310转向,从而在螺旋桨 14旋转运行时,调整船体310航行转向。In this embodiment, optionally, the second rotating part 12 includes a second bracket 25 and a second rotating shaft 26, and the axis direction of the second rotating shaft 26 is parallel to the third direction Z. The second bracket 25 is connected to the first bracket 21 through the second rotating shaft 26, and the third rotating part 13 is rotatably connected to the second bracket 25. As shown in Figure 1, the lower end of the second rotating shaft 26 is connected to the first bracket 21, and the upper end is connected to the second bracket 25. Optionally, the second rotating part 12 also includes a second driving member 27, and the second driving member 27 is connected to the second rotating shaft 26, and is used to drive the second bracket 25 to rotate through the second rotating shaft 26. The second driving member 27 can be a motor or a hydraulic drive or other equipment capable of realizing rotational drive. The second driving member 27 can be used to drive the second bracket 25 to rotate relative to the first bracket 21 around the axis of the second rotating shaft 26, thereby driving the propeller 14 to turn relative to the hull 310, so that when the propeller 14 rotates, the hull 310 is adjusted to sail and turn.
可选地,第二支架25上连接有舵柄25a,舵柄25a可用于操作者手动操控带动第二支架25绕第二转动轴26转动以实现船体310航行转向的操控,也可以用于操作者手动操控带动第二支架25和与第二支架25连接的第一支架21及第一转动轴22一起相对夹具23转动以实现起翘操控。Optionally, the second bracket 25 is connected to a tiller handle 25a, which can be used by an operator to manually control the second bracket 25 to rotate around the second rotation axis 26 to achieve navigation and steering control of the hull 310. It can also be used by an operator to manually control the second bracket 25 and the first bracket 21 connected to the second bracket 25 and the first rotation axis 22 to rotate relative to the clamp 23 to achieve tilting control.
由此,本实施例中,第一驱动件24(或起翘伸缩缸24a)的驱动操控和操作者通过舵柄25a的手动操控,可以相互独立地实现螺旋桨14起翘;第二驱动件27的驱动操控和操作者通过舵柄25a的手动操控,可以相互独立地实现螺旋桨14转向。Therefore, in this embodiment, the driving control of the first driving member 24 (or the lifting and telescopic cylinder 24a) and the manual control of the operator through the tiller handle 25a can independently realize the lifting of the propeller 14; the driving control of the second driving member 27 and the manual control of the operator through the tiller handle 25a can independently realize the steering of the propeller 14.
本实施例中,可选地,第二支架25包括第一连接臂28和第二连接臂29。第一连接臂28连接第二转动轴26,并沿垂直第二转动轴26的轴心方向延伸,第二连接臂29固定连接第一连接臂28,并沿垂直第一连接臂28方向延伸,第二连接臂29的延伸方向平行第二转动轴26的轴心方向,第三转动部13连接第二连接臂29远离第一连接臂28的一端。如图中示出的,第一连接臂28和第二连接臂29连接形成倒置的L形结构的第二支架25,第一连接臂28朝船体310后部伸出,第二连接臂29从第一连接臂28的伸出一端向下伸出。In this embodiment, optionally, the second bracket 25 includes a first connecting arm 28 and a second connecting arm 29. The first connecting arm 28 is connected to the second rotating shaft 26 and extends in a direction perpendicular to the axis of the second rotating shaft 26. The second connecting arm 29 is fixedly connected to the first connecting arm 28 and extends in a direction perpendicular to the first connecting arm 28. The extension direction of the second connecting arm 29 is parallel to the axis of the second rotating shaft 26. The third rotating portion 13 is connected to one end of the second connecting arm 29 away from the first connecting arm 28. As shown in the figure, the first connecting arm 28 and the second connecting arm 29 are connected to form an inverted L-shaped second bracket 25, the first connecting arm 28 extends toward the rear of the hull 310, and the second connecting arm 29 extends downward from the extended end of the first connecting arm 28.
本实施例中,第三转动部13包括第三支架30和第三转动轴31,第三转动轴31的轴心方向平行于第一方向X。第三支架30通过第三转动轴31连接于第二支架25,螺旋桨14转动连接第三支架30。可选地,第三转动部13还包括第三驱动件32,第三驱动件32连接第三转动轴31,用于经第三转动轴31驱动第三支架30转动。第三驱动件32可以是电机或液压驱动器或其他能够实现旋转驱动的设备。可选地,第三转动轴31向船体310后方伸出,第三支架30大致呈沿第三方向Z延伸,其上端连接在第三转动轴31的伸出一端、下端用于安装螺旋桨14。In this embodiment, the third rotating part 13 includes a third bracket 30 and a third rotating shaft 31, and the axial direction of the third rotating shaft 31 is parallel to the first direction X. The third bracket 30 is connected to the second bracket 25 through the third rotating shaft 31, and the propeller 14 is rotatably connected to the third bracket 30. Optionally, the third rotating part 13 also includes a third driving member 32, and the third driving member 32 is connected to the third rotating shaft 31, and is used to drive the third bracket 30 to rotate through the third rotating shaft 31. The third driving member 32 can be a motor or a hydraulic drive or other equipment that can achieve rotational drive. Optionally, the third rotating shaft 31 extends to the rear of the hull 310, and the third bracket 30 extends roughly along the third direction Z, with its upper end connected to the protruding end of the third rotating shaft 31 and the lower end used to install the propeller 14.
可以理解的是,第三驱动件32可驱动第三支架30绕第三转动轴31相对第二支架25转动,从而带动所述螺旋桨14相对船体横向摆动,可调整船体左右摆动姿态,从而实现多维度调整船体姿态。It can be understood that the third driving member 32 can drive the third bracket 30 to rotate around the third rotating axis 31 relative to the second bracket 25, thereby driving the propeller 14 to swing laterally relative to the hull, and can adjust the left and right swinging posture of the hull, thereby realizing multi-dimensional adjustment of the hull posture.
本实施例中,推进器100还包括转动设置于第三支架30的动力输出轴34,螺旋桨14连接动力输出轴34并经动力输出轴34获取转动扭矩。动力输出轴34由前述的原动机15驱动。In this embodiment, the propeller 100 further includes a power output shaft 34 rotatably disposed on the third bracket 30, and the propeller 14 is connected to the power output shaft 34 and obtains the rotation torque through the power output shaft 34. The power output shaft 34 is driven by the aforementioned prime mover 15.
在另一实施例中,可以不采用前述的第一驱动件24、第二驱动件27和第三驱动件32,而是采用下述实施方式:推进器100还包括固定于第一转动部11、或第二转动部12、或第三转动部13的扭转动力机,扭转动力机用于为第一转动部11、第二转动部12和第三转动部13至少一者提供转动扭矩。In another embodiment, the aforementioned first driving member 24, the second driving member 27 and the third driving member 32 may not be used, but the following implementation may be used: the propeller 100 also includes a torsion power machine fixed to the first rotating part 11, or the second rotating part 12, or the third rotating part 13, and the torsion power machine is used to provide rotational torque for at least one of the first rotating part 11, the second rotating part 12 and the third rotating part 13.
较之已知技术中具有起翘自由度和转动自由度的方案,本实施例中的推进器100还具有一额外的摆动自由度,可以实现侧向摆动,一方面可以同样实现螺旋桨14的竖向升降,另一方面该摆动自由度可以和转动自由度结合来减少船体310的摇摆。因此,本实施例中通过新增的第三自由度可以实现三个自由度的旋转,从而使得推进器100可以减少各个方向的摇摆。Compared with the solution with the tilting degree of freedom and the rotation degree of freedom in the known technology, the propeller 100 in this embodiment also has an additional swinging degree of freedom, which can realize lateral swinging. On the one hand, it can also realize the vertical lifting and lowering of the propeller 14, and on the other hand, the swinging degree of freedom can be combined with the rotation degree of freedom to reduce the swaying of the hull 310. Therefore, in this embodiment, the newly added third degree of freedom can realize the rotation of three degrees of freedom, so that the propeller 100 can reduce the swaying in all directions.
此外,在一些可行的实施方式中,还可以通过摆动自由度来折叠推进器100,节省更多的空间。如图1示出的,第二连接臂29和第三支架30均设置为沿第三方向Z的杆状结构,两者在交界处通过第三转动轴31转动连接。在需要时,可以使第三支架30绕该第三转动轴31旋转折叠,使得推进器100在第三方向Z上的尺寸减小,方便包装运输。In addition, in some feasible embodiments, the propeller 100 can also be folded by swinging the degree of freedom to save more space. As shown in FIG. 1 , the second connecting arm 29 and the third bracket 30 are both configured as a rod-shaped structure along the third direction Z, and the two are rotatably connected at the junction by a third rotation axis 31. When necessary, the third bracket 30 can be rotated and folded around the third rotation axis 31, so that the size of the propeller 100 in the third direction Z is reduced, which is convenient for packaging and transportation.
图3示出了水域可移动设备300采用了另一种推进器200。该推进器200和前述推进器 100的不同在于,第一转动部11、第二转动部12和第三转动部13具有两个或两个以上的转动自由度,如第一转动部11、第二转动部12和第三转动部13均具有三个转动自由度。Fig. 3 shows that the movable device 300 in water area adopts another propeller 200. The propeller 200 is different from the aforementioned propeller 100 in that the first rotating part 11, the second rotating part 12 and the third rotating part 13 have two or more rotational degrees of freedom, such as the first rotating part 11, the second rotating part 12 and the third rotating part 13 all have three rotational degrees of freedom.
参见图3,该推进器200中,第一转动部11相对船体310具有三个第一转动自由度,三个第一转动自由度分别设置于相互垂直的三个第一转动平面。其中,第一转动部11包括第一转动节51和连接第一转动节51的第一转向臂52,第一转动节51设有依次连接的三个第一转向轴53,三个第一转向轴53相互垂直,第一转向臂52的一端经三个第一转向轴53连接船体310,第一转向臂52的另一端连接第二转动部12。可选地,第一转动部11还包括三个第一电机54,三个第一电机54分别用于驱动三个第一转向轴53转动,以带动第一转向臂52相对船体310转动。Referring to FIG. 3 , in the propeller 200, the first rotating part 11 has three first rotational degrees of freedom relative to the hull 310, and the three first rotational degrees of freedom are respectively arranged in three first rotational planes perpendicular to each other. The first rotating part 11 includes a first rotating joint 51 and a first steering arm 52 connected to the first rotating joint 51, and the first rotating joint 51 is provided with three first steering shafts 53 connected in sequence, and the three first steering shafts 53 are perpendicular to each other. One end of the first steering arm 52 is connected to the hull 310 via the three first steering shafts 53, and the other end of the first steering arm 52 is connected to the second rotating part 12. Optionally, the first rotating part 11 also includes three first motors 54, and the three first motors 54 are respectively used to drive the three first steering shafts 53 to rotate, so as to drive the first steering arm 52 to rotate relative to the hull 310.
第二转动部12相对第一转动部11具有三个第二转动自由度,三个第二转动自由度分别设置于相互垂直的三个第二转动平面。第二转动部12包括第二转动节56和连接第二转动节56的第二转向臂57,第二转动节56设有依次连接的三个第二转向轴58,三个第二转向轴58相互垂直,第二转向臂57的一端经三个第二转向轴58连接第一转动部11,第二转向臂57的另一端连接第三转动部13。可选地,第二转动部12还包括三个第二电机59,三个第二电机59分别用于驱动三个第二转向轴58转动,以带动第二转向臂57相对第一转动部11转动。The second rotating part 12 has three second rotational degrees of freedom relative to the first rotating part 11, and the three second rotational degrees of freedom are respectively arranged in three second rotational planes perpendicular to each other. The second rotating part 12 includes a second rotating joint 56 and a second steering arm 57 connected to the second rotating joint 56, the second rotating joint 56 is provided with three second steering shafts 58 connected in sequence, the three second steering shafts 58 are perpendicular to each other, one end of the second steering arm 57 is connected to the first rotating part 11 via the three second steering shafts 58, and the other end of the second steering arm 57 is connected to the third rotating part 13. Optionally, the second rotating part 12 also includes three second motors 59, and the three second motors 59 are respectively used to drive the three second steering shafts 58 to rotate, so as to drive the second steering arm 57 to rotate relative to the first rotating part 11.
第三转动部13相对第二转动部12具有三个第三转动自由度,三个第三转动自由度分别设置于相互垂直的三个第三转动平面。第三转动部13包括第三转动节61和连接第三转动节61的第三转向臂62,第三转动节61设有依次连接的三个第三转向轴63,三个第三转向轴63相互垂直,第三转向臂62的一端经三个第三转向轴63连接第二转动部12,第三转向臂62的另一端连接螺旋桨14。可选地,第三转动部13还包括三个第三电机64,三个第三电机64分别用于驱动三个第三转向轴63转动,以带动第三转向臂62相对第二转动部12转动。The third rotating part 13 has three third rotational degrees of freedom relative to the second rotating part 12, and the three third rotational degrees of freedom are respectively arranged in three third rotational planes perpendicular to each other. The third rotating part 13 includes a third rotating joint 61 and a third steering arm 62 connected to the third rotating joint 61, and the third rotating joint 61 is provided with three third steering shafts 63 connected in sequence, and the three third steering shafts 63 are perpendicular to each other. One end of the third steering arm 62 is connected to the second rotating part 12 via the three third steering shafts 63, and the other end of the third steering arm 62 is connected to the propeller 14. Optionally, the third rotating part 13 also includes three third motors 64, and the three third motors 64 are respectively used to drive the three third steering shafts 63 to rotate, so as to drive the third steering arm 62 to rotate relative to the second rotating part 12.
前述的第一转动节51、第二转动节56、第三转动节61可以采用常见的能够实现三个相互垂直的轴转动的转动结构,如具有三转动自由度的万向节,在此不做限定。The first rotating joint 51, the second rotating joint 56, and the third rotating joint 61 mentioned above may adopt a common rotating structure capable of realizing rotation of three mutually perpendicular axes, such as a universal joint with three rotational degrees of freedom, which is not limited here.
参见图1或图3,本实施例中,水域可移动设备300还包括惯导模块320,惯导模块320固定于船体310,用于感测船体310运动数据。其中,惯导模块320即惯性导航模块,具体型号可以根据需要选择。1 or 3, in this embodiment, the mobile device 300 in water area further includes an inertial navigation module 320, which is fixed to the hull 310 and is used to sense the motion data of the hull 310. The inertial navigation module 320 is an inertial navigation module, and the specific model can be selected as needed.
推进器100设有与惯导模块320电连接的主控模块70,主控模块70用于将水域可移动设备运动数据进行姿态解算,并产生平衡控制指令,平衡控制指令包括角度控制指令、位移控制指令。角度控制指令用于指示第一转动部11、第二转动部12和/或第三转动部13调整姿态,以控制螺旋桨14推动船体310转向目标角度,位移控制指令用于指示螺旋桨14的转速及转向,以控制螺旋桨14推动船体310移动目标位移。The propeller 100 is provided with a main control module 70 electrically connected to the inertial navigation module 320. The main control module 70 is used to perform attitude calculation on the motion data of the movable device in the water area and generate a balance control instruction, which includes an angle control instruction and a displacement control instruction. The angle control instruction is used to instruct the first rotating part 11, the second rotating part 12 and/or the third rotating part 13 to adjust the attitude so as to control the propeller 14 to push the hull 310 to turn to the target angle, and the displacement control instruction is used to instruct the rotation speed and direction of the propeller 14 so as to control the propeller 14 to push the hull 310 to move the target displacement.
本实施例中,平衡控制指令还包括转速控制指令;转速控制指令指示目标转动部在目标转动方向上的转动速率。In this embodiment, the balance control instruction also includes a rotation speed control instruction; the rotation speed control instruction indicates the rotation speed of the target rotating part in the target rotation direction.
前述的角度控制指令包括目标转动方向和目标转动部;目标转动方向指示目标转动部的转动方向,目标转动部指示第一转动部11、第二转动部12和第三转动部13的至少一者转动。可选地,角度控制指令还包括目标转向角度值,目标转向角度值指示目标转动部在目标转动方向上转动的角度值。The aforementioned angle control instruction includes a target rotation direction and a target rotation part; the target rotation direction indicates the rotation direction of the target rotation part, and the target rotation part indicates the rotation of at least one of the first rotation part 11, the second rotation part 12, and the third rotation part 13. Optionally, the angle control instruction also includes a target steering angle value, and the target steering angle value indicates the angle value of the target rotation part rotating in the target rotation direction.
本申请实施例中的水域可移动设备300中,推进器可以设置为一个或多个。在设置一个推进器时,推进器可以设置在船体310尾部的宽度方向中间位置;在设置多个推进器时,多 个推进器可以沿船体310的宽度方向间隔设置。推进器可以是前述的推进器100或推进器200。In the mobile device 300 in the water area of the embodiment of the present application, the propeller can be provided as one or more. When one propeller is provided, the propeller can be provided at the middle position in the width direction of the tail of the hull 310; when multiple propellers are provided, the multiple propellers can be provided at intervals along the width direction of the hull 310. The propeller can be the aforementioned propeller 100 or propeller 200.
例如图4示出了采用两个推进器的水域可移动设备300的简视图。参见图4,两个推进器分别设置在船体310尾部并设置在船体310尾部的宽度方向两侧。For example, Fig. 4 shows a simplified view of a mobile device 300 for use in waters with two propellers. Referring to Fig. 4, the two propellers are respectively arranged at the stern of a hull 310 and at both sides of the stern of the hull 310 in the width direction.
设置多个推进器,一方面提高了水域可移动设备300的动力来源,另一方面也使控制更加灵活。The provision of multiple thrusters not only improves the power source of the movable device 300 in the water area, but also makes the control more flexible.
综上,本实施例中的水域可移动设备300采用的推进器通过设置额外的第三转动部13,实现更多自由度的转动,能够更灵活地调节螺旋桨14的位置和姿态,利于对水域可移动设备300运行状态的调整。In summary, the propeller used in the movable device 300 in the water area in this embodiment realizes rotation with more degrees of freedom by setting an additional third rotating part 13, and can more flexibly adjust the position and posture of the propeller 14, which is conducive to adjusting the operating state of the movable device 300 in the water area.
本实施例还提供一种水域可移动设备减摇控制方法,用于前述的水域可移动设备300的减摇控制。该处所说的减摇指减小水域可移动设备300的转动摇摆或平移窜动。基于前述水域可移动设备300新增第三转动自由度的结构设计,本实施例提供的水域可移动设备减摇控制方法能够很好地控制船体310的有害摇摆,提高了船体310的稳定性和乘坐舒适性。This embodiment also provides a method for stabilizing a movable device in water area, which is used for stabilizing the movable device 300 mentioned above. The stabilization mentioned here refers to reducing the rotational sway or translational movement of the movable device 300 in water area. Based on the structural design of the movable device 300 in water area with a third rotational degree of freedom, the method for stabilizing a movable device in water area provided in this embodiment can well control the harmful sway of the hull 310, thereby improving the stability and riding comfort of the hull 310.
图5示出了本实施例中的水域可移动设备300的控制原理图。参见图5,惯导模块320、第一驱动件24、第二驱动件27和第三驱动件32、原动机15分别电连接于主控模块70。惯导模块320可将其感测到的水域可移动设备运动数据传输给主控模块70,主控模块70基于该水域可移动设备运动数据进行姿态结算,得到平衡控制指令,并可通过该平衡控制指令控制第一驱动件24、第二驱动件27和第三驱动件32、原动机15的运行,从而控制水域可移动设备300至所需位置姿态或运动数据。FIG5 shows a control principle diagram of the movable device 300 in the water area in this embodiment. Referring to FIG5, the inertial navigation module 320, the first driving member 24, the second driving member 27, the third driving member 32, and the prime mover 15 are electrically connected to the main control module 70 respectively. The inertial navigation module 320 can transmit the motion data of the movable device in the water area sensed by it to the main control module 70, and the main control module 70 performs attitude settlement based on the motion data of the movable device in the water area, obtains a balance control instruction, and can control the operation of the first driving member 24, the second driving member 27, the third driving member 32, and the prime mover 15 through the balance control instruction, thereby controlling the movable device 300 in the water area to the desired position attitude or motion data.
配合参见图6,本实施例提供的水域可移动设备减摇控制方法包括以下步骤:6, the anti-rolling control method for a mobile device in water area provided in this embodiment includes the following steps:
S1:获取惯导模块320感测的水域可移动设备运动数据;S1: Acquiring the motion data of the movable device in the water area sensed by the inertial navigation module 320;
本实施例中,由惯导模块320获取的水域可移动设备运动数据包括在预设的水域可移动设备300坐标系上的角速度、加速度、磁场方向以及欧拉角。可选地,预设的水域可移动设备300坐标系的构建方法为,以水域可移动设备300重心为坐标原点,水域可移动设备300长度方向为X轴,水域可移动设备300宽度方向为Y轴,水域可移动设备300高度方向为Z轴。In this embodiment, the motion data of the movable device for water area acquired by the inertial navigation module 320 includes angular velocity, acceleration, magnetic field direction and Euler angle in the preset coordinate system of the movable device for water area 300. Optionally, the preset coordinate system of the movable device for water area 300 is constructed by taking the center of gravity of the movable device for water area 300 as the origin of the coordinate, the length direction of the movable device for water area 300 as the X axis, the width direction of the movable device for water area 300 as the Y axis, and the height direction of the movable device for water area 300 as the Z axis.
S2:对水域可移动设备运动数据进行姿态解算,产生平衡控制指令;S2: Calculate the attitude of the motion data of the mobile equipment in the water area and generate balance control instructions;
平衡控制指令包括角度控制指令和位移控制指令。其中,角度控制指令用于指示第一转动部11、第二转动部12和/或第三转动部13调整姿态,以控制螺旋桨14推动船体310转向目标角度;位移控制指令指示螺旋桨14的转速及转向,以控制螺旋桨14推动船体310移动目标位移。The balance control instruction includes an angle control instruction and a displacement control instruction. The angle control instruction is used to instruct the first rotating part 11, the second rotating part 12 and/or the third rotating part 13 to adjust their postures so as to control the propeller 14 to push the hull 310 to turn to a target angle; the displacement control instruction indicates the speed and direction of the propeller 14 so as to control the propeller 14 to push the hull 310 to move to a target displacement.
对水域可移动设备运动数据进行姿态解算,产生平衡控制指令,包括:Perform attitude calculation on the motion data of mobile equipment in waters and generate balance control instructions, including:
采用四元数法对水域可移动设备运动数据进行姿态解算,得到水域可移动设备300姿态数据;可选地,水域可移动设备300姿态数据包括俯仰角、翻滚角和/或偏航角。The quaternion method is used to perform attitude calculation on the motion data of the movable device for water areas, so as to obtain attitude data of the movable device for water areas 300; optionally, the attitude data of the movable device for water areas 300 includes a pitch angle, a roll angle and/or a yaw angle.
根据水域可移动设备300姿态数据,确定目标调整角度和目标调整位移;Determine a target adjustment angle and a target adjustment displacement according to the posture data of the movable device 300 in the water area;
根据目标调整角度和目标调整位移,生成角度控制指令和位移控制指令。其中,角度控制指令包括目标转动方向、目标转动部和目标转向角度值,目标转向角度值指示目标转动部在目标转动方向上转动的角度值;目标转动方向指示目标转动部的转动方向;目标转动部指示第一转动部11、第二转动部12和第三转动部13的至少一者转动。According to the target adjustment angle and the target adjustment displacement, an angle control instruction and a displacement control instruction are generated. The angle control instruction includes a target rotation direction, a target rotation part and a target steering angle value, wherein the target steering angle value indicates the angle value of the target rotation part rotating in the target rotation direction; the target rotation direction indicates the rotation direction of the target rotation part; and the target rotation part indicates that at least one of the first rotation part 11, the second rotation part 12 and the third rotation part 13 rotates.
若目标转动方向包括横摇方向,以推进器100的第三转动部13为目标转动部,并控制目 标转动部转动目标转向角度值,以控制螺旋桨14推动船体310转向目标角度。If the target rotation direction includes the rolling direction, the third rotating part 13 of the propeller 100 is used as the target rotating part, and the target rotating part is controlled to rotate to the target steering angle value to control the propeller 14 to push the hull 310 to turn to the target angle.
若目标转动方向包括纵摇方向,以推进器100的第一转动部11为目标转动部,并控制目标转动部转动目标转向角度值,以控制螺旋桨14推动船体310转向目标角度。If the target rotation direction includes the pitch direction, the first rotation part 11 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target turning angle value, so as to control the propeller 14 to push the hull 310 to turn to the target angle.
若目标转动方向包括艏摇方向,以推进器100的第二转动部12为目标转动部,并控制目标转动部转动目标转向角度值,以控制螺旋桨14推动船体310转向目标角度。If the target rotation direction includes the yaw direction, the second rotation part 12 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to turn to the target angle.
若目标转动方向包括横荡方向,以推进器100的第三转动部13为目标转动部,并控制目标转动部转动目标转向角度值,以控制螺旋桨14推动船体310沿横荡方向平移。If the target rotation direction includes the sway direction, the third rotation part 13 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to translate along the sway direction.
若目标转动方向包括纵荡方向,以推进器100的第二转动部12为目标转动部,并控制目标转动部转动目标转向角度值,以控制螺旋桨14推动船体310沿纵荡方向平移。If the target rotation direction includes the surge direction, the second rotation part 12 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to translate along the surge direction.
若目标转动方向包括垂荡方向,以推进器100的第一转动部11为目标转动部,并控制目标转动部转动目标转向角度值,以控制螺旋桨14推动船体310沿垂荡方向平移。If the target rotation direction includes the heave direction, the first rotating part 11 of the propeller 100 is used as the target rotation part, and the target rotation part is controlled to rotate to a target steering angle value, so as to control the propeller 14 to push the hull 310 to translate along the heave direction.
前述的横摇方向、纵摇方向、艏摇方向分别指水域可移动设备300绕X轴、Y轴、Z轴的往复摆动;前述的纵荡方向、横荡方向、垂荡方向指水域可移动设备300沿X轴、Y轴、Z轴的平移,可结合图7进行理解。The aforementioned roll direction, pitch direction and bow swing direction refer to the reciprocating swing of the movable device 300 in the water area around the X-axis, Y-axis and Z-axis respectively; the aforementioned surge direction, sway direction and vertical swing direction refer to the translation of the movable device 300 in the water area along the X-axis, Y-axis and Z-axis, which can be understood in conjunction with Figure 7.
S3:判断水域可移动设备300姿态数据是否被调整到预设姿态阈值内;S3: Determine whether the posture data of the movable device 300 in the water area is adjusted to within a preset posture threshold;
若是,则结束控制流程;If so, the control flow ends;
若否,则循环执行控制流程。即,再次进行上述的步骤S1和步骤S2。If not, the control flow is executed cyclically, that is, the above steps S1 and S2 are performed again.
本实施例还包括一种存储介质,包括计算机指令,存储介质上存储有计算机可读指令,计算机可读指令被处理器执行时实现前述的水域可移动设备减摇控制方法。The present embodiment also includes a storage medium including computer instructions. The storage medium stores computer-readable instructions. When the computer-readable instructions are executed by a processor, the aforementioned anti-rolling control method for a mobile device in water area is implemented.
本实施例中的存储介质应用于水域可移动设备300的主控模块70,在需要时,主控模块70读取并运行该存储介质存储的计算机可读指令,并执行前述的水域可移动设备减摇控制方法。本实施例中的主控模块70包括但不限于电机驱动器、行驶控制器、电源管理控制器、温度管理控制器等结构。主控模块70还可以用于与水域可移动设备300上的其他模块交互。本申请的实施方式中,并不局限于推进器100包括上述控制器的方式,任何可实现驱动与信息交互功能的电子控制终端模块均可以是本申请的实施方式。The storage medium in this embodiment is applied to the main control module 70 of the mobile device 300 in water areas. When necessary, the main control module 70 reads and runs the computer-readable instructions stored in the storage medium, and executes the aforementioned anti-roll control method for the mobile device in water areas. The main control module 70 in this embodiment includes but is not limited to structures such as a motor driver, a driving controller, a power management controller, and a temperature management controller. The main control module 70 can also be used to interact with other modules on the mobile device 300 in water areas. In the implementation manner of the present application, it is not limited to the manner in which the propeller 100 includes the above-mentioned controller, and any electronic control terminal module that can realize the driving and information interaction functions can be an implementation manner of the present application.
以上实施方式仅用以说明本申请的技术方案而非限制,尽管参照以上较佳实施方式对本申请进行了详细说明,本领域的普通技术人员应当理解,可以对本申请的技术方案进行修改或等同替换都不应脱离本申请技术方案的精神和范围。The above implementation modes are only used to illustrate the technical solutions of the present application and are not intended to limit the present application. Although the present application has been described in detail with reference to the above preferred implementation modes, those skilled in the art should understand that the technical solutions of the present application may be modified or replaced by equivalents without departing from the spirit and scope of the technical solutions of the present application.

Claims (44)

  1. 一种推进器,其特征在于,包括:第一转动部、第二转动部、第三转动部及螺旋桨;所述第一转动部用于连接于船体,并相对所述船体具有至少一个第一转动自由度;所述第二转动部连接于所述第一转动部,并相对所述第一转动部具有至少一个第二转动自由度;所述第三转动部连接于所述第二转动部,并相对所述第二转动部具有至少一个第三转动自由度;所述螺旋桨连接所述第三转动部,并能够相对所述第三转动部旋转。A propeller, characterized in that it includes: a first rotating part, a second rotating part, a third rotating part and a propeller; the first rotating part is used to connect to a hull, and has at least one first rotational degree of freedom relative to the hull; the second rotating part is connected to the first rotating part, and has at least one second rotational degree of freedom relative to the first rotating part; the third rotating part is connected to the second rotating part, and has at least one third rotational degree of freedom relative to the second rotating part; the propeller is connected to the third rotating part, and can rotate relative to the third rotating part.
  2. 根据权利要求1所述的推进器,其特征在于,所述第一转动部能够相对所述船体在第一平面内转动,以调整所述螺旋桨的俯仰角度;The propeller according to claim 1, characterized in that the first rotating part can rotate relative to the hull in a first plane to adjust the pitch angle of the propeller;
    所述第二转动部能够相对所述第一转动部在第二平面内转动,以调整所述螺旋桨的转向角度;The second rotating part can rotate relative to the first rotating part in a second plane to adjust the steering angle of the propeller;
    所述第三转动部能够相对第二转动部在第三平面内转动,以调整所述螺旋桨的摆动角度;The third rotating part can rotate relative to the second rotating part in a third plane to adjust the swing angle of the propeller;
    所述第一平面、第二平面以及第三平面互相垂直。The first plane, the second plane and the third plane are perpendicular to each other.
  3. 根据权利要求2所述的推进器,其特征在于,所述第一转动部包括第一支架和第一转动轴,所述第一支架通过所述第一转动轴连接于所述船体尾部,所述第二转动部连接所述第一支架。The propeller according to claim 2 is characterized in that the first rotating part includes a first bracket and a first rotating shaft, the first bracket is connected to the stern of the hull through the first rotating shaft, and the second rotating part is connected to the first bracket.
  4. 根据权利要求3所述的推进器,其特征在于,所述第一转动部还包括夹具,所述夹具用于可拆卸连接所述船体尾部,所述第一转动轴设置于所述夹具。The propeller according to claim 3 is characterized in that the first rotating part also includes a clamp, the clamp is used to detachably connect the stern of the hull, and the first rotating shaft is arranged on the clamp.
  5. 根据权利要求3所述的推进器,其特征在于,所述第一转动部还包括第一驱动件,所述第一驱动件连接所述第一转动轴,用于经所述第一转动轴驱动所述第一支架转动。The propeller according to claim 3 is characterized in that the first rotating part also includes a first driving member, and the first driving member is connected to the first rotating shaft and is used to drive the first bracket to rotate via the first rotating shaft.
  6. 根据权利要求3所述的推进器,其特征在于,所述第二转动部包括第二支架和第二转动轴,所述第二支架通过所述第二转动轴连接所述第一支架,所述第三转动部转动连接所述第二支架。The propeller according to claim 3 is characterized in that the second rotating part includes a second bracket and a second rotating shaft, the second bracket is connected to the first bracket through the second rotating shaft, and the third rotating part is rotatably connected to the second bracket.
  7. 根据权利要求6所述的推进器,其特征在于,所述第二转动部还包括第二驱动件,所述第二驱动件连接所述第二转动轴,用于经所述第二转动轴驱动所述第二支架转动。The propeller according to claim 6 is characterized in that the second rotating part also includes a second driving member, and the second driving member is connected to the second rotating shaft and is used to drive the second bracket to rotate via the second rotating shaft.
  8. 根据权利要求6所述的推进器,其特征在于,所述第二支架包括第一连接臂和第二连接臂,所述第一连接臂连接所述第二转动轴,并沿垂直所述第二转动轴的轴心方向延伸,所述第二连接臂固定连接所述第一连接臂,并沿垂直所述第一连接臂方向延伸,所述第二连接臂的延伸方向平行所述第二转动轴的轴心方向,所述第三转动部连接所述第二连接臂远离所述第一连接臂的一端。The thruster according to claim 6 is characterized in that the second bracket includes a first connecting arm and a second connecting arm, the first connecting arm is connected to the second rotating shaft and extends in an axial direction perpendicular to the second rotating shaft, the second connecting arm is fixedly connected to the first connecting arm and extends in a direction perpendicular to the first connecting arm, the extension direction of the second connecting arm is parallel to the axial direction of the second rotating shaft, and the third rotating portion is connected to an end of the second connecting arm away from the first connecting arm.
  9. 根据权利要求6所述的推进器,其特征在于,所述第三转动部包括第三支架和第三转动轴,第三支架通过所述第三转动轴连接于所述第二支架,所述螺旋桨转动连接所述第三支架。The propeller according to claim 6 is characterized in that the third rotating part includes a third bracket and a third rotating shaft, the third bracket is connected to the second bracket through the third rotating shaft, and the propeller is rotatably connected to the third bracket.
  10. 根据权利要求9所述的推进器,其特征在于,所述第三转动部还包括第三驱动件,所述第三驱动件连接所述第三转动轴,用于经所述第三转动轴驱动所述第三支架转动。The propeller according to claim 9 is characterized in that the third rotating portion further includes a third driving member, and the third driving member is connected to the third rotating shaft and is used to drive the third bracket to rotate via the third rotating shaft.
  11. 根据权利要求9所述的推进器,其特征在于,所述推进器还包括转动设置于所述第三支架的动力输出轴,所述螺旋桨连接所述动力输出轴,并经所述动力输出轴获取转动扭矩。The propeller according to claim 9 is characterized in that the propeller also includes a power output shaft rotatably arranged on the third bracket, the propeller is connected to the power output shaft, and obtains the rotational torque through the power output shaft.
  12. 根据权利要求9所述的推进器,其特征在于,所述推进器还包括固定于所述第一转动部、或第二转动部、或第三转动部的扭转动力机,所述扭转动力机用于为所述第一转动部、第二转动部和第三转动部至少一者提供转动扭矩。The propeller according to claim 9 is characterized in that the propeller also includes a torsion power machine fixed to the first rotating part, the second rotating part, or the third rotating part, and the torsion power machine is used to provide rotational torque for at least one of the first rotating part, the second rotating part and the third rotating part.
  13. 根据权利要求1-12任意一项所述的推进器,其特征在于,所述推进器还包括原动机, 所述原动机固定于所述第三转动部,用于驱动所述螺旋桨旋转。The propeller according to any one of claims 1 to 12 is characterized in that the propeller further comprises a prime mover, wherein the prime mover is fixed to the third rotating part and is used to drive the propeller to rotate.
  14. 根据权利要求13所述的推进器,其特征在于,所述原动机固定于所述第三转动部远离所述螺旋桨处,所述推进器还包括连接所述原动机和所述螺旋桨的传动机构。The propeller according to claim 13 is characterized in that the prime mover is fixed to the third rotating part away from the propeller, and the propeller also includes a transmission mechanism connecting the prime mover and the propeller.
  15. 根据权利要求13所述的推进器,其特征在于,所述原动机固定于所述第三转动部连接所述螺旋桨处,与所述螺旋桨轴连接。The propeller according to claim 13 is characterized in that the prime mover is fixed to the place where the third rotating part is connected to the propeller and is connected to the propeller shaft.
  16. 根据权利要求13所述的推进器,其特征在于,所述原动机为电机,所述推进器还包括驱动器,所述驱动器电连接所述原动机,用以驱动所述原动机运行。The propeller according to claim 13 is characterized in that the prime mover is a motor, and the propeller also includes a driver, which is electrically connected to the prime mover to drive the prime mover to operate.
  17. 根据权利要求2所述的推进器,其特征在于,所述第一转动部相对所述船体具有三个第一转动自由度,三个第一转动自由度分别设置于相互垂直的三个第一转动平面。The propeller according to claim 2 is characterized in that the first rotating part has three first rotational degrees of freedom relative to the hull, and the three first rotational degrees of freedom are respectively arranged in three first rotational planes that are perpendicular to each other.
  18. 根据权利要求17所述的推进器,其特征在于,所述第一转动部包括第一转动节和连接所述第一转动节的第一转向臂,所述第一转动节设有依次连接的三个第一转向轴,三个第一转向轴相互垂直,所述第一转向臂的一端经三个所述第一转向轴连接所述船体,所述第一转向臂的另一端连接所述第二转动部。The propeller according to claim 17 is characterized in that the first rotating part includes a first rotating joint and a first steering arm connected to the first rotating joint, the first rotating joint is provided with three first steering shafts connected in sequence, the three first steering shafts are perpendicular to each other, one end of the first steering arm is connected to the hull via the three first steering shafts, and the other end of the first steering arm is connected to the second rotating part.
  19. 根据权利要求18所述的推进器,其特征在于,所述第一转动部还包括三个第一电机,三个所述第一电机分别用于驱动三个所述第一转向轴转动,以带动所述第一转向臂相对所述船体转动。The propeller according to claim 18 is characterized in that the first rotating part also includes three first motors, and the three first motors are respectively used to drive the three first steering shafts to rotate, so as to drive the first steering arms to rotate relative to the hull.
  20. 根据权利要求2所述的推进器,其特征在于,所述第二转动部相对所述第一转动部具有三个第二转动自由度,三个第二转动自由度分别设置于相互垂直的三个第二转动平面。The propeller according to claim 2 is characterized in that the second rotating part has three second rotational degrees of freedom relative to the first rotating part, and the three second rotational degrees of freedom are respectively arranged in three second rotational planes that are perpendicular to each other.
  21. 根据权利要求20所述的推进器,其特征在于,所述第二转动部包括第二转动节和连接所述第二转动节的第二转向臂,所述第二转动节设有依次连接的三个第二转向轴,三个第二转向轴相互垂直,所述第二转向臂的一端经三个所述第二转向轴连接所述第一转动部,所述第二转向臂的另一端连接所述第三转动部。The propeller according to claim 20 is characterized in that the second rotating part includes a second rotating joint and a second steering arm connected to the second rotating joint, the second rotating joint is provided with three second steering shafts connected in sequence, the three second steering shafts are perpendicular to each other, one end of the second steering arm is connected to the first rotating part via the three second steering shafts, and the other end of the second steering arm is connected to the third rotating part.
  22. 根据权利要求21所述的推进器,其特征在于,所述第二转动部还包括三个第二电机,三个所述第二电机分别用于驱动三个所述第二转向轴转动,以带动所述第二转向臂相对所述第二转动部转动。The propeller according to claim 21 is characterized in that the second rotating part also includes three second motors, and the three second motors are respectively used to drive the three second steering shafts to rotate, so as to drive the second steering arm to rotate relative to the second rotating part.
  23. 根据权利要求2所述的推进器,其特征在于,所述第三转动部相对所述第二转动部具有三个第三转动自由度,三个第三转动自由度分别设置于相互垂直的三个第三转动平面。The propeller according to claim 2 is characterized in that the third rotating part has three third rotational degrees of freedom relative to the second rotating part, and the three third rotational degrees of freedom are respectively arranged in three third rotational planes that are perpendicular to each other.
  24. 根据权利要求23所述的推进器,其特征在于,所述第三转动部包括第三转动节和连接所述第三转动节的第三转向臂,所述第三转动节设有依次连接的三个第三转向轴,三个第三转向轴相互垂直,所述第三转向臂的一端经三个所述第三转向轴连接所述第二转动部,所述第三转向臂的另一端连接所述螺旋桨。The propeller according to claim 23 is characterized in that the third rotating part includes a third rotating joint and a third steering arm connected to the third rotating joint, the third rotating joint is provided with three third steering shafts connected in sequence, the three third steering shafts are perpendicular to each other, one end of the third steering arm is connected to the second rotating part via the three third steering shafts, and the other end of the third steering arm is connected to the propeller.
  25. 根据权利要求24所述的推进器,其特征在于,所述第三转动部还包括三个第三电机,三个所述第三电机分别用于驱动三个所述第三转向轴转动,以带动所述第三转向臂相对所述第二转动部转动。The propeller according to claim 24 is characterized in that the third rotating part also includes three third motors, and the three third motors are respectively used to drive the three third steering shafts to rotate, so as to drive the third steering arm to rotate relative to the second rotating part.
  26. 一种水域可移动设备,其特征在于,包括权利要求1至25任一项所述推进器、船体和惯导模块;A movable device in waters, characterized in that it comprises the propeller, hull and inertial navigation module according to any one of claims 1 to 25;
    所述惯导模块固定于所述船体,用于感测船体运动数据;The inertial navigation module is fixed to the hull and is used to sense hull motion data;
    所述推进器连接所述船体,所述推进器设有与所述惯导模块电连接的主控模块,所述主控模块用于将所述水域可移动设备的运动数据进行姿态解算,并产生平衡控制指令,所述平 衡控制指令包括角度控制指令、位移控制指令;The propeller is connected to the hull, and is provided with a main control module electrically connected to the inertial navigation module, and the main control module is used to perform attitude calculation on the motion data of the movable device in the water area and generate a balance control instruction, and the balance control instruction includes an angle control instruction and a displacement control instruction;
    所述角度控制指令用于指示第一转动部、第二转动部和/或第三转动部调整姿态,以控制螺旋桨推动船体转向目标角度,所述位移控制指令用于指示所述螺旋桨的转速及转向,以控制螺旋桨推动所述船体移动目标位移。The angle control instruction is used to instruct the first rotating part, the second rotating part and/or the third rotating part to adjust their posture so as to control the propeller to push the hull to turn to the target angle, and the displacement control instruction is used to instruct the rotation speed and direction of the propeller so as to control the propeller to push the hull to move the target displacement.
  27. 根据权利要求26所述的水域可移动设备,其特征在于,所述角度控制指令包括目标转动方向和目标转动部;所述目标转动方向指示所述目标转动部的转动方向,所述目标转动部指示所述第一转动部、第二转动部和第三转动部的至少一者转动。The movable device for water areas according to claim 26 is characterized in that the angle control instruction includes a target rotation direction and a target rotation part; the target rotation direction indicates the rotation direction of the target rotation part, and the target rotation part indicates the rotation of at least one of the first rotation part, the second rotation part and the third rotation part.
  28. 根据权利要求27所述的水域可移动设备,其特征在于,所述平衡控制指令还包括转速控制指令;所述转速控制指令指示所述目标转动部在所述目标转动方向上的转动速率。The movable device for water area according to claim 27 is characterized in that the balance control instruction also includes a rotation speed control instruction; the rotation speed control instruction indicates the rotation rate of the target rotating part in the target rotation direction.
  29. 根据权利要求28所述的水域可移动设备,其特征在于,所述角度控制指令还包括目标转向角度值,所述目标转向角度值指示所述目标转动部在所述目标转动方向上转动的角度值。The movable device for water areas according to claim 28 is characterized in that the angle control instruction also includes a target steering angle value, and the target steering angle value indicates the angle value of the target rotating part rotating in the target rotation direction.
  30. 根据权利要求27所述的水域可移动设备,其特征在于,所述水域可移动设备包括单个或双个所述推进器。The movable device for water areas according to claim 27 is characterized in that the movable device for water areas comprises a single or double propeller.
  31. 一种水域可移动设备减摇控制方法,用于权利要求26至30任一项所述的水域可移动设备的减摇控制,其特征在于,包括:A method for stabilizing and controlling a mobile device in water area, used for stabilizing and controlling a mobile device in water area according to any one of claims 26 to 30, characterized in that it comprises:
    获取惯导模块感测的水域可移动设备运动数据;Obtain the motion data of movable equipment in water area sensed by the inertial navigation module;
    对所述水域可移动设备运动数据进行姿态解算,产生平衡控制指令,所述平衡控制指令包括角度控制指令和位移控制指令;Performing posture calculation on the motion data of the movable device in the water area to generate a balance control instruction, wherein the balance control instruction includes an angle control instruction and a displacement control instruction;
    角度控制指令用于指示第一转动部、第二转动部和/或第三转动部调整姿态,以控制螺旋桨推动船体转向目标角度,所述位移控制指令指示所述螺旋桨的转速及转向,以控制螺旋桨推动所述船体移动目标位移。The angle control instruction is used to instruct the first rotating part, the second rotating part and/or the third rotating part to adjust their posture to control the propeller to push the hull to turn to the target angle, and the displacement control instruction indicates the rotation speed and direction of the propeller to control the propeller to push the hull to move the target displacement.
  32. 根据权利要求31所述的水域可移动设备减摇控制方法,其特征在于,所述水域可移动设备运动数据包括在预设的水域可移动设备坐标系上的角速度、加速度、磁场方向以及欧拉角。The anti-roll control method for a mobile device in water area according to claim 31 is characterized in that the motion data of the mobile device in water area includes angular velocity, acceleration, magnetic field direction and Euler angle in a preset coordinate system of the mobile device in water area.
  33. 根据权利要求32所述的水域可移动设备减摇控制方法,其特征在于,所述预设的水域可移动设备坐标系,以水域可移动设备重心为原点,水域可移动设备长度方向为X轴,水域可移动设备宽度方向为Y轴,水域可移动设备高度方向为Z轴。The anti-roll control method for a movable device in water area according to claim 32 is characterized in that the preset coordinate system of the movable device in water area takes the center of gravity of the movable device in water area as the origin, the length direction of the movable device in water area as the X-axis, the width direction of the movable device in water area as the Y-axis, and the height direction of the movable device in water area as the Z-axis.
  34. 根据权利要求31所述的水域可移动设备减摇控制方法,其特征在于,所述对所述水域可移动设备运动数据进行姿态解算,产生平衡控制指令,包括:The anti-roll control method for a mobile device in water area according to claim 31 is characterized in that the posture calculation of the motion data of the mobile device in water area and the generation of a balance control instruction include:
    采用四元数法对所述水域可移动设备运动数据进行姿态解算,得到水域可移动设备姿态数据;Using quaternion method to perform attitude calculation on the motion data of the mobile device in water area to obtain attitude data of the mobile device in water area;
    根据所述水域可移动设备姿态数据,确定目标调整角度和目标调整位移;Determining a target adjustment angle and a target adjustment displacement according to the posture data of the movable device in the water area;
    根据所述目标调整角度和目标调整位移,生成所述角度控制指令和位移控制指令。The angle control instruction and the displacement control instruction are generated according to the target adjustment angle and the target adjustment displacement.
  35. 根据权利要求34所述的水域可移动设备减摇控制方法,其特征在于,所述水域可移动设备姿态数据包括俯仰角、翻滚角和/或偏航角。The anti-roll control method for mobile equipment in water areas according to claim 34 is characterized in that the posture data of the mobile equipment in water areas includes a pitch angle, a roll angle and/or a yaw angle.
  36. 根据权利要求35所述的水域可移动设备减摇控制方法,其特征在于,在所述产生平衡控制指令之后,所述方法还包括:The anti-roll control method for mobile equipment in water area according to claim 35 is characterized in that after generating the balance control instruction, the method further comprises:
    判断所述水域可移动设备姿态数据是否被调整到预设姿态阈值内;Determining whether the posture data of the movable device in the water area is adjusted to within a preset posture threshold;
    若是,则结束控制流程;If so, the control flow ends;
    若否,则循环执行控制流程。If not, the control flow is executed cyclically.
  37. 根据权利要求31所述的水域可移动设备减摇控制方法,其特征在于,所述角度控制指令包括目标转动方向、目标转动部和目标转向角度值,所述目标转向角度值指示所述目标转动部在所述目标转动方向上转动的角度值;所述目标转动方向指示所述目标转动部的转动方向;所述目标转动部指示所述第一转动部、第二转动部和第三转动部的至少一者转动。According to the anti-roll control method for movable equipment in water area according to claim 31, it is characterized in that the angle control instruction includes a target rotation direction, a target rotating part and a target steering angle value, the target steering angle value indicates the angle value of the target rotating part rotating in the target rotation direction; the target rotation direction indicates the rotation direction of the target rotating part; the target rotating part indicates the rotation of at least one of the first rotating part, the second rotating part and the third rotating part.
  38. 根据权利要求37所述的水域可移动设备减摇控制方法,其特征在于,若所述目标转动方向包括横摇方向,以所述推进器的第三转动部为目标转动部,并控制所述目标转动部转动目标转向角度值,以控制螺旋桨推动船体转向目标角度。According to the anti-roll control method for movable equipment in water areas as described in claim 37, it is characterized in that if the target rotation direction includes a roll direction, the third rotating part of the propeller is used as the target rotating part, and the target rotating part is controlled to rotate to a target steering angle value to control the propeller to push the hull to turn to the target angle.
  39. 根据权利要求37所述的水域可移动设备减摇控制方法,其特征在于,若所述目标转动方向包括纵摇方向,以所述推进器的第一转动部为目标转动部,并控制所述目标转动部转动目标转向角度值,以控制螺旋桨推动船体转向目标角度。According to the anti-roll control method for movable equipment in water areas as described in claim 37, it is characterized in that if the target rotation direction includes a pitch direction, the first rotating part of the propeller is used as the target rotating part, and the target rotating part is controlled to rotate to a target steering angle value to control the propeller to push the hull to turn to the target angle.
  40. 根据权利要求37所述的水域可移动设备减摇控制方法,其特征在于,若所述目标转动方向包括艏摇方向,以所述推进器的第二转动部为目标转动部,并控制所述目标转动部转动目标转向角度值,以控制螺旋桨推动船体转向目标角度。According to the anti-roll control method for movable equipment in water areas as described in claim 37, it is characterized in that if the target rotation direction includes the bow roll direction, the second rotating part of the propeller is used as the target rotating part, and the target rotating part is controlled to rotate to a target steering angle value to control the propeller to push the hull to turn to the target angle.
  41. 根据权利要求37所述的水域可移动设备减摇控制方法,其特征在于,若所述目标转动方向包括横荡方向,以所述推进器的第三转动部为目标转动部,并控制所述目标转动部转动目标转向角度值,以控制螺旋桨推动船体转向目标角度。According to the anti-roll control method for movable equipment in water areas as described in claim 37, it is characterized in that if the target rotation direction includes the lateral swing direction, the third rotating part of the propeller is used as the target rotating part, and the target rotating part is controlled to rotate to a target steering angle value to control the propeller to push the hull to turn to the target angle.
  42. 根据权利要求37所述的水域可移动设备减摇控制方法,其特征在于,若所述目标转动方向包括纵荡方向,以所述推进器的第二转动部为目标转动部,并控制所述目标转动部转动目标转向角度值,以控制螺旋桨推动船体转向目标角度。The anti-roll control method for movable equipment in water areas according to claim 37 is characterized in that if the target rotation direction includes the longitudinal swing direction, the second rotating part of the propeller is used as the target rotating part, and the target rotating part is controlled to rotate to a target steering angle value to control the propeller to push the hull to turn to the target angle.
  43. 根据权利要求38所述的水域可移动设备减摇控制方法,其特征在于,若所述目标转动方向包括垂荡方向,以所述推进器的第一转动部为目标转动部,并控制所述目标转动部转动目标转向角度值,以控制螺旋桨推动船体转向目标角度。The anti-roll control method for movable equipment in water areas according to claim 38 is characterized in that if the target rotation direction includes the vertical swing direction, the first rotating part of the propeller is used as the target rotating part, and the target rotating part is controlled to rotate to a target steering angle value to control the propeller to push the hull to turn to the target angle.
  44. 一种存储介质,其特征在于,所述存储介质包括计算机指令,所述存储介质上存储有计算机可读指令,所述计算机可读指令被处理器执行时实现如权利要求31至43中任一项所述的水域可移动设备减摇控制方法。A storage medium, characterized in that the storage medium includes computer instructions, and computer-readable instructions are stored on the storage medium, and when the computer-readable instructions are executed by a processor, the anti-roll control method for a mobile device in water area as described in any one of claims 31 to 43 is implemented.
PCT/CN2022/131174 2022-11-10 2022-11-10 Thruster, water area movable device and stabilization control method therefor, and storage medium WO2024098334A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202280005741.1A CN117015500A (en) 2022-11-10 2022-11-10 Propeller, water area movable device, stabilization control method for the same, and storage medium
PCT/CN2022/131174 WO2024098334A1 (en) 2022-11-10 2022-11-10 Thruster, water area movable device and stabilization control method therefor, and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2022/131174 WO2024098334A1 (en) 2022-11-10 2022-11-10 Thruster, water area movable device and stabilization control method therefor, and storage medium

Publications (1)

Publication Number Publication Date
WO2024098334A1 true WO2024098334A1 (en) 2024-05-16

Family

ID=88564003

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/131174 WO2024098334A1 (en) 2022-11-10 2022-11-10 Thruster, water area movable device and stabilization control method therefor, and storage medium

Country Status (2)

Country Link
CN (1) CN117015500A (en)
WO (1) WO2024098334A1 (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080020658A1 (en) * 2003-03-14 2008-01-24 Brian Provost Outboard motor with reverse shift
US20170043853A1 (en) * 2014-04-17 2017-02-16 Kabushiki Kaisha Toyota Jidoshokki Marine engine propelling apparatuses
CN106741791A (en) * 2016-12-28 2017-05-31 中国人民解放军海军工程大学 full rotary underwater propeller
CN107512380A (en) * 2017-08-22 2017-12-26 大连理工大学 A kind of all-around propeller, ship and floating platform
CN107554739A (en) * 2017-08-22 2018-01-09 大连理工大学 A kind of two-way all-direction propeller, ship and floating platform
CN108313232A (en) * 2018-03-13 2018-07-24 厦门大学 Combined type ship stabilizer based on two-dimensional vector propeller and moving heavy object
CN209535428U (en) * 2019-01-31 2019-10-25 海南大学 A kind of shipboard self-stabilization suspension arrangement
CN211139635U (en) * 2019-11-25 2020-07-31 江西为民机械有限公司 Outboard engine low-energy-consumption self-stabilizing suspension device
CN113697078A (en) * 2021-09-26 2021-11-26 河北科技师范学院 Underwater robot

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT1246890B (en) * 1990-10-10 1994-11-28 Carlo Alinari PROPULSION SYSTEM FOR FAST VESSELS.
US20060079140A1 (en) * 2002-12-03 2006-04-13 Supraventures Ag Watercraft
US8468964B2 (en) * 2004-09-14 2013-06-25 Kevin Daniel Hoberman Methods and arrangements for redirecting thrust from a propeller
SE535979C2 (en) * 2011-09-16 2013-03-12 Tagg R & D Ab Q Method and apparatus for avoiding and attenuating the rolling of a ship
CN202624599U (en) * 2012-06-14 2012-12-26 苟乃琛 Propeller stabilization system
EP3071475B1 (en) * 2013-11-18 2019-04-03 AB Volvo Penta A method for controlling a boat comprising a pivotable drive unit, and a electronic vessel control unit for steering a boat
ITUA20163171A1 (en) * 2016-05-05 2017-11-05 Ultraflex Spa Combination of a propulsion group and a boat, a method of propulsion of a boat and a propulsion group for a boat
JP2020032871A (en) * 2018-08-30 2020-03-05 ヤンマー株式会社 Electric propulsion device and electric propulsion ship
CN109305309B (en) * 2018-11-30 2020-03-20 厦门大学 Multifunctional telescopic ship vector spiral rocker reducing arm
CN212890871U (en) * 2020-09-14 2021-04-06 桂林三井农机有限公司 Universal swing outboard motor
CN115071942B (en) * 2022-05-27 2023-09-05 广东逸动科技有限公司 Marine outboard engine, ship, and control method of marine outboard engine

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20080020658A1 (en) * 2003-03-14 2008-01-24 Brian Provost Outboard motor with reverse shift
US20170043853A1 (en) * 2014-04-17 2017-02-16 Kabushiki Kaisha Toyota Jidoshokki Marine engine propelling apparatuses
CN106741791A (en) * 2016-12-28 2017-05-31 中国人民解放军海军工程大学 full rotary underwater propeller
CN107512380A (en) * 2017-08-22 2017-12-26 大连理工大学 A kind of all-around propeller, ship and floating platform
CN107554739A (en) * 2017-08-22 2018-01-09 大连理工大学 A kind of two-way all-direction propeller, ship and floating platform
CN108313232A (en) * 2018-03-13 2018-07-24 厦门大学 Combined type ship stabilizer based on two-dimensional vector propeller and moving heavy object
CN209535428U (en) * 2019-01-31 2019-10-25 海南大学 A kind of shipboard self-stabilization suspension arrangement
CN211139635U (en) * 2019-11-25 2020-07-31 江西为民机械有限公司 Outboard engine low-energy-consumption self-stabilizing suspension device
CN113697078A (en) * 2021-09-26 2021-11-26 河北科技师范学院 Underwater robot

Also Published As

Publication number Publication date
CN117015500A (en) 2023-11-07

Similar Documents

Publication Publication Date Title
US8417399B2 (en) Systems and methods for orienting a marine vessel to minimize pitch or roll
US8478464B2 (en) Systems and methods for orienting a marine vessel to enhance available thrust
US9156535B2 (en) Vessel propulsion system and vessel including the same
JP6831459B2 (en) How to operate a vessel with multiple propulsion units
CN102887217B (en) Autonomous underwater vehicle (AUV) vector thrust device
CN111232167B (en) Full-freedom underwater vehicle and control method thereof
CN108313232B (en) Combined ship stabilizing device based on two-dimensional vector propeller and moving weight
JP4814692B2 (en) Navigation system
JP6982681B2 (en) Azimuth thrusters, ships, floating platforms, diving equipment and submarines
CN112591059B (en) Underwater vehicle control method
US20160251070A1 (en) Trimmable Rudder
WO2024098334A1 (en) Thruster, water area movable device and stabilization control method therefor, and storage medium
US7090549B2 (en) System to propel an air powered boat
CN219077455U (en) Propeller and movable equipment in water area
CN209327875U (en) Coordinate augmentation control system in unmanned boat rolling-course
CN219077457U (en) Propeller and movable equipment in water area
CN219077464U (en) Propeller and movable equipment in water area
CN109669469B (en) Unmanned ship roll-course coordination stability augmentation control system and method
CN109358495A (en) Unmanned boat pitch-rotational speed difference, which subtracts, shakes stability augmentation system and method
CN114030579B (en) Unmanned ship stability control method and propulsion device
US20230030018A1 (en) Marine vessel with gyroscope-assisted joystick maneuvering
JPH11139392A (en) Method for controlling rudder of underwater sailing body
JP7448235B2 (en) Marine rudders and vessels
CN112590751B (en) Amphibious air cushion vehicle and steering linkage control method thereof
JP7352522B2 (en) water vehicle