CN113665776A - Rudder angle control method, rudder angle control device and rudder angle control box - Google Patents
Rudder angle control method, rudder angle control device and rudder angle control box Download PDFInfo
- Publication number
- CN113665776A CN113665776A CN202110886901.5A CN202110886901A CN113665776A CN 113665776 A CN113665776 A CN 113665776A CN 202110886901 A CN202110886901 A CN 202110886901A CN 113665776 A CN113665776 A CN 113665776A
- Authority
- CN
- China
- Prior art keywords
- rudder
- neutral
- sensor
- rudder angle
- feedback value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63H—MARINE PROPULSION OR STEERING
- B63H25/00—Steering; Slowing-down otherwise than by use of propulsive elements; Dynamic anchoring, i.e. positioning vessels by means of main or auxiliary propulsive elements
- B63H25/06—Steering by rudders
- B63H25/08—Steering gear
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63H—MARINE PROPULSION OR STEERING
- B63H25/00—Steering; Slowing-down otherwise than by use of propulsive elements; Dynamic anchoring, i.e. positioning vessels by means of main or auxiliary propulsive elements
- B63H25/06—Steering by rudders
- B63H25/08—Steering gear
- B63H25/14—Steering gear power assisted; power driven, i.e. using steering engine
- B63H25/18—Transmitting of movement of initiating means to steering engine
- B63H25/24—Transmitting of movement of initiating means to steering engine by electrical means
Landscapes
- Chemical & Material Sciences (AREA)
- Engineering & Computer Science (AREA)
- Combustion & Propulsion (AREA)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The application discloses a rudder angle control method, a rudder angle control device, a rudder angle control box and a computer readable storage medium. The rudder angle control method comprises the following steps: after a rudder angle neutral control instruction is received, acquiring a feedback value output by a rudder neutral sensor; if the feedback value is a preset first value, steering is carried out based on the steering angle neutral control instruction; and if the feedback value is a preset second value, stopping steering. Through the scheme, the unmanned equipment can eliminate rudder mid-position oscillation caused by rudder angle delay caused by the structure to a certain extent.
Description
Technical Field
The present application belongs to the technical field of device control, and in particular, relates to a rudder angle control method, a rudder angle control device, a rudder angle control box, and a computer-readable storage medium.
Background
For unmanned devices, such as unmanned ships, there are some problems in their autonomous driving state: the rudder angle feedback precision and the mechanical structure of the rudder connecting rod limit, so that obvious control delay is realized, the rudder angle jitter is easy to generate when the program controls the unmanned ship to steer back to the neutral position, the heading swings back and forth when the rudder angle of the unmanned ship is in the neutral position, the unmanned ship cannot be stabilized, and an S-shaped path is formed when the unmanned ship moves straight.
Disclosure of Invention
The application provides a rudder angle control method, a rudder angle control device, a rudder angle control box and a computer readable storage medium, which can enable unmanned equipment to eliminate rudder neutral oscillation caused by rudder angle delay caused by a structure to a certain extent.
In a first aspect, the present application provides a rudder angle control method applied to a rudder angle control box of an unmanned aerial vehicle, including:
after a rudder angle neutral control instruction is received, acquiring a feedback value output by a rudder neutral sensor;
if the feedback value is a preset first value, steering is carried out based on the steering angle neutral control instruction;
and if the feedback value is a preset second value, stopping steering.
In a second aspect, the present application provides a rudder angle control device applied to a rudder angle control box of an unmanned aerial vehicle, including:
the first acquisition module is used for acquiring a feedback value output by the rudder neutral sensor after receiving a rudder angle neutral control instruction;
the first control module is used for steering based on the steering angle neutral control instruction if the feedback value is a preset first value;
and the second control module is used for stopping steering if the feedback value is a preset second value.
In a third aspect, the present application provides a control method applied to a general-purpose control box of a control apparatus for controlling a component to perform a circular motion or a reciprocating motion; the control method comprises the following steps:
when a driving instruction for a specified position is received, acquiring a general feedback value output by a specified position sensor;
if the general feedback value is a preset third value, controlling the component to move to the appointed position based on the driving instruction;
and if the general feedback value is a preset fourth value, stopping controlling the assembly.
In a fourth aspect, the present application provides a control device applied to a universal control box of a control apparatus for controlling a component to perform a circular motion or a reciprocating motion; the control device includes:
the second acquisition module is used for acquiring a general feedback value output by the sensor at the specified position after receiving a driving instruction for the specified position;
a third control module, configured to control the component to move to the specified position based on the driving instruction if the general feedback value is a preset third value;
and the fourth control module is used for stopping controlling the components if the general feedback value is a preset fourth value.
In a fifth aspect, the present application provides a rudder angle controlling box comprising a memory, a processor and a computer program stored in the memory and executable on the processor, the processor implementing the steps of the method according to the first aspect when executing the computer program.
In a sixth aspect, the present application provides a computer-readable storage medium storing a computer program which, when executed by a processor, performs the steps of the method of the first aspect; alternatively, the computer program as described above, when executed by a processor, performs the steps of the method as described above in the third aspect.
In a seventh aspect, the present application provides a computer program product comprising a computer program which, when executed by one or more processors, performs the steps of the method as described in the first aspect above; alternatively, the computer program as described above, when executed by one or more processors, performs the steps of the method as described above in the third aspect.
Compared with the prior art, the application has the beneficial effects that: the novel assembly of the rudder neutral position sensor is added into the unmanned equipment, and the rudder angle control box does not judge whether the current rudder angle returns to the neutral position based on the output of the rudder angle sensor any more, but judges whether the current rudder angle returns to the neutral position based on the output of the rudder neutral position sensor. Specifically, after the rudder angle control box receives a rudder angle neutral control instruction, a feedback value output by a rudder neutral sensor may be acquired first, if the feedback value is a preset first value, steering is performed based on the rudder angle neutral control instruction, and if the feedback value is a preset second value, steering is stopped. Through the process, the pilotless device can eliminate rudder neutral oscillation caused by rudder angle delay caused by the structure to a certain extent. It is to be understood that, the beneficial effects of the second to seventh aspects may be referred to the relevant description of the first aspect, and are not repeated herein.
Drawings
In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings needed to be used in the embodiments or the prior art descriptions will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present application, and it is obvious for those skilled in the art to obtain other drawings without creative efforts.
FIG. 1 is a schematic flow chart of an implementation of a rudder angle control method provided by an embodiment of the present application;
fig. 2 is an exemplary diagram of an installation position of a rudder neutral position sensor and a rudder neutral position sensor strip in a ship according to an embodiment of the present application;
fig. 3 is an exemplary diagram illustrating the movement of a rudder connecting rod and a stern machine when a ship rudder left according to an embodiment of the present application;
fig. 4 is an exemplary diagram of the movement of a rudder connecting rod and a stern machine when a ship steers a right rudder according to an embodiment of the present application;
fig. 5 is a schematic structural diagram of a rudder angle control device according to an embodiment of the present application;
fig. 6 is a schematic structural diagram of a rudder angle control box according to an embodiment of the present application.
Detailed Description
In the following description, for purposes of explanation and not limitation, specific details are set forth, such as particular system structures, techniques, etc. in order to provide a thorough understanding of the embodiments of the present application. It will be apparent, however, to one skilled in the art that the present application may be practiced in other embodiments that depart from these specific details. In other instances, detailed descriptions of well-known systems, devices, circuits, and methods are omitted so as not to obscure the description of the present application with unnecessary detail.
In order to explain the technical solutions proposed in the embodiments of the present application, the following description will be given by way of specific examples.
Taking an unmanned ship device (hereinafter referred to as a ship) as an example, a rudder angle control method provided by the embodiment of the present application is described below. Referring to fig. 1, the rudder angle control method is applied to a rudder angle control box, and mainly describes control of steering in a ship sailing process. The rudder angle control method comprises the following steps:
and 101, acquiring a feedback value output by a rudder neutral sensor after receiving a rudder angle neutral control instruction.
In the present embodiment, the drone incorporates a new assembly of a rudder neutral sensor. The rudder neutral position sensor is used for detecting whether the rudder angle of the current unmanned equipment is in a preset neutral position range. Specifically, if the rudder angle of the current unmanned aerial vehicle is not in the preset neutral range, the feedback value output by the rudder neutral sensor is a preset first value (for example, "0"); on the contrary, if the rudder angle of the current unmanned aerial vehicle is already in the preset neutral range, the feedback value output by the rudder neutral sensor is a preset second value (for example, "1"). It can be understood that the detection of the rudder neutral position by the rudder neutral position sensor is not limited to a single position, but a neutral position range is set, and as long as the rudder angle is within the neutral position range, the current rudder angle can be considered to return to the neutral position.
And the main control of the unmanned equipment sends a rudder angle neutral control instruction to the rudder angle control box when the requirement of returning to the rudder angle neutral position exists. It can be understood that the rudder angle neutral position control instruction is used for instructing the rudder angle control box to steer towards one side, so that the rudder angle can return to the neutral position. The rudder angle control box is connected with the middle position sensor, so that the rudder angle control box can obtain a feedback value output by the rudder middle position sensor after receiving the rudder angle middle position control instruction.
And 102, if the feedback value is a preset first value, steering based on the rudder angle neutral control instruction.
In the embodiment of the present application, it has been described in step 101 that when the rudder angle of the current unmanned device is not in the preset neutral range, the feedback value output by the rudder neutral sensor is the preset first value. Thus, when the feedback value acquired by the rudder angle control box is the first value, the rudder angle control box knows that the rudder angle of the current unmanned equipment is not in the neutral range. At this time, steering needs to be continued based on the steering angle neutral position control command until the steering angle returns to the neutral position.
In some embodiments, the rudder angle neutral control instruction comprises a left rudder opening neutral control instruction and a right rudder opening neutral control instruction; it can be understood that when the current rudder angle is on the right side, the middle position of the rudder angle returning should be steered to the left, and the middle position control instruction of the rudder angle at the moment is specifically a left steering middle position control instruction; when the current rudder angle is on the left side, the rudder angle returning middle position needs to steer to the right, and the rudder angle middle position control instruction at the moment is specifically a right steering middle position control instruction. Then this step may specifically be: if the steering angle middle position control instruction is a left steering middle position control instruction, steering to the left; and if the steering angle middle position control instruction is a right steering middle position control instruction, steering to the right.
And 103, stopping steering if the feedback value is a preset second value.
In the embodiment of the present application, it has been described in step 101 that when the rudder angle of the current unmanned aerial vehicle is already in the preset neutral range, the feedback value output by the rudder neutral sensor is the preset second value. Thus, when the feedback value acquired by the rudder angle control box is the second value, the rudder angle control box knows that the rudder angle of the current unmanned equipment is already in the neutral range. At the moment, no matter how many rudder angle values are fed back by the rudder angle sensor, the rudder angle is considered to be in the middle position, and no rudder beating is needed any more; that is, the current steering operation may be stopped. The unmanned equipment can realize straight line driving without rudder angle shake.
In some embodiments, the unmanned device has multiple sailing modes, and rudder angle dithering tends to occur only in the sailing mode of the unmanned mode. Based on the method, the rudder angle control box can detect the navigation mode of the unmanned equipment; the operation of step 101 is executed only when the unmanned device is in the unmanned mode, and the feedback value output by the rudder neutral sensor is acquired after the rudder angle neutral control instruction is received.
In some embodiments, a rudder neutral sensor may be used to sense the signal emitted by the sensed object. It can be understood that when the sensed object is closer to the rudder neutral sensor, the stronger the signal intensity of the signal sent by the sensed object sensed by the rudder neutral sensor is; on the contrary, when the sensed object is far away from the rudder center sensor, the signal strength of the signal sent by the sensed object sensed by the rudder center sensor is weaker. By adjusting the mounting positions of the rudder neutral position sensor and the sensed object, the sensing range of the rudder neutral position sensor and the sensed range of the sensed object are overlapped in the preset direction in the rudder angle neutral position state (namely, the rudder angle is in the preset neutral position range). In addition, the signal intensity of the signal sensed by the rudder neutral position sensor when the sensing range of the rudder neutral position sensor is just overlapped with the sensed range of the sensed object can be recorded, and the signal intensity can be set as the preset intensity. Therefore, when the signal intensity of the signal sensed by the rudder neutral position sensor is lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a first value and is used for indicating that the rudder angle does not return to the neutral position; when the signal intensity of the signal sensed by the rudder neutral position sensor is not lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a second value and is used for indicating that the rudder angle returns to the neutral position;
alternatively, the rudder center sensor may be used to sense the distance between the sensed object and itself (i.e., the rudder center sensor), for example, by estimating the distance from the rudder center sensor by sending and reflecting signals. When the distance sensed by the rudder neutral position sensor is out of the preset distance range, the feedback value output by the rudder neutral position sensor is a first value; and when the distance sensed by the rudder neutral position sensor is within the preset distance range, the feedback value output by the rudder neutral position sensor is a second value.
In some embodiments, the rudder neutral sensor may be specifically configured to sense a rudder neutral sensing strip; when the rudder center sensor does not sense the rudder center sensing piece, the feedback value output by the rudder center sensor is a first value; when the rudder neutral position sensor senses the rudder neutral position sensing piece, the feedback value output by the rudder neutral position sensor is a second value. The position of the rudder middle position sensor and the position of the rudder middle position sensing piece are adjusted and set, so that the rudder middle position sensor can sense the rudder middle position sensing piece when the rudder angle middle position state is detected (namely, the rudder angle is in the preset middle position range), and the rudder middle position sensor cannot sense the rudder middle position sensing piece when the rudder angle is not in the middle position state (namely, the rudder angle is out of the middle position range), so that the rudder middle position sensor can detect whether the rudder angle is in the middle position range or not.
In some embodiments, referring to fig. 2, fig. 2 shows an example of the installation positions of the rudder neutral position sensor and the rudder neutral position sensing piece in the ship. The following is shown in this fig. 2:
in the state that the rudder angle returns to the middle position, the distance 201 between the rudder middle position sensor and the rudder middle position induction sheet records the numerical value of the distance as A;
an effective induced width range 202 of the rudder neutral position induction sheet, and the width value of the width range is recorded as B;
the effective sensing width range 203 of the rudder neutral position sensor, and the width value of the width range is recorded as C;
a rudder connecting rod 206 for connecting a structural member of the left stern machine 204 and the right stern machine 205, the rudder connecting rod 206, the left stern machine 204 and the right stern machine 205 moving simultaneously when the rudder is turned, the rudder connecting rod 206 moving rightward when the left rudder is turned, and the rudder connecting rod 206 moving leftward when the right rudder is turned;
a rudder neutral position sensing piece 207 which can be fixed at the rudder connecting rod 206;
the rudder neutral sensor 208 may be fixed at the hull 209 of the vessel.
For example only, the rudder neutral position sensor may use a non-contact sensor (e.g., a hall sensor), or may use a contact sensor (e.g., a flexible contact switch), and only if the sensing range of the rudder neutral position sensor overlaps with the sensed range of the rudder neutral position sensing piece (or the sensed object) in a preset direction, the rudder neutral position sensor may be triggered to output a second value as the feedback value, where the preset direction is: in a direction parallel to the central axis of the hull of the vessel. The (sensed) range in the preset direction can be understood as a (sensed) width range, as shown in fig. 2: the sensing range of the rudder center sensor is overlapped with the sensed range of the rudder center sensing piece (or sensed object) in the preset direction, and what is actually meant is that the effective sensing width range of the rudder center sensor is overlapped with the effective sensed width range of the rudder center sensing piece (sensed object).
It can be understood that the sensing range of the rudder neutral position sensor and the sensed range of the rudder neutral position sensing piece (or sensed object) can be adjusted. Different types of sensors can be adopted according to the requirements of specific use scenes of the unmanned equipment, and different types of objects can be adopted as rudder neutral position sensing pieces (or sensed objects). The sensing range of the rudder center position sensor and the sensed range of the rudder center position sensing piece (or sensed object) are not limited herein.
Taking fig. 2 as an example, as can be seen from fig. 2, in this mounting manner, as long as the effective sensing width range of the rudder neutral position sensor overlaps with the effective sensed width range of the rudder neutral position sensing piece (sensed object), it is considered that the rudder neutral position sensor is in the rudder neutral position state, and the rudder neutral position sensor can be triggered to output the second value; therefore, the triggering range of the rudder neutral position sensor is 2B + C, which can improve the robustness of the system, namely: the trigger condition of the position sensor in the rudder is changed from one point to a small distance (2B + C) to buffer the instability caused by the feedback transmission delay of the system signal. By way of example only, for ease of understanding, the following scenarios may be envisioned:
it is assumed that the rudder angle gradually decreases from 10 ° during the rudder angle return neutral. At time T0, the rudder angle is reduced to 3 °, and the relative position of the rudder center sensor and the rudder center sensor strip matches the triggering range of the rudder center sensor, so that the rudder center sensor can be triggered to output the second value. The rudder angle control box realizes the operation of stopping the rudder operation by the stop signal based on the second value. Since there is still a certain delay in the transmission of the stop signal, which results in that the rudder turning is actually stopped at the time T1, the rudder turning operation is still continuously performed during the period from the time T0 to the time T1, which may make the rudder angle at the time T1 smaller than the rudder angle at the time T0, that is, the rudder angle at the time T1 is closer to the neutral position.
It can be understood that if the rudder neutral sensor uses a non-contact sensor, a > 0; if the rudder center position sensor is a contact sensor, a is 0, and it should be noted that the rudder center position sensor piece may be a retractable elastic piece that can be retracted by contact with the rudder center position sensor when the rudder angle returns to the center position.
Please refer to fig. 3 and 4. Fig. 3 shows an example of the movement of the rudder linkage and the stern machine when the ship steers the left rudder; fig. 4 shows an example of the movement of the rudder linkage and the stern machine when the ship steers the right rudder. It can be seen that the ship steers left/right by driving the stern engine to swing left/right, specifically: when the ship steers the left rudder, the bow rotates leftwards, and the stern rotates rightwards; when the ship drives the right rudder, the bow rotates rightwards, and the stern rotates leftwards.
Of course, the positions of the rudder middle position sensing piece and the rudder middle position sensor can also be turned, namely the rudder middle position sensing piece is fixed on the ship body, and the rudder middle position sensor is fixed on the rudder connecting rod.
In some embodiments, the rudder neutral position sensor can also output a feedback value thereof to the main control, so that the main control can also know whether the current rudder angle returns to the neutral position in time. When the master control determines that the current rudder angle has returned to the neutral position based on the received feedback value, the master control may stop sending the rudder angle neutral control instruction to the rudder angle control box.
In some embodiments, a general control method may also be proposed based on similar ideas as the rudder angle control method proposed above. The control method has strong flexibility, can be applied to a universal control box of various control devices, and the universal control box can be used for controlling components of the corresponding control devices to execute circular motion or reciprocating motion; the control method comprises the following steps: when a driving instruction for a specified position is received, acquiring a general feedback value output by a specified position sensor; if the general feedback value is a preset third value, controlling the component to move to the specified position based on the driving instruction; and if the general feedback value is a preset fourth value, stopping controlling the component. It will be appreciated that the third value may be set by a previous commissioning of the position-specific sensor to: the value output by the specified position sensor when the component is not at the specified position; setting the fourth value to: the value output by the specified position sensor when the component is at the specified position.
For example only, the control device may be a general driving device (i.e., a driving device depending on the operation of the driver), an unmanned device, a robot, or the like, and is not limited herein.
Therefore, in the embodiment of the application, a new assembly, namely the rudder neutral position sensor, is added to the unmanned device, and the rudder angle control box does not judge whether the current rudder angle returns to the neutral position based on the output of the rudder angle sensor any more, but judges whether the current rudder angle returns to the neutral position based on the output of the rudder neutral position sensor. Specifically, after the rudder angle control box receives a rudder angle neutral control instruction, a feedback value output by a rudder neutral sensor may be acquired first, if the feedback value is a preset first value, steering is performed based on the rudder angle neutral control instruction, and if the feedback value is a preset second value, steering is stopped. Through the process, the pilotless device can eliminate rudder neutral oscillation caused by rudder angle delay caused by the structure to a certain extent.
Corresponding to the rudder angle control method provided above, the embodiment of the present application further provides a rudder angle control device. The rudder angle control device is applied to a rudder angle control box of unmanned equipment. As shown in fig. 5, the rudder angle control device 500 in the embodiment of the present application includes:
the first obtaining module 501 is configured to obtain a feedback value output by a rudder neutral sensor after receiving a rudder angle neutral control instruction;
a first control module 502, configured to steer based on the steering angle neutral control instruction if the feedback value is a preset first value;
and a second control module 503, configured to stop steering if the feedback value is a preset second value.
Optionally, the rudder angle control device 500 further includes:
the detection module is used for detecting the navigation mode of the unmanned equipment;
accordingly, the first obtaining module 501 is specifically configured to, if the unmanned aerial vehicle is in the unmanned mode, obtain a feedback value output by the rudder neutral position sensor after receiving the rudder angle neutral position control instruction.
Optionally, the rudder neutral position sensor is configured to sense a signal emitted by a sensed object; when the signal intensity of the signal sensed by the rudder neutral position sensor is lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a first value; when the signal intensity of the signal sensed by the rudder neutral position sensor is not lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a second value;
or the rudder neutral position sensor is used for sensing the distance between the sensed object and the rudder neutral position sensor; when the distance sensed by the rudder neutral position sensor is out of a preset distance range, the feedback value output by the rudder neutral position sensor is a first value; and when the distance sensed by the rudder neutral position sensor is within the preset distance range, the feedback value output by the rudder neutral position sensor is a second value.
Optionally, the rudder neutral position sensor is used for sensing a rudder neutral position sensing piece; when the rudder center sensor does not sense the rudder center sensing piece, the feedback value output by the rudder center sensor is a first value; when the rudder neutral position sensor senses the rudder neutral position sensing piece, the feedback value output by the rudder neutral position sensor is a second value.
Optionally, the unmanned device is a ship; the rudder neutral position sensor is fixed to a rudder link of the ship, and the rudder neutral position sensor is fixed to a hull of the ship; alternatively, the rudder neutral position sensor may be fixed to the hull, and the rudder neutral position sensor may be fixed to the rudder link.
Optionally, in the rudder angle neutral position state, the sensing range of the rudder neutral position sensor overlaps with the sensed range of the sensed object in a preset direction, or, in the rudder angle neutral position state, the sensing range of the rudder neutral position sensor overlaps with the sensed range of the rudder neutral position sensing strip in the preset direction, where the overlapping range is settable, and the preset direction is: a direction parallel to the central axis of the hull of said vessel.
Optionally, the rudder angle neutral control instruction includes a left rudder hitting neutral control instruction and a right rudder hitting neutral control instruction; the first control module 502 is specifically configured to steer leftward if the rudder angle neutral control instruction is a left steering neutral control instruction and steer rightward if the rudder angle neutral control instruction is a right steering neutral control instruction when the feedback value is a preset first value.
Therefore, in the embodiment of the application, a new assembly of the rudder neutral position sensor is added into the unmanned equipment, and the rudder angle control box does not judge whether the current rudder angle returns to the neutral position based on the output of the rudder angle sensor any more, but judges whether the current rudder angle returns to the neutral position based on the output of the rudder neutral position sensor. Specifically, after the rudder angle control box receives a rudder angle neutral control instruction, a feedback value output by a rudder neutral sensor may be acquired first, if the feedback value is a preset first value, steering is performed based on the rudder angle neutral control instruction, and if the feedback value is a preset second value, steering is stopped. Through the process, the pilotless device can eliminate rudder neutral oscillation caused by rudder angle delay caused by the structure to a certain extent.
Corresponding to the rudder angle control method provided by the above, the embodiment of the application also provides a rudder angle control box, and the rudder angle control box is integrated in the unmanned equipment; referring to fig. 6, the unmanned control box 6 in the embodiment of the present application includes: a memory 601, one or more processors 602 (only one shown in fig. 6), and computer programs stored on the memory 601 and executable on the processors. Wherein: the memory 601 is used for storing software programs and units, and the processor 602 executes various functional applications and data processing by running the software programs and units stored in the memory 601 so as to acquire resources corresponding to preset events. Specifically, the processor 602 implements the following steps by running the above-mentioned computer program stored in the memory 601:
after a rudder angle neutral control instruction is received, acquiring a feedback value output by a rudder neutral sensor;
if the feedback value is a preset first value, steering is carried out based on the steering angle neutral control instruction;
and if the feedback value is a preset second value, stopping steering.
Assuming that the above is the first possible embodiment, in a second possible embodiment provided on the basis of the first possible embodiment, before acquiring the feedback value output by the rudder neutral sensor after receiving the rudder angle neutral control command, the processor 602 further performs the following steps by running the computer program stored in the memory 601:
detecting a navigation mode of the unmanned equipment;
correspondingly, the obtaining of the feedback value output by the rudder neutral position sensor after receiving the rudder angle neutral position control command includes:
and if the unmanned equipment is in the unmanned mode, acquiring a feedback value output by a rudder neutral sensor after receiving a rudder angle neutral control instruction.
In a third possible embodiment based on the first possible embodiment, the rudder neutral position sensor is configured to sense a signal emitted by a sensed object; when the signal intensity of the signal sensed by the rudder neutral position sensor is lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a first value; when the signal intensity of the signal sensed by the rudder neutral position sensor is not lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a second value;
or the rudder neutral position sensor is used for sensing the distance between the sensed object and the rudder neutral position sensor; when the distance sensed by the rudder neutral position sensor is out of a preset distance range, the feedback value output by the rudder neutral position sensor is a first value; and when the distance sensed by the rudder neutral position sensor is within the preset distance range, the feedback value output by the rudder neutral position sensor is a second value.
In a fourth possible embodiment based on the first possible embodiment, the rudder neutral position sensor is configured to sense a rudder neutral position sensing piece; when the rudder center sensor does not sense the rudder center sensing piece, the feedback value output by the rudder center sensor is a first value; when the rudder neutral position sensor senses the rudder neutral position sensing piece, the feedback value output by the rudder neutral position sensor is a second value.
In a fifth possible embodiment provided on the basis of the four possible embodiments, the unmanned aerial vehicle is a ship; the rudder neutral position sensor is fixed to a rudder link of the ship, and the rudder neutral position sensor is fixed to a hull of the ship; alternatively, the rudder neutral position sensor may be fixed to the hull, and the rudder neutral position sensor may be fixed to the rudder link.
In a sixth possible embodiment based on the three possible embodiments or the four possible embodiments, in the rudder angle neutral state, a sensing range of the rudder neutral position sensor and a sensed range of the sensed object overlap in a preset direction, or in the rudder angle neutral state, the sensing range of the rudder neutral position sensor and the sensed range of the rudder neutral position sensing piece overlap in a preset direction, where an overlap range may be set, and the preset direction is: a direction parallel to the central axis of the hull of said vessel.
In a seventh possible embodiment based on the one possible embodiment, the rudder angle neutral control command includes a left steering neutral control command and a right steering neutral control command; the steering based on the steering angle neutral position control command comprises:
if the steering angle middle position control instruction is a left steering middle position control instruction, steering to the left;
and if the steering angle middle position control instruction is a right steering middle position control instruction, steering to the right.
It should be understood that in the embodiments of the present Application, the Processor 602 may be a Central Processing Unit (CPU), and the Processor may be other general-purpose processors, Digital Signal Processors (DSPs), Application Specific Integrated Circuits (ASICs), Field-Programmable Gate arrays (FPGAs) or other Programmable logic devices, discrete Gate or transistor logic devices, discrete hardware components, or the like. A general purpose processor may be a microprocessor, or may be any conventional processor or the like.
Therefore, in the embodiment of the application, a new assembly, namely the rudder neutral position sensor, is added to the unmanned device, and the rudder angle control box does not judge whether the current rudder angle returns to the neutral position based on the output of the rudder angle sensor any more, but judges whether the current rudder angle returns to the neutral position based on the output of the rudder neutral position sensor. Specifically, after the rudder angle control box receives a rudder angle neutral control instruction, a feedback value output by a rudder neutral sensor may be acquired first, if the feedback value is a preset first value, steering is performed based on the rudder angle neutral control instruction, and if the feedback value is a preset second value, steering is stopped. Through the process, the pilotless device can eliminate rudder neutral oscillation caused by rudder angle delay caused by the structure to a certain extent.
It will be apparent to those skilled in the art that, for convenience and brevity of description, only the above-mentioned division of the functional units and modules is illustrated, and in practical applications, the above-mentioned functions may be distributed as different functional units and modules according to needs, that is, the internal structure of the apparatus may be divided into different functional units or modules to implement all or part of the above-mentioned functions. Each functional unit and module in the embodiments may be integrated in one processing unit, or each unit may exist alone physically, or two or more units are integrated in one unit, and the integrated unit may be implemented in a form of hardware, or in a form of software functional unit. In addition, specific names of the functional units and modules are only for convenience of distinguishing from each other, and are not used for limiting the protection scope of the present application. The specific working processes of the units and modules in the system may refer to the corresponding processes in the foregoing method embodiments, and are not described herein again.
In the above embodiments, the descriptions of the respective embodiments have respective emphasis, and reference may be made to the related descriptions of other embodiments for parts that are not described or illustrated in a certain embodiment.
Those of ordinary skill in the art would appreciate that the various illustrative elements and algorithm steps described in connection with the embodiments disclosed herein may be implemented as electronic hardware or combinations of external device software and electronic hardware. Whether such functionality is implemented as hardware or software depends upon the particular application and design constraints imposed on the implementation. Skilled artisans may implement the described functionality in varying ways for each particular application, but such implementation decisions should not be interpreted as causing a departure from the scope of the present application.
In the embodiments provided in the present application, it should be understood that the disclosed apparatus and method may be implemented in other ways. For example, the above-described system embodiments are merely illustrative, and for example, the division of the above-described modules or units is only one logical functional division, and in actual implementation, there may be another division, for example, multiple units or components may be combined or integrated into another system, or some features may be omitted, or not executed. In addition, the shown or discussed mutual coupling or direct coupling or communication connection may be an indirect coupling or communication connection through some interfaces, devices or units, and may be in an electrical, mechanical or other form.
The units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one place, or may be distributed on a plurality of network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment.
The integrated unit may be stored in a computer-readable storage medium if it is implemented in the form of a software functional unit and sold or used as a separate product. Based on such understanding, all or part of the flow in the method of the embodiments described above can be realized by a computer program, which can be stored in a computer-readable storage medium and can realize the steps of the embodiments of the methods described above when the computer program is executed by a processor. The computer program includes computer program code, and the computer program code may be in a source code form, an object code form, an executable file or some intermediate form. The computer-readable storage medium may include: any entity or device capable of carrying the above-mentioned computer program code, recording medium, usb disk, removable hard disk, magnetic disk, optical disk, computer readable memory, Read-only memory (ROM, Read-Onl8 memory 8), Random Access Memory (RAM), electrical carrier signal, telecommunications signal, software distribution medium, etc. It should be noted that the computer readable storage medium may contain content that is subject to appropriate increase or decrease according to the requirements of legislation and patent practice in jurisdictions, for example, in some jurisdictions, computer readable storage media does not include electrical carrier signals and telecommunication signals according to legislation and patent practice.
The above embodiments are only used to illustrate the technical solutions of the present application, and not to limit the same; although the present application has been described in detail with reference to the foregoing embodiments, it should be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; such modifications and substitutions do not substantially depart from the spirit and scope of the embodiments of the present application and are intended to be included within the scope of the present application.
Claims (11)
1. A rudder angle control method applied to a rudder angle control box of an unmanned aerial vehicle, comprising:
after a rudder angle neutral control instruction is received, acquiring a feedback value output by a rudder neutral sensor;
if the feedback value is a preset first value, steering is carried out based on the steering angle neutral control instruction;
and if the feedback value is a preset second value, stopping steering.
2. A rudder angle controlling method according to claim 1, wherein before the feedback value output from the rudder neutral sensor is acquired after the rudder angle neutral control command is received, the rudder angle controlling method includes:
detecting a navigation mode in which the unmanned equipment is located;
correspondingly, after receiving the rudder angle neutral position control instruction, acquiring a feedback value output by the rudder neutral position sensor, including:
and if the unmanned equipment is in an unmanned mode, acquiring a feedback value output by a rudder neutral sensor after receiving a rudder angle neutral control instruction.
3. A rudder angle controlling method as claimed in claim 1, wherein the rudder neutral position sensor is adapted to sense a signal emitted from a sensed object; when the signal intensity of the signal sensed by the rudder neutral position sensor is lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a first value; when the signal intensity of the signal sensed by the rudder neutral position sensor is not lower than the preset intensity, the feedback value output by the rudder neutral position sensor is a second value;
or the rudder neutral position sensor is used for sensing the distance between the sensed object and the rudder neutral position sensor; when the distance sensed by the rudder center sensor is out of a preset distance range, a feedback value output by the rudder center sensor is a first value; and when the distance sensed by the rudder neutral position sensor is within the preset distance range, the feedback value output by the rudder neutral position sensor is a second value.
4. The rudder angle controlling method according to claim 1, wherein the rudder neutral sensor is used for sensing a rudder neutral sensing strip; when the rudder center sensor does not sense the rudder center sensing piece, the feedback value output by the rudder center sensor is a first value; when the rudder middle position sensor senses the rudder middle position sensing piece, the feedback value output by the rudder middle position sensor is a second value.
5. Rudder angle controlling method according to claim 4, characterised in that the unmanned aerial vehicle is a ship; the rudder middle position sensing piece is fixed on a rudder connecting rod of the ship, and the rudder middle position sensor is fixed on a ship body of the ship; or the rudder middle position sensing piece is fixed on the ship body, and the rudder middle position sensor is fixed on the rudder connecting rod.
6. A rudder angle controlling method according to claim 3 or 4, wherein in a rudder angle neutral state, the sensing range of the rudder neutral sensor and the sensed range of the sensed object overlap in a preset direction, or in a rudder angle neutral state, the sensing range of the rudder neutral sensor and the sensed range of the rudder neutral sensor overlap in a preset direction, wherein the overlapping range is settable, and the preset direction is: in a direction parallel to the central axis of the hull of the vessel.
7. The rudder angle controlling method according to claim 1, wherein the rudder angle neutral control command includes a left rudder turn neutral control command and a right rudder turn neutral control command; the steering based on the steering angle neutral position control instruction comprises:
if the steering angle middle position control instruction is a left steering middle position control instruction, steering to the left;
and if the steering angle middle position control instruction is a right steering middle position control instruction, steering to the right.
8. A control method, characterized in that it is applied to a universal control box of a control device for controlling components to perform a circular or reciprocating motion; the control method comprises the following steps:
when a driving instruction for a specified position is received, acquiring a general feedback value output by a specified position sensor;
if the general feedback value is a preset third value, controlling the component to move to the specified position based on the driving instruction;
and if the general feedback value is a preset fourth value, stopping controlling the component.
9. A rudder angle controlling device applied to a rudder angle controlling box of an unmanned aerial vehicle, comprising:
the first acquisition module is used for acquiring a feedback value output by the rudder neutral sensor after receiving a rudder angle neutral control instruction;
the first control module is used for steering based on the steering angle neutral control instruction if the feedback value is a preset first value;
and the second control module is used for stopping steering if the feedback value is a preset second value.
10. Rudder angle control box comprising a memory, a processor and a computer program stored in the memory and executable on the processor, characterized in that the processor realizes the method according to any of the claims 1 to 7 when executing the computer program.
11. A computer-readable storage medium, in which a computer program is stored which, when being executed by a processor, carries out the method according to any one of claims 1 to 8.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110886901.5A CN113665776B (en) | 2021-08-03 | 2021-08-03 | Rudder angle control method, rudder angle control device and rudder angle control box |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110886901.5A CN113665776B (en) | 2021-08-03 | 2021-08-03 | Rudder angle control method, rudder angle control device and rudder angle control box |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113665776A true CN113665776A (en) | 2021-11-19 |
CN113665776B CN113665776B (en) | 2022-10-11 |
Family
ID=78541244
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110886901.5A Active CN113665776B (en) | 2021-08-03 | 2021-08-03 | Rudder angle control method, rudder angle control device and rudder angle control box |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113665776B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114455051A (en) * | 2022-01-06 | 2022-05-10 | 珠海云洲智能科技股份有限公司 | Unmanned equipment control method and device and unmanned equipment |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6038290A (en) * | 1983-08-11 | 1985-02-27 | Mitsubishi Electric Corp | Autopilot device for sailing ship |
CN101881970A (en) * | 2010-06-04 | 2010-11-10 | 哈尔滨工程大学 | Twin-rudder synchronization control method of ship |
CN102530223A (en) * | 2010-12-31 | 2012-07-04 | 上海宏曲电子科技有限公司 | Passive direct laser rudder angular position sending device |
KR20140055088A (en) * | 2012-10-30 | 2014-05-09 | 대우조선해양 주식회사 | Apparatus to control rudder angle for ship |
CN104703876A (en) * | 2012-10-11 | 2015-06-10 | 铃木株式会社 | System for controlling ship, method for controlling ship, and program |
CN106774341A (en) * | 2017-01-20 | 2017-05-31 | 四方继保(武汉)软件有限公司 | Unmanned boat kinetic control system and motion control method |
CN109375620A (en) * | 2018-10-12 | 2019-02-22 | 深圳市今天国际智能机器人有限公司 | The method and device of origin is returned using single photoelectric sensor control steering wheel |
CN111352341A (en) * | 2020-03-18 | 2020-06-30 | 上海海事大学 | Ship navigation control online self-adaptive adjustment system and method |
CN111559488A (en) * | 2020-05-25 | 2020-08-21 | 智慧航海(青岛)科技有限公司 | Intelligent ship rudder equipment automatic control method and system |
KR102228594B1 (en) * | 2019-09-06 | 2021-03-16 | 엘아이지넥스원 주식회사 | Method and device for adjusting zero point of underwater vehicle rudder |
CN112650112A (en) * | 2020-12-18 | 2021-04-13 | 湖南金翎箭信息技术有限公司 | Steering engine control method |
CN113184156A (en) * | 2020-01-28 | 2021-07-30 | 纳博特斯克有限公司 | Control device, ship, calculation device and system, and interference data collection system |
-
2021
- 2021-08-03 CN CN202110886901.5A patent/CN113665776B/en active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6038290A (en) * | 1983-08-11 | 1985-02-27 | Mitsubishi Electric Corp | Autopilot device for sailing ship |
CN101881970A (en) * | 2010-06-04 | 2010-11-10 | 哈尔滨工程大学 | Twin-rudder synchronization control method of ship |
CN102530223A (en) * | 2010-12-31 | 2012-07-04 | 上海宏曲电子科技有限公司 | Passive direct laser rudder angular position sending device |
CN104703876A (en) * | 2012-10-11 | 2015-06-10 | 铃木株式会社 | System for controlling ship, method for controlling ship, and program |
KR20140055088A (en) * | 2012-10-30 | 2014-05-09 | 대우조선해양 주식회사 | Apparatus to control rudder angle for ship |
CN106774341A (en) * | 2017-01-20 | 2017-05-31 | 四方继保(武汉)软件有限公司 | Unmanned boat kinetic control system and motion control method |
CN109375620A (en) * | 2018-10-12 | 2019-02-22 | 深圳市今天国际智能机器人有限公司 | The method and device of origin is returned using single photoelectric sensor control steering wheel |
KR102228594B1 (en) * | 2019-09-06 | 2021-03-16 | 엘아이지넥스원 주식회사 | Method and device for adjusting zero point of underwater vehicle rudder |
CN113184156A (en) * | 2020-01-28 | 2021-07-30 | 纳博特斯克有限公司 | Control device, ship, calculation device and system, and interference data collection system |
CN111352341A (en) * | 2020-03-18 | 2020-06-30 | 上海海事大学 | Ship navigation control online self-adaptive adjustment system and method |
CN111559488A (en) * | 2020-05-25 | 2020-08-21 | 智慧航海(青岛)科技有限公司 | Intelligent ship rudder equipment automatic control method and system |
CN112650112A (en) * | 2020-12-18 | 2021-04-13 | 湖南金翎箭信息技术有限公司 | Steering engine control method |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114455051A (en) * | 2022-01-06 | 2022-05-10 | 珠海云洲智能科技股份有限公司 | Unmanned equipment control method and device and unmanned equipment |
CN114455051B (en) * | 2022-01-06 | 2023-07-25 | 珠海云洲智能科技股份有限公司 | Unmanned equipment control method and device and unmanned equipment |
Also Published As
Publication number | Publication date |
---|---|
CN113665776B (en) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3699888A1 (en) | Interaction method and apparatus between vehicles | |
CN106527439B (en) | Motion control method and device | |
CN113665776B (en) | Rudder angle control method, rudder angle control device and rudder angle control box | |
US11532230B2 (en) | System, method and apparatus for position-based parking of vehicle | |
CN109703616B (en) | Automatic driving angle control method, electronic device, and storage medium | |
US20210078690A1 (en) | Hull control device, hull controlling method, and hull control program | |
US10081387B2 (en) | Non-autonomous steering modes | |
CN109204315A (en) | Method, apparatus, storage medium and the electronic equipment of changing Lane | |
JP2944408B2 (en) | Control device and control method for moving object mounted antenna | |
CN118205547A (en) | Driving support device and driving support method | |
JP7241082B2 (en) | Ship operation support system, ship control device, ship control method, and program | |
CN115431980A (en) | Automatic vehicle driving method, device, equipment and medium | |
JP2020523603A (en) | Sensor device for automated vehicles | |
US20230249675A1 (en) | Method for ascertaining a replacement trajectory, computer program product, parking assistance system and vehicle | |
US20200307625A1 (en) | Automated driving system | |
KR102509852B1 (en) | Control device and method | |
KR102072357B1 (en) | Apparatus and method for controlling alarm of vehicle | |
US12043322B2 (en) | Steering control system, steering control device, and steering control method | |
US11846939B2 (en) | Mobile vehicle, control method of mobile vehicle, and path control system of mobile vehicle | |
CN112633124B (en) | Target vehicle judging method of automatic driving vehicle and electronic equipment | |
CN115848404A (en) | Articulated vehicle control method and articulated vehicle | |
JP2019202642A (en) | Travel control device for vehicle | |
JP6620962B2 (en) | Parking assistance device | |
JP2019147481A (en) | Parking support device | |
JP2020111305A (en) | Parking assistance device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |