Patent Grant
8215252
The invention generally relates to shipboard stabilization systems, and more particularly to an active stabilization system for seagoing vessels to enhance vessel performance in extreme sea states.
In high sea states (greater than 4 on the Beaufort scale), boats and ships must negotiate a variety of extreme conditions. Excessive rolls, yaws, and pitches, coupled with taking on water make working and living on a ship hazardous. Seakeeping (defined as the ability of a vessel to navigate safely at sea for prolonged periods during stormy weather) limits advanced, high speed, vessels from providing an overall effective platform for many open-water applications—including ferrying, search and rescue operations, and military missions. In high seas, most ships must sacrifice either speed or seakeeping ability, and neither can be achieved without size. To survive in high sea states and maintain speed, conventional displacement ships must be large. The relationship between a ship's maximum speed and its hull length is called “hull speed.” Consequently, small, conventional displacement ships are unable to perform high-speed missions in rough seas.
Existing ships often incorporate passive stability systems such as bilge keels, outriggers, anti-roll tanks, and paravanes to reduce the tipping of ships. Active stability systems include the use of stabilizer fins attached to the side of the vessel to counteract unwanted motion of the vessel. Active fin stabilizers are often used to reduce the roll a vessel experiences. There is currently no way to stabilize a ship, and the present solutions are limited to use in countering the small motions of waves.
Thus, there is a need for a dynamic stability system that can assess and counteract a variety of factors that adversely affect ship stability, to provide ships with enhanced ability to perform at extreme sea states.
The disclosed dynamic stability is a novel approach based on using fast computers, active sensing of sea conditions, and optimal control. The advantage in implementing the disclosed system is that it will provide smaller ships with increased seakeeping capability, especially in open and rough seas where currently there is no practical stability solution.
The disclosed system can be used to dynamically stabilize a ship in high sea states to enhance seakeeping, to enable a smaller ship size to move more rapidly at high sea states, and to maintain speed in rough waters. In one embodiment, a six (6) degree-of-freedom (DOF) manipulator (i.e., robotic arm) may be attached to the ship, with a thruster located at the distal end of the manipulator. The manipulator may be used to orient the thruster to counteract wave forces that act against the ship's hull in real time. This active balancing technique can be used to keep the ship substantially erect in rough seas by making continual corrections to the ship's body attitude. The center of gravity and the center of buoyancy of the ship are utilized, along with a precisely oriented and controlled thrust at the end of the manipulator, to optimally control the ship's state against impending waves.
A system is disclosed for stabilizing a floating body. The system may comprise a manipulator connected to the floating body, the manipulator being selectively adjustable with respect to the floating body. The system may also comprise a thruster positioned on the manipulator arm, a first plurality of sensors for measuring a first characteristic of the floating body, a second plurality of sensors for measuring a fluid force adjacent to the floating body; and a controller configured to adjust a position of the manipulator arm and the thruster based on information received from the first and second plurality of sensors. A thrust generated by the thruster may counteract at least a portion of the measured fluid force.
A system is disclosed for stabilizing a floating body. The system may comprise a manipulator arm connected to the floating body, the manipulator arm having six degrees of freedom with respect to the floating body. The system may further comprise a thruster positioned on the manipulator arm, a first plurality of sensors for measuring a first characteristic of the floating body, a second plurality of sensors for measuring a fluid force adjacent to the floating body; and a controller configured to adjust a position of the manipulator arm and the thruster based on information received from the first and second plurality of sensors. A thrust generated by the thruster counteracts at least a portion of the measured fluid force.
These and other features and advantages of the present invention will be more fully disclosed in, or rendered obvious by, the following detailed description of the preferred embodiment of the invention, which is to be considered together with the accompanying drawings wherein like numbers refer to like parts, and further wherein:
In the accompanying drawings, like items are indicated by like reference numerals. This description of the preferred embodiments is intended to be read in connection with the accompanying drawings, which are to be considered part of the written description of this invention. In the description, relative terms such as “lower,” “upper,” “horizontal,” “vertical,”, “above,” “below,” “up,” “down,” “top” and “bottom” as well as derivative thereof (e.g., “horizontally,” “downwardly,” “upwardly,” etc.) should be construed to refer to the orientation as then described or as shown in the drawing under discussion. These relative terms are for convenience of description and do not require that the apparatus be constructed or operated in a particular orientation. Terms concerning attachments, coupling and the like, such as “connected” and “interconnected,” refer to a relationship wherein structures are secured or attached to one another either directly or indirectly through intervening structures, as well as both movable or rigid attachments or relationships, unless expressly described otherwise.
The disclosed system may be referred to as having two portions: (1) a stability portion, and (2) a navigation portion. The stability portion includes a six (6) Degree of Freedom (DOF) manipulator to position and orient a thruster which supply a counteracting force to the water, sensors to measure the state of the ship and to measure the forces of impinging waves, and a computer (processor) to run software that measures the state of the ship, senses the waves and controls the manipulator and thruster. In addition to this list of hardware, low-level software may be required to interpret the output of each of the sensors, and to control the arm and thruster combination. The navigation portion includes an analytical system that selects an optimum ship's travel path based on visual and radar inputs of sea conditions, including the presence of waves.
Thus, the disclosed system utilizes dynamic stability techniques to keep the boat upright in high sea states. Referring to
Although a single manipulator 6 and thruster 12 are shown in
As noted, the manipulator 6 may be operable to position the thruster 12 at a desired position and orientation with respect to the vessel so that the thruster 12 can apply a counter-thrust to the water, which may include one or more waves. By positioning the thruster 12 to counteract the force of impinging waves, an active balance may be achieved to maintain the ship 2 substantially erect in rough seas. As will be described in greater detail later, the manipulator 6 may be automatically controlled in this effort by a control system (
Referring now to
In the illustrated embodiment, the manipulator 6 has multiple independent arm segments 16, 18, 20 to provide a high degree of adjustability so that the thruster 12 can be rapidly positioned at any of a variety of desired positions with respect to the ship 2. The arm segments 16, 18, 20 may be sized, depending upon the individual application, to result in a desired overall length for the manipulator 6 that will provide an appropriate moment to enable force applied by the thruster to maintain the ship's stability. In addition, the physical strength characteristics of the manipulator 6 may be varied depending on the size of the ship being served and the nature of the seas in which the ship will operate.
As noted, the extended length of the manipulator 6 may be the maximum moment arm for the balancing moment. The virtual moment arm (i.e., the distance from the base 22 of the first segment 16 to the end 24 of the third segment 20) may be adjustable by a combination of bending (rotation of the joint) at what are referred to as the shoulder 26, elbow 28, and wrist 30 joints of the manipulator 6. Since these joints 26, 28, 30 are in the same plane, they can effectively extend and retract the manipulator 6.
Thruster 12 may, in its most basic form, comprise a motor driven propeller 32 in a duct 34. Examples of suitable commercial thrusters include those offered by TELL Technology Ltd, One Ropley Business Park, Ropley, Hampshire SO24 0BG, England; and Innerspace Corporation, 1138 East Edna Place, Covina, Calif. 91724. Like the manipulator 12, the size and power of the thruster 12 may be chosen depending on the size of the ship 2 being served, as well as the nature of the seas in which the ship will operate.
The thruster 12 may be connected to the manipulator 6 such that the thruster and manipulator are rigidly fixed together. Alternatively, the connection between the thruster and manipulator may be such that a degree of articulability is provided between the two so that the thruster can move (swivel, etc.) with respect to the manipulator.
Referring now to
As previously noted, the disclosed system 1 uses the center of gravity “CG” and center of buoyancy of the ship 2, as well as a controlled thrust at the end of the manipulator 6, to optimally control the ship's state against impending waves. Center of gravity “CG” may be calculated during the design of the ship, or it may be determined through testing after the ship is built. Test methods may include suspending the ship 2 and finding its fulcrum based on moving and balancing the load until an equilibrium is reached. The center of buoyancy can be determined in a number of ways, including measurement with liquid level sensors, derivation from pressure sensors, using a gyroscope, using accelerometers, or it can be calculated from mass and shape parameters.
The act of balancing is a dynamic problem described by a set of linear differential equations. Stability is achieved by an optimal control system that tries to minimize all the different costs in the system, which is described by a quadratic function. This means that the settings of the processor 38 (see
Force and moment sensing Fd at the wrist 30 of the manipulator 6 is provided using a robotic force/torque sensor. This force and moment information is input into the force control law. In parallel, the manipulator 6 is controlled using inputs of position, velocity, and acceleration measured at each of the individual rotational joints 26, 28, 30 of the manipulator 6. The individual control laws, the Inverse Kinematics of the manipulator, and its Jacobian function are used to position and orient the thruster 12. In addition, a controller (not shown) is provided to modulate the output of the thruster 12. The forces and moments of the waves are balanced with the counter forces produced by the thruster 12 and the counter torque produced by the force of the thruster 12 projected by the manipulator 6. The output is a dynamic system that keeps the ship upright when disturbed by waves crashing into the side of the vessel.
The “cost” (function) may be defined as a sum of the deviations of key measurements from their desired values. In effect, the algorithm determines those controller settings that minimize the undesired deviations, like deviations from undesired rolling that will tip the ship. A quadratic cost function is defined as the feedback control law that minimizes the value of the cost. Thus, the quadratic regulator algorithm optimizes the controller. This means that the controller synthesizes and then adjusts the weighting factors to get the controller more “in line” with the specified design goals of the system. Thus, the quadratic regulator algorithm is an automated way of finding an appropriate state-feedback controller that defines the relationship between its adjusted parameters and the resulting changes in the controller's behavior.
Referring now to
The navigation system uses the general sense-plan-act algorithm. The architecture is hierarchical and layered with a servo layer (at the bottom), a reactive layer (in the middle), and a navigational or trajectory layer (at the top). The servo layer has the fastest update rate, followed by the middle layer which runs slightly slower, and the top layer which updates at the lowest update rate (allowing the planner to plan a trajectory). The servo layer uses inertial sensing data received from an Inertial Measuring Unit to dead reckon (based on heading and velocity) the ship.
The reactive layer is used to redirect the ship in the presence of potential obstacles, such as large waves. A radar or camera 58 is used to identify potential obstacles that pose a threat to the ship. An obstacle avoidance maneuver (such as using a potential field approach) is used to direct or steer the ship around the obstacles. This same radar or camera will also be used to build a 2.5D (two and a half dimensional) or 3D range map of the local area around the ship. Either type of map will work for obstacle maneuvering similar to what is currently used by unmanned ground vehicles. In one embodiment, the range and resolution of this map would have a look ahead range of approximately 50 meters with a resolution to resolve waves as small as a few meters tall.
The highest layer is the trajectory layer. This layer plans the trajectory or path of the ship in a world coordinate frame. GPS is used to determine the location of the ship (also known as the localization problem), especially if it is on or diverting off its planned trajectory. This information tells the ship if it is on the planned trajectory or not. When the ship gets off its path, it makes adjustments in order to return to its planned path. Commands from the trajectory layer are used to keep the ship on its path, and are passed down to the low level controller and simultaneously make adjustments for any reactive maneuvers. The GPS sensor can correct any drifting of the inertial sensing used in dead reckoning, and the map created by the radar or camera is correlated with a global map that is registered to global coordinates (sometimes referred to as sensor fusion). Maps modeled at the local level are reconciled and fused with maps on the larger scale (global) to gain a knowledge of the environment about the ship. Sensing from multiple sensors at varying resolution is passed to the planner, resulting with a set of servo commands that are ultimately used to steer the ship.
The stabilization system (i.e., the processor 38, manipulator 6, and thruster 12) and the navigation system 50 are separate, however, the navigation system can re-direct the ship, thus steering the ship into calmer water. Similarly, by understanding the real-time forces on the ship, this information can be used to fine tune the navigation system (e.g., speed, heading and bearing). Thus, the stabilization system and the navigation system are complementary.
For navigation, a “two and a half dimensional” map is used. A two and a half dimensional map is simply a two-dimensional map which incorporates information regarding gravity. Gravity represents a vertical characteristic applied to each point in the planar two-dimensional map. To measure the direction of gravity, one or more gyroscopes 64 may be mounted as close to the center of gravity “CG” of the ship as practical. Accelerometers 66 may also be located close to the gyroscopes. Any physical offsets can be accounted for in the kinematics, which is typically represented by a six by six matrix. As the gyroscopes 64 drift with time, the accelerometers 66 will be used to re-calibrate the gyroscopes to their null position. Gyroscopes may drift for a variety of reasons (e.g., as a result of high frequency noise). To re-calibrate the gyroscopes 64, the accelerometers 66 may indicate an amount of drift, and when a predetermined limit is exceeded the gyroscope may be commanded to re-zero their readings.
A three dimensional map could also be desirable, and depending on the resolution, this may be a topographical type of map or an occupancy grid. The GPS 52, navigation radar 56 and second processor 62 may be used separately, or together with the control system 36 to result in an integrated overall system.
The stability of a ship 2 in high sea states is fundamentally equivalent to solving the inverted pendulum problem. To measure its direction of motion, Global Positioning System (GPS) data can be used to calculate vessel heading (i.e., direction). Due to the nature of waves and sets of waves in a storm, however, steering does not adhere to the traditional ground-robot path planning problem, but to a local behavioral approach to navigation. The ground robot path planning problem is to take a mobile robot from a starting point to a goal point. There are multiple planning techniques such as occupancy grids, Voronoi diagrams, exact cell-decomposition approach, potential fields, etc. to plan an optimal path. The same techniques can be used to plan the motion of a ship, taking waves as obstacles and marking them as negative consequences to be avoided. Thus, the smoothest or safest path becomes the goal of the planning algorithm, which is described in more detail later in relation to
The system 1 must sense and enable the ship to traverse simultaneously in order to negotiate the waves, eliminating planning which can be time consuming. The navigation problem uses reactive control theory to chart its way through a patch of rough seas. Reactive control refers to the capability of a system to react quickly to state changes. Reactive controllers have very tight code loops that make fast but simple decisions. This type of controller is well suited to dynamic worlds where behaviors such as obstacle avoidance are implemented. Exemplary publications that describe reactive control theory include “Vehicles: Experiments in Synthetic Psychology,” by Valentino Braitenberg, MIT Press, 1986, ISBN 0-262-52112-1; “A Simple Reactive Architecture for Robust Robots”, by Rajiv Desai and David Miller, Proc. of the IEEE International Conference on Robotics & Automation (ICRA), Nice, France, May 1992; “Introduction to AI Robotics,” by Robin Murphy, MIT Press, 2000, ISBN 0-262-13383-0; “Behavior-Based Robotics,” by Ronald Arkin, MIT Press, 1998, ISBN 0-262-01165-4; “A Robust Layered Control System for a Mobile Robot”, by R. A. Brooks, IEEE Journal of Robotics and Automation, Vol. 2, No. 1, March 1986, pp. 14-23; “Intelligence Without Reason”, by R. A. Brooks, Proceedings of 12th Int. Joint Conf. on Artificial Intelligence, Sydney, Australia, August 1991, pp. 569-595; the entirety of which are incorporated by reference herein.
During navigation, the load cells 60 may be used to “feel” the waves, and the radar 56 along with the panoramic camera 58 will be used to “see” and pick an appropriate course (analogous to a probability predictor). Referring to
The panoramic camera(s) 58 may be placed at or near the highest point on the ship, (e.g., at the top of the ships mast or similar location). The camera(s) 58 may be pointed out and downward to obtain a desired view of impending water and waves. For a fuller view of the ship's local surroundings, the camera(s) may be positioned with a pan/tilt device (commonly referred to as a gimbal). The camera(s) may be connected to the onboard computer, which is the brains and coordinates the navigation of the ship, as well as computing the stability control. This is analogous to an automobile with traction control.
Surface water is the most difficult environment for a mobile robot to negotiate. A ground environment is cluttered with many potential obstacles, but the surface water environment is difficult because of its color and non-descript characteristics, i.e., most water looks alike through a camera. A Gaussian or a Sobel operator may be used (for edge detection) to build a rough order model of the waves in the immediate area around the ship to react to. The model of the waves will be developed with cameras and processed using computer vision algorithms. A common computer vision algorithm is a Sobel operator (named for its inventor), while other techniques utilize a Gaussian approach which is based on probability distributions. The way these algorithms work is that to find discontinuities in the scene which equate to a mathematical derivative function. For example, these techniques find edges in a 2-dimensional image. These edges form boundaries on a surface, which in the subject case is a wave. This edge can be separated from the sky above and other features such as flat water. Having a shape or object defined, the height and width of a wave can be calculated from this information. This technique is dynamic since waves are always forming, growing, combining, or diminishing all the time. A series of waves is often distinguished as a set. In the robotic world, waves would be defined as moving obstacles. When negotiating an obstacle, the ship has a choice of going around the obstacle, maybe stopping or slowing down until the obstacle no longer is an obstacle, or passing through the obstacle.
This navigation approach incorporates an aspect of hierarchy (similar to Three-T architecture) since there is a heading and destination for the mission. Autonomous navigation is based on different types of architectures: 1) hierarchical (very deterministic and used a lot in a military structure), 2) behaviorist or reactive (insects use these primitive behaviors to forage for food or to explore), or 3) a hybrid of both. Three-T stands for three-tiers and is a hybrid architecture. The result is an architecture that can plan as well as react to situations, similar to the way the human body works.
Although the invention has been described in terms of exemplary embodiments, it is not limited thereto. The features of the system and method have been disclosed, and further variations will be apparent to persons skilled in the art. All such variations are considered to be within the scope of the appended claims. Reference should be made to the appended claims, rather than the foregoing specification, as indicating the true scope of the disclosed method. The appended claims should be construed broadly, to include such other variants and embodiments of the invention which may be made by those skilled in the art without departing from the scope and range of equivalents of the invention.
The methods described herein may be automated by, for example, tangibly embodying a program of instructions upon a computer readable storage media capable of being read by machine capable of executing the instructions. A general purpose computer is one example of such a machine. A non-limiting exemplary list of appropriate storage media well known in the art would include such devices as a readable or writeable CD, flash memory chips (e.g., thumb drives), various magnetic storage media, and the like.
The functions and process steps herein may be performed automatically or wholly or partially in response to user command. An activity (including a step) performed automatically is performed in response to executable instruction or device operation without user direct initiation of the activity.
| Number | Name | Date | Kind |
|---|---|---|---|
| 2979010 | Braddon et al. | Apr 1961 | A |
| 3446173 | Ohcho et al. | May 1969 | A |
| 3757723 | Pangalila | Sep 1973 | A |
| 3818959 | Larsh | Jun 1974 | A |
| 4645463 | Arneson | Feb 1987 | A |
| 4777899 | Bettcher, Jr. | Oct 1988 | A |
| 5276390 | Fisher et al. | Jan 1994 | A |
| 5414799 | Seraji | May 1995 | A |
| 6064924 | Fleischmann | May 2000 | A |
| 6145378 | McRobbie et al. | Nov 2000 | A |
| 6978728 | Koop et al. | Dec 2005 | B2 |
| 7036445 | Kaufmann et al. | May 2006 | B2 |
| 7335074 | Arneson | Feb 2008 | B2 |
| 7339339 | Kanaoka | Mar 2008 | B2 |
| 7511736 | Benton | Mar 2009 | B2 |
| 7565876 | Wilson et al. | Jul 2009 | B2 |
| 20070272143 | Koop et al. | Nov 2007 | A1 |
| Number | Date | Country |
|---|---|---|
| 0754618 | Jan 1997 | EP |
| 922977 | Apr 1963 | GB |
