SYSTEM AND METHOD FOR A MARINE VESSEL AUTOPILOT

• US 20120130570A1
• Filed: 11/14/2011
• Published: 05/24/2012
• Est. Priority Date: 11/24/2010
• Status: Active Grant

• Current Assignee: John F. Neyland Jr
• Original Assignee: William M Pease
• Inventors: PEASE, WILLIAM M.
• Granted Patent: US 8,265,812 B2
• Time in Patent Office: Days
• US Class Current: 701/21
• CPC Class Codes: B63H 25/04 automatic, e.g. reacting to compass
• CPC Class Codes: G05D 1/0206 specially adapted to water vehicles

Abstract

An autopilot system includes a navigation application for computing angular position and angular turn rate of a pilot line and an autopilot steering application for calculating steering commands for a ship steering device. The pilot line provides directional guidance to a ship and is a vector having one end attached to a point on the ship and a second end pointing to a desired direction. The autopilot steering application receives the computed pilot line angular position and angular turn rate and calculates angular position steering commands for the steering device. The steering commands are calculated by taking into account the difference between the pilot line angular position and the ship'"'"'s angular position and the difference between the pilot line angular turn rate and the ship'"'"'s angular turn rate.

Claims

1. An autopilot system comprising:

a navigation application for computing angular position and angular turn rate of a pilot line and wherein said pilot line provides directional guidance to a ship and comprises a vector having one end attached to a point on the ship and a second end pointing to a desired direction;

an autopilot steering application for calculating steering commands for a ship steering device wherein said autopilot steering application receives said computed pilot line angular position and angular turn rate and calculates angular position steering commands for said steering device; and

wherein said ship steering device steers the ship and is set according to the calculated steering commands to steer the ship so that the ship'"'"'s velocity vector lines up with the pilot line.

2. The system of claim 1, wherein said autopilot steering application calculates said steering commands by taking into account the difference between the pilot line angular position and the ship'"'"'s angular position and the difference between the pilot line angular turn rate and the ship'"'"'s angular turn rate.

3. The system of claim 1 wherein said autopilot steering application calculates steering commands according to equation:

RudCmd=K_max(P_c−

S_c)+K_vel(dP_c/dt−

dS_c/dt),

Wherein RudCmd is the steering command;

wherein P_c is the pilot line angular position, and S_c is the ship'"'"'s angular position;

wherein dP_c/dt is the pilot line angular turn rate, and dS_c/dt is the ship'"'"'s angular turn rate;

wherein Kmax is a constant having a value equal to the ratio of a maximum steering device angular turn rate to a maximum allowable ship angular turn rate; and

wherein Kvel is a constant having a value that causes the ship'"'"'s response to a pilot line angular turn rate input to be damped.

4. The system of claim 3, further comprising one or more motion sensors, and wherein said motion sensors provide input signals of ship'"'"'s angular position and turning rate and wherein said autopilot steering application calculates said steering commands for the steering device based on said sensor input signals.

5. The system of claim 4, wherein ship maneuvers are accomplished with the ship'"'"'s angular turn rate being equal or less than a set maximum ship angular turn rate value, and with the steering device angular turn rate being equal or less than a set maximum steering device angular turn rate value.

6. The system of claim 5, further comprising a computing system and wherein the computing system comprises a computing device, a database, said navigation application, and said autopilot steering application.

7. The system of claim 6, wherein said ship follows a voyage plan and said voyage plan comprises at least first and second waypoints connected via a track line and wherein said navigation application compares the ship'"'"'s current position with said first and second waypoint positions and determines offset of the ship'"'"'s current position from the track line, and angular direction of the track line and subsequently uses the determined offset of the ship'"'"'s current position from the track line, and angular direction of the track line to compute pilot line angular position and angular turn rate.

8. The system of claim 7, wherein each navigation maneuver comprises one or more successive segments and wherein the navigation application computes pilot line angular position and pilot line angular turn rate for each segment and provides the computed pilot line angular positions and pilot line angular turn rates to the autopilot steering application for each successive segment.

9. The system of claim 8, wherein at a transition instant between two adjacent segments the pilot line angular position and angular turn rate are changed and the ship'"'"'s position, ship'"'"'s angular turn rate and the steering device'"'"'s angular position do not change.

10. The system of claim 4, wherein said one or more motion sensors comprise one or more of ship'"'"'s position sensor, a GPS, ship speed sensor, ship angular position sensor, ship angular turn rate sensor, steering device position sensor, compass, or speedlog.

