SYSTEM AND METHOD FOR POSITIONING A MARINE VESSEL
20190084662 ยท 2019-03-21
Inventors
- Ray Tat Lung Wong (Richmond, CA)
- Pierre GARON (Trois-Riviers, CA)
- Geoffrey David DUDDRINGE (Nanaimo, CA)
Cpc classification
G05D1/027
PHYSICS
B63H2020/003
PERFORMING OPERATIONS; TRANSPORTING
B63H25/42
PERFORMING OPERATIONS; TRANSPORTING
B63H25/04
PERFORMING OPERATIONS; TRANSPORTING
B63H2025/045
PERFORMING OPERATIONS; TRANSPORTING
International classification
B63H25/42
PERFORMING OPERATIONS; TRANSPORTING
B63H25/04
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A marine vessel control system comprises a propulsion unit and a steering actuator for steering the propulsion unit. There is a shift actuator for shifting gears in the propulsion unit and a throttle actuator for increasing or decreasing throttle to the propulsion unit. There is an input device for providing user inputted steering commands to the steering actuator and for providing user inputted shift and throttle commands to the shift actuator and the throttle actuator. There is a sensor for detecting a global position and a heading direction of the marine vessel. A controller receives position and heading values of the marine vessel from the sensor. The controller compares the received position value to a pre-programmed position value to determine a position error difference. The controller also compares the received heading value to a pre-programmed heading value to determine a heading error difference.
Claims
1. (canceled)
2. (canceled)
3. (canceled)
4. (canceled)
5. (canceled)
6. (canceled)
7. (canceled)
8. (canceled)
9. (canceled)
10. (canceled)
11. (canceled)
12. (canceled)
13. (canceled)
14. (canceled)
15. (canceled)
16. (canceled)
17. (canceled)
18. (canceled)
19. (canceled)
20. (canceled)
21. (canceled)
22. (canceled)
23. (canceled)
24. (canceled)
25. (canceled)
26. A method for maintaining a heading of a marine vessel using a rear mounted propulsion unit, the method comprising: setting a heading to a target heading of the marine vessel; determining a current heading of the marine vessel; calculating a heading error difference between the target heading of the marine vessel and the current heading of the marine vessel, the heading error difference resulting from a disturbance being applied to the marine vessel; generating a thrust using the rear mounted propulsion unit to rotate the marine vessel to minimize the heading error difference; and allowing a position of the marine vessel to move along a course, while maintaining the heading of the marine vessel, by setting an angle of the target heading differently from an angle of the course.
27. The method as claimed in claim 26 wherein setting the angle of the target heading differently from the angle of the course includes setting the angle of the target heading independently from the angle of the course.
28. The method as claimed in claim 26 wherein generating the thrust using the rear mounted propulsion unit includes generating the thrust using a single rear mounted propulsion unit.
29. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes allowing the marine vessel to drift naturally as a result of the disturbance acting on the marine vessel.
30. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes allowing the marine vessel to move along the course through a waypoint.
31. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes allowing the marine vessel to move along the course through waypoints.
32. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes allowing the marine vessel to move along the course over ground.
33. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes allowing the marine vessel to drift naturally as a result of the disturbance acting on the marine vessel while allowing the marine vessel to move along the course through waypoints.
34. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes allowing the marine vessel to drift naturally as a result of the disturbance acting on the marine vessel while controlling a speed of the marine vessel.
35. The method as claimed in claim 26 wherein allowing the position of the marine vessel to move along the course includes controlling a speed of the marine vessel as the marine vessel moves along the course.
36. The method as claimed in claim 26 wherein setting the heading to the target heading includes setting incremental target headings.
37. A marine vessel having a marine control system, the marine control system comprising: a rear mounted propulsion unit and a steering actuator for steering the rear mounted propulsion unit; a shift actuator for shifting gears in the propulsion unit and a throttle actuator for increasing or decreasing throttle to the propulsion unit; an input device for providing user inputted steering commands to the steering actuator and for providing user inputted shift and throttle commands to the shift actuator and the throttle actuator; a heading control for setting a target heading of the marine vessel; a sensor for detecting a current heading direction of the marine vessel; and a controller which receives the target heading of the marine vessel from the heading control and the current heading of the marine vessel from the sensor, the controller calculating a heading error difference between the target heading of the marine vessel and the current heading of the marine vessel which results from a disturbance being applied to the marine vessel, and the controller signaling the rear mounted propulsion unit to generate a thrust to rotate the marine vessel to minimize the heading error difference, wherein a position of the marine vessel to move along a course, while maintaining the heading of the marine vessel, by setting an angle of the target heading differently from an angle of the course.
38. The marine control system as claimed in claim 37, wherein the controller actuates the shift actuator and the throttle actuator in a presence of a heading error difference so that the rear mounted propulsion unit provides a counteracting thrust to minimize the heading error difference.
39. The marine control system as claimed in claim 38, wherein the controller a detects a direction of the disturbance causing the heading error difference, and the controller actuating the steering actuator to steer the rear mounted propulsion unit such that the counteracting thrust of the rear mounted propulsion unit is opposite in direction to the disturbance.
40. The marine control system as claimed in claim 38, wherein the counteracting thrust of the propulsion unit of the rear mounted propulsion unit is equal in magnitude to the force of the disturbance.
41. The marine control system as claimed in claim 37, wherein the controller actuates the shift actuator and the throttle actuator in a presence of a heading error difference so that the rear mounted propulsion unit provides counteracting thrusts to minimize the heading error difference.
42. The marine control system as claimed in claim 41, wherein the controller a detects a direction of the disturbance causing the heading error difference, and the controller actuating the steering actuator to steer the rear mounted propulsion unit such that the counteracting thrusts of the rear mounted propulsion unit are opposite in direction to the disturbance.
43. The marine control system as claimed in claim 41, wherein the counteracting thrusts of the propulsion unit are equal in magnitude to the force of the disturbance.
44. The marine control system as claimed in claim 37, wherein the controller automatically actuates the steering actuator in a presence of a heading error difference to steer the rear mounted propulsion unit to minimize the heading error difference.
45. The marine control system as claimed in claim 37 wherein the controller sets the angle of the target heading differently from the angle of the course by setting the angle of the target heading independently from the angle of the course.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0015] The invention will be more readily understood from the following description of the embodiments thereof given, by way of example only, with reference to the accompanying drawings, in which:
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
DESCRIPTION OF SPECIFIC EMBODIMENTS
[0032] Referring to the drawings and first to
[0033] When the marine vessel 10 is steered using the joystick 24, and with reference to
[0034] It may be desired to maintain a position of the marine vessel 10 relative to a reference point such as a buoy, an underwater wreck or reef, a shoreline, another vessel or a dock. Unless there is no disturbance, i.e. external interruption from the environment such as a current and/or a wind, maintaining the position (station keeping) without an anchor normally requires active control of the marine vessel. Manual station keeping may be achieved by an operator observing movement of the marine vessel 10 relative to the reference point and using the joystick 24 to steer the marine vessel to counteract the disturbance in order to hold the position of the marine vessel. However, there may be a limited number of operators aboard the marine vessel. In order to maximize time on the water and to allow the operator(s) to catch as many fish as possible, it may be desirable to automatically maintain the position of the marine vessel.
[0035] In an automatic station keeping system, the operator is replaced with electronic sensors which measure the movement of the marine vessel and control algorithms which calculate appropriate counteracting port and starboard engine thrusts in order to maintain the position of the marine vessel. The electronic sensors may include a Global Positioning System (GPS) receiver for measuring the absolute position of the marine vessel, an accelerometer for measuring the attitude (pitch and roll) of the marine vessel, a gyroscope for measuring the horizontal rate of turn of the marine vessel and/or a magnetometer for determining a heading direction of the marine vessel. These sensors are used in combination to define a compensated global position and a compensated heading direction of the marine vessel. An inertia measurement unit may also be used to provide compensated heading information.
[0036] In this example, the marine vessel 10 includes an electronic sensor in the form of a GPS compass 32 as shown in
[0037] The ASK controller 34 uses three proportional-integral-derivative (PID) controllers to maintain the position of the marine vessel 10. The three PID controllers correspond to the three axes of movement: X-axis, Y-axis and ?-axis. Each PID controller has different sets of gains depending on the operation zone. The ASK controller 34 is further provided with software having an algorithm for maintaining a position and a heading of the marine vessel 10.
[0038] As shown in
[0039] The best heading command refers to the heading command which provides the best engine efficiency and best heading stability. In one instance, the best heading command may be set to a steady state thrust angle (?.sub.ss) which is the vector sum of the integral term of the X-axis PID controller and the integral term of the Y-axis PID controller. In order to ensure that the integral terms of the X-axis and Y-axis PID controllers continue to point towards the steady state disturbance, the X-axis and Y-axis PID controllers are rotated as the heading of the marine vessel changes. This restricts movement of the marine vessel away from the target position as the marine vessel rotates.
[0040]
[0041]
[0042] In the examples shown in
[0043] Furthermore, when the heading 38 of the marine vessel 10 is facing against the direction of the disturbance 36, as shown in
[0044] In contrast, when the disturbance 36 is acting on a side, for example, a starboard side 40 of the marine vessel 10 as shown in
[0045] However, there are instances where the disturbance angle may change. Referring now to
[0046] However, instead of waiting for the position error to accumulate over time, a rotation can be applied to the integral term vector.sub.1 with the same amplitude to become the new heading command ?.sub.cmd2. The heading command ?.sub.cmd2 is equal to the disturbance angle ?.sub.2. Since the heading command ?.sub.cmd2, the disturbance angle ?.sub.2 and the thrust angle ?.sub.2 are equal to one another, with the engines 12 and 14 providing forward thrusts which are equal in magnitude and opposite in direction to the disturbance 36, the marine vessel 10 is maintained in the fixed target position even with a change in direction of the disturbance.
[0047] Referring now to
[0048] Traditional autopilot systems keep the marine vessel course (the intended path of vessel motion) in the forward direction without vector thrusting. The heading of the marine vessel is therefore dependent on the vessel course and on the angle of the disturbance. However, in the present invention, the heading of the marine vessel can be set independently of the marine vessel course.
[0049]
[0050] Referring now to
[0051] The station keeping system with a single propulsion unit as described above is significantly different than a traditional station keeping system with a trolling motor. The outboard engine 72 has a limited range of steering angle, such as +/?30? from a center steering position. The system presented in
[0052] Referring now to
[0053] Similarly, when the operator requests a specific heading command at t0, the heading momentary switch 107 takes a snapshot of the target heading ? (t0) 108. In the fixed target heading mode, the heading hold switch is switched to the ON position. The actual heading 110 is subtracted from this target heading ? (t0) 108 to calculate the heading ? error 111. This error is passed to the ? PID controller 112. The ? thrust command 113 is then sent to the heading hold switch 114. With the heading hold switch being ON, this ? thrust command 113 is sent to the automatic station keeping zone controller 103. In the automatic station keeping mode, the thrust commands 104 are selected by the joystick mode switch 105. These thrust commands 104 are sent to the motion controller 106 to control the shift, throttle and steering commands to each engine.
[0054] It is worth noting that, in the best heading mode, when the operator does not request a specific heading command, the heading hold switch is switched to the OFF position. The heading command 115 is still calculated as the vector angle of the X thrust command and the Y thrust command. This heading command is used for the close loop control instead.
[0055] In the case of a change in disturbance angle similar to the situation depicted in
[0056] Traditional PID controllers may use an input deadband based on error to avoid constantly outputting a command. This negatively impacts the continuity of the P, I and D terms. With this system, the P, I, and D terms are calculated regardless of the size of the position error 99 and the heading error 111. The P, I, D terms are continuous and responsive. Instead, programmable output dead-bands 116, 117 are used to eliminate those thrust commands not large enough to impose a motion to the vessel.
[0057] As best shown in
[0058] The control head 22 and the joystick 24 are both plugged into a second CAN network 86 that allows the control head 22 and the joystick 24 to communicate with a shift actuator 88 and a throttle actuator 90 of the port engine 12 as well as a shift actuator 92 and a throttle actuator 94 of the starboard engine 14. The shift and throttle actuators shift engine gears and increase or decrease engine throttle based on user inputted commands from either the control head 22 or the joystick 24 or both. Accordingly, the control head 22 and the joystick 24 may be used independently or together to control shift and throttle functions. It will be understood by a person skilled in the art that similar control schemes can be applied to marine vessels with more than two engines.
[0059] The GPS compass 32 and the ASK controller 34 are also plugged into the second CAN network 86 in this example. The GPS compass 32 provides position and heading information to the joystick 24 over the second CAN network 86. The joystick 24 in turn inputs steering and shift and throttle commands which are sent to the PCM 26 and the EST system over the CAN networks 80 and 86 as shown in
[0060] The automatic station keeping system disclosed herein has three main operating modes: position hold mode, heading hold mode, and position and heading hold mode. When the position hold mode is engaged, the system holds the position of the marine vessel while the heading of the marine vessel may change. When the heading hold mode is engage, the system holds the heading of the marine vessel while the position of the marine vessel is not controlled, allowing the marine vessel to drift freely with a current or a wind. When the position and heading hold mode is engaged, the system holds both the position and the heading of the marine vessel. If the marine vessel is not ideally aligned relative to a disturbance, such as a wind and/or a current, then position holding performance may be affected.
[0061] In the position hold mode with best heading enabled, the heading command (?.sub.cmd or (180?-?.sub.cmd)), is the angle of the vector of the X-axis thrust command and the Y-axis thrust command. This heading command will be used instead of an operator specified command ?.sub.t0. The selected ? command is used for close loop control with the actual heading feedback by the ?-axis PID controller. The output of the ?-axis PID controller is the ? thrust command (%). The theta thrust command (%) rotates the marine vessel so that the actual heading is equal to the heading command.
[0062] The control algorithms of the ASK controller 34 control secondary axes when using the joystick 24. During operation of the joystick 24 along the X-axis, the ASK controller 34 corrects unwanted rotational motion and forward or reverse motions. During operation of the joystick 24 along the Y-axis, the ASK controller 34 corrects unwanted rotational motion and lateral motion. During operation of the joystick 24 about the ?-axis, the ASK controller 34 corrects unwanted forward or reverse motion.
[0063] If the operator moves the joystick 24 while one of three operating modes is engaged, then the ASK controller 34 is temporarily disabled and the operator has full joystick control. When the joystick 24 returns to neutral, an acknowledgement prompt is displayed on a CANtrack display 31, shown in
[0064] The table below shows a list of faults that the joystick 24 can detect when the ASK controller 34 is enabled.
TABLE-US-00001 Fault detection and handling Fault display Type Trigger Recovery Description System status Instructions Warning PGN 129025 One PGN 12902 Joystick lost Station is disengaged. Monitor vessel surroundings. lost for 5 s received. communication Joystick is enabled. Manual vessel control is required. with GPS antenna. Warning PGN 129025 One PGN 129025 No GPS fix or Station is disengaged. Monitor vessel surroundings. longitude or received with data unstable. Joystick is enabled. Manual vessel control is required. latitude data valid longitude invalid for 5 s and latitude. OR AND Latitude or Latitude and Longitude Longitude yield yield SOG below SOG of 60 m/s 60 m/s for 1 s OR AND Latitude or Latitude and Longitude Longitude change do not change values for 5 s Warning PGN 127250 One PGN 127250 Joystick lost Station is disengaged. Monitor vessel surroundings. lost for 5 s received. communication Joystick is enabled. Manual vessel control is required. with heading sensor. Warning PGN 127250 One PGN 127250 No Heading fix Station is disengaged. Monitor vessel surroundings. heading data received with valid or data unstable. Joystick is enabled. Manual vessel control is required. invalid for 5 s heading data OR AND Heading does Heading changes not change value for 5 s Warning Position Position error <70% Significant Station is still engaged. Monitor vessel surroundings. error >12 m trigger threshold position Manual vessel control may be required. Note that the OR change detected. Adjusting/disabling heading hold may improve performance. threshold is exited Station configurable via Datalink with Engrprivs Warning Heading Heading error <60% Significant Station is still engaged. Monitor vessel surroundings. error >45? trigger threshold heading Manual vessel control may be required. Note that the OR change detected. Adjusting the heading may improve threshold is exited Station performance. configurable via Datalink with Engrprivs
[0065] It will be understood by a person skilled in the art that many of the details provided above are by way of example only, and are not intended to limit the scope of the invention which is to be determined with reference to the following claims.