11. The system of claim 6, wherein said database comprises voyage plan information, maximum ship angular turn rate and maximum steering device angular turn rate.

12. The system of claim 1 further comprising a command system and wherein said command system comprises a command unit and a display and wherein the command unit comprises one or more command buttons used to initiate specific maneuvers and wherein the display displays at least a portion of a selected voyage plan, the ship'"'"'s direction and the pilot line.

13. The system of claim 8, wherein said pilot line angular position and angular turn rate are computed by taking further into account a bias of the pilot line angular position (P_cbias) associated with a change in the pilot line angular turn rate in any of said segments.

14. The system of claim 13 wherein at the instant of a transition from one segment to the next, the rudder command'"'"'s response is calculated according to equation:

RudCmd(0+)−

RudCmd(0−

)=K_max(P_c(0+)−

P_c(0−

))+K_vel(dP_c/dt(0+)−

dP_c/dt(0−

))

wherein (0−

) refers to the instant before the transition and (0+) refers to the instant after the transition.

15. The system of claim 14, wherein following a change in the pilot line angular turn rate the pilot line bias comprises a value equal to:

P_cbias=K_vel/K_max(dP_c/dt(0+)−

dP_c/dt(0−

))

and the pilot line is then calculated according to equation;

P_c(0+)=P_c(0−

)−

P_cbias

16. A method for automatically steering a ship comprising:

providing a navigation application for computing angular position and angular turn rate of a pilot line and wherein said pilot line provides directional guidance to a ship and comprises a vector having one end attached to a point on the ship and a second end pointing to a desired direction;

providing an autopilot steering application for calculating steering commands for a ship steering device wherein said autopilot steering application receives said computed pilot line angular position and angular turn rate and calculates angular position steering commands for said steering device; and

wherein said ship steering device steers the ship and is set according to the calculated steering commands to steer the ship so that the ship'"'"'s velocity vector lines up with the pilot line.

17. The method of claim 16, wherein said autopilot steering application calculates said steering commands by taking into account the difference between the pilot line angular position and the ship'"'"'s angular position and the difference between the pilot line angular turn rate and the ship'"'"'s angular turn rate.

18. The method of claim 16, wherein said autopilot steering application calculates steering commands according to equation:

RudCmd=K_max(P_c−

S_c)+K_vel(dP_c/dt−

dS_c/dt),

wherein RudCmd is the steering command;

wherein P_c is the pilot line angular position, and S_c is the ship'"'"'s angular position;

wherein dP_c/dt is the pilot line angular turn rate, and dS_c/dt is the ship'"'"'s angular turn rate;

wherein K_max is a constant having a value equal to the ratio of a maximum steering device angular turn rate to a maximum allowable ship angular turn rate; and

wherein K_vel is a constant having a value that causes the ship'"'"'s response to a pilot line angular turn rate input to be damped.

19. The method of claim 18, further comprising receiving inputs from one or more motion sensors, wherein said motion sensors provide input signals of ship'"'"'s angular position and turning rate and wherein said autopilot steering application calculates said steering commands for the steering device also based on said sensor input signals.

20. The method of claim 19, wherein ship maneuvers are accomplished with the ship'"'"'s angular turn rate being equal or less than a set maximum ship angular turn rate value, and with the steering device angular turn rate being equal or less than a set maximum steering device angular turn rate value.

21. The method of claim 20, further comprising providing a computing system and wherein the computing system comprises a computing device, a database, said navigation application, and said autopilot steering application.

22. The method of claim 21, wherein said ship follows a voyage plan and said voyage plan comprises at least first and second waypoints connected via a track line and wherein said navigation application compares the ship'"'"'s current position with said first and second waypoint positions and determines offset of the ship'"'"'s current position from the track line, and angular direction of the track line and subsequently uses the determined offset of the ship'"'"'s current position from the track line, and angular direction of the track line to compute pilot line angular position and angular turn rate.

23. The method of claim 22, wherein each navigation maneuver comprises one or more successive segments and wherein the navigation application computes pilot line angular position and pilot line angular turn rate for each segment and provides the computed pilot line angular positions and pilot line angular turn rates to the autopilot steering application for each successive segment.

24. The method of claim 23, wherein at a transition instant between two adjacent segments the pilot line angular position and angular turn rate are changed and the ship'"'"'s position, ship'"'"'s angular turn rate and the steering device'"'"'s angular position do not change.

25. The method of claim 19, wherein said one or more motion sensors comprise one or more of ship'"'"'s position sensor, a GPS, ship speed sensor, ship angular position sensor, ship angular turn rate sensor, steering device position sensor, compass, or speedlog.

26. The method of claim 21, wherein said database comprises voyage plan information, maximum ship angular turn rate and maximum steering device angular turn rate.

27. The method of claim 16, further comprising providing a command system and wherein said command system comprises a command unit and a display and wherein the command unit comprises one or more directional command buttons used to initiate specific maneuvers and wherein the display displays at least a portion of a selected voyage plan, the ship'"'"'s direction and the pilot line angular direction and turn rate.

28. The method of claim 23, wherein said pilot line angular position and angular turn rate are computed by taking further into account a bias of the pilot line angular position (P_cbias) associated with a change in the pilot line angular turn rate in any of the segments.

29. The method of claim 28, wherein at an instant of a transition from one segment to the next, the rudder command'"'"'s response is calculated according to equation:

RudCmd(0+)−

RudCmd(0−

)=K_max(P_c(0+)−

P_c(0−

))+K_vel(dP_c/dt(0+)−

dP_c/dt(0−

))

wherein (0−

) refers to the instant before the transition and (0+) refers to the instant after the transition.

30. The method of claim 29, wherein following a change in the pilot line angular turn rate the bias of the pilot line comprises a value equal to:

P_cbias=K_vel/K_max(dP_c/dt(0+)−

dP_c/dt(0−

))

and the pilot line is then calculated according to equation;

P_c(0+)=P_c(0−

)−

P_cbias

31. A method for automatically steering a ship comprising:

selecting a voyage plan, wherein said voyage plan comprises at least first and second waypoints connected by a track line;

receiving ship'"'"'s current position from a position sensor;

comparing ship'"'"'s current position relative to said waypoints, and if there is an offset from the track line, computing angular position and angular turn rate of a pilot line for reducing said offset to zero and wherein said pilot line provides directional guidance to the ship;

calculating ship steering commands by taking into account the difference between the pilot line angular position and the ship'"'"'s angular position and the difference between the pilot line angular turn rate and the ship'"'"'s angular turn rate; and

setting ship'"'"'s steering device angular position according to the calculated steering commands, thereby adjusting ship'"'"'s angular position so that its velocity vector lines up with the pilot line.

32. The method of claim 31, wherein said steering commands are calculated according to equation:

RudCmd=K_max(P_c−

S_c)+K_vel(dP_c/dt−

dS_c/dt),

wherein RudCmd is the steering command;

wherein P_c is the pilot line angular position, and S_c is the ship'"'"'s angular position;

wherein dP_c/dt is the pilot line angular turn rate, and dS_c/dt is the ship'"'"'s angular turn rate;

wherein Kmax is a constant having a value equal to the ratio of a maximum steering device angular turn rate to a maximum allowable ship angular turn rate; and

wherein Kvel is a constant having a value that causes the ship'"'"'s response to a pilot line angular turn rate input to be damped.

33. The method of claim 32, further comprising introducing a bias in the pilot line angular position following a change in the pilot line angular turn rate.

34. The method of claim 33, wherein each navigation maneuver comprises one or more successive segments and wherein at an instant of a transition from one segment to the next, the rudder command'"'"'s response is calculated according to equation:

RudCmd(0+)−

RudCmd(0−

)=K_max(P_c(0+)−

P_c(0−

))+K_vel(dP_c/dt(0+)−

dP_c/dt(0−

))

wherein (0−

) refers to the instant before the transition and (0+) refers to the instant after the transition.

35. The method of claim 34, wherein following a change in the pilot line angular turn rate the bias of the pilot line comprises a value equal to:

P_cbias=K_vel/K_max(dP_c/dt(0+)−

dP_c/dt(0−

))

and the pilot line is then calculated according to equation;

P_c(0+)=P_c(0−

)−

P_cbias

36. The method of claim 31, wherein said calculating of the ship steering commands comprises one or more of a settle segment, an approach segment, or a convergence segment.

37. The method of claim 36, wherein in said settle segment said pilot line initially points away from an approach line and then rotates toward the approach line.

38. The method of claim 36, wherein in said approach segment the pilot line approaches the desired track line at a constant angle.

39. The method of claim 36, wherein in said convergence segment said pilot line'"'"'s tip touches and slides along said track line causing the ship to converge asymptotically with the desired track line.