POLAR MAPPING FOR AUTONOMOUS AND ASSISTED DOCKING SYSTEMS AND METHODS
Techniques are disclosed for systems and methods to provide docking assist and/or general navigation for mobile structures. A docking assist or navigation control system includes a logic device, a perimeter ranging sensor, one or more actuators/controllers, and modules to interface with users, sensors, actuators, and/or other elements of a mobile structure. The logic device is configured to receive perimeter sensor data from the perimeter ranging system. The logic device determines a polar height map based on the received perimeter sensor data and a polar non-water object map and/or a polar vessel perimeter map based on the polar non-water object map. The logic device then generates a display view and/or determines navigation control signals based, at least in part, on the polar maps. Control signals may be displayed to a user and/or used to adjust a steering actuator, a propulsion system thrust, and/or other operational systems of the mobile structure.
1 . A system comprising:
a logic device configured to communicate with a perimeter ranging system mounted to a mobile structure and to provide docking assist for the mobile structure, wherein the logic device is configured to:
receive perimeter sensor data from the perimeter ranging system;
determine a polar height map based, at least in part, on the received perimeter sensor data; and
determine a polar non-water object map and/or a polar vessel perimeter map based, at least in part, on the determined polar height map.
2 . The system of claim 1 , wherein the determining the polar height map comprises:
determining a polar voxel grid mapping for the polar height map based, at least in part, on a radial cell length distribution and/or a monitoring perimeter of the perimeter ranging system, wherein the polar height map comprises a polar voxel grid; and
converting a cartesian point cloud corresponding to the perimeter sensor data to the polar height map based, at least in part, on the polar voxel grid mapping.
3 . The system of claim 1 , wherein the determining the polar non-water object map comprises:
determining, for at least one angle vector of the polar height map, a radial rate of change in voxel height across a series of two or more radially adjacent polar voxels of the polar height map is greater than a non-water object height gradient threshold; and
assigning a range associated with the series of two or more radially adjacent polar voxels of the polar height map to an angle element of the polar non-water object map that corresponds to the at least one angle vector of the polar height map.
4 . The system of claim 1 , wherein the logic device is configured to:
identify portions of the perimeter sensor data corresponding to a water surface disposed about the mobile structure;
determine an estimated water plane orientation relative to an orientation of a perimeter sensor of the perimeter ranging system based, at least in part, on the identified water surface portions of the perimeter sensor data; and
determine an estimated perimeter sensor height vertically above the water surface disposed about the mobile structure based, at least in part, on the estimated water plane orientation, wherein the determining the polar height map is based, at least in part, on the estimated perimeter sensor height.
5 . The system of claim 1 , further comprising the perimeter ranging system, wherein:
the perimeter ranging system comprises one or more imaging modules mounted to the mobile structure configured to capture images of corresponding one or more areas proximate to a perimeter of the mobile structure and including at least a portion of the perimeter of the mobile structure, and to provide the captured images as the perimeter sensor data to the logic device.
6 . The system of claim 1 , further comprising a user interface for the mobile structure, wherein the logic device is configured to:
generate a maneuverability display view of a docking area for the mobile structure on a display of the user interface for the mobile structure, wherein the maneuverability display view is based, at least in part, on the polar non-water object map and/or the polar vessel perimeter map;
receive docking assist parameters from the user interface for the mobile structure;
determine one or more docking assist control signals based, at least in part, on the received docking assist parameters and the determined polar non-water object map and/or polar vessel perimeter map; and
provide the one or more docking assist control signals to a navigation control system for the mobile structure.
7 . The system of claim 6 , wherein the docking assist parameters comprise user pilot control signals, and wherein the determining the one or more docking assist control signals comprises:
determining a target linear and/or angular velocity for the mobile structure based, at least in part, on the user pilot control signals and a maximum maneuvering thrust of the navigation control system; and
determining the one or more docking assist control signals based, at least in part, on the determined target linear and/or angular velocity, wherein the one or more docking assist control signals are configured to cause the navigation control system to maneuver the mobile structure according to the determined target linear and/or angular velocity.
8 . The system of claim 6 , wherein the docking assist parameters comprise a target docking position and/or orientation for the mobile structure, and wherein the determining the one or more docking assist control signals comprises:
determining a target docking track for the mobile structure based, at least in part, on the target docking position and/or orientation and one or more docking safety parameters corresponding to the target docking track; and
determining the one or more docking assist control signals based, at least in part, on the determined target docking track, wherein the one or more docking assist control signals are configured to cause the navigation control system to maneuver the mobile structure according to the determined target docking track.
9 . The system of claim 6 , wherein:
the navigation control system comprises one or more of a steering actuator, a propulsion system, and a thrust maneuver system; and
the providing the one or more docking assist control signals to the navigation control system comprises controlling the one or more of the steering actuator, propulsion system, and thrust maneuver system to maneuver the mobile structure according to a target linear and/or angular velocity, a target docking track, and/or a target docking track position and/or orientation corresponding to the received docking assist parameters.
10 . The system of claim 6 , wherein the determining the one or more docking assist control signals comprises:
determining a relative velocity of and/or a range to a navigation hazard disposed within a monitoring perimeter of the perimeter ranging system based, at least in part, on the polar non-water object map and/or the polar vessel perimeter map;
determining the relative velocity of the navigation hazard towards the mobile structure is greater than a hazard velocity limit and/or the range to the navigation hazard is within a safety perimeter for the mobile structure; and
determining the one or more docking assist control signals based, at least in part, on the determined relative velocity of the navigation hazard and/or the determined range to the navigation hazard, wherein the one or more docking assist control signals are configured to cause the navigation control system to maneuver the mobile structure to evade the navigation hazard by decreasing the relative velocity of the navigation hazard towards the mobile structure and/or maintaining or increasing the range to the navigation hazard.
11 . A method comprising:
receiving perimeter sensor data from a perimeter ranging system mounted to a mobile structure;
determining a polar height map based, at least in part, on the received perimeter sensor data; and
determining a polar non-water object map and/or a polar vessel perimeter map based, at least in part, on the determined polar height map.
12 . The method of claim 11 , wherein the determining the polar height map comprises:
determining a polar voxel grid mapping for the polar height map based, at least in part, on a radial cell length distribution and/or a monitoring perimeter of the perimeter ranging system, wherein the polar height map comprises a polar voxel grid; and
converting a cartesian point cloud corresponding to the perimeter sensor data to the polar height map based, at least in part, on the polar voxel grid mapping for the polar height map.
13 . The method of claim 11 , wherein the determining the polar vessel perimeter map comprises:
determining, for at least one angle vector of the polar height map, a radial rate of change in voxel height across a series of two or more radially adjacent polar voxels of the polar height map is less than a vessel perimeter height gradient threshold; and
assigning a range associated with the of the series of two or more radially adjacent polar voxels of the polar height map to an angle element of the polar vessel perimeter map that corresponds to the at least one angle vector of the polar height map.
14 . The method of claim 11 , further comprising:
identifying portions of the perimeter sensor data corresponding to a water surface disposed about the mobile structure;
determining an estimated water plane orientation relative to an orientation of a perimeter sensor of the perimeter ranging system based, at least in part, on the identified water surface portions of the perimeter sensor data; and
determining an estimated perimeter sensor height vertically above the water surface disposed about the mobile structure based, at least in part, on the estimated water plane orientation, wherein the determining the polar height map is based, at least in part, on the estimated perimeter sensor height.
15 . The method of claim 11 , wherein:
the perimeter ranging system comprises one or more imaging modules mounted to the mobile structure configured to capture images of corresponding one or more areas proximate to a perimeter of the mobile structure and including at least a portion of the perimeter of the mobile structure, and to provide the captured images as the perimeter sensor data to the logic device.
16 . The method of claim 11 , further comprising:
generating a maneuverability display view of a docking area for the mobile structure on a display of a user interface for the mobile structure, wherein the maneuverability display view is based, at least in part, on the polar non-water object map and/or the polar vessel perimeter map;
receiving docking assist parameters from the user interface for the mobile structure;
determining one or more docking assist control signals based, at least in part, on the received docking assist parameters and the determined polar non-water object map and/or polar vessel perimeter map; and
providing the one or more docking assist control signals to a navigation control system for the mobile structure.
17 . The method of claim 16 , wherein the docking assist parameters comprise user pilot control signals, and wherein the determining the one or more docking assist control signals comprises:
determining a target linear and/or angular velocity for the mobile structure based, at least in part, on the user pilot control signals and a maximum maneuvering thrust of the navigation control system; and
determining the one or more docking assist control signals based, at least in part, on the determined target linear and/or angular velocity, wherein the one or more docking assist control signals are configured to cause the navigation control system to maneuver the mobile structure according to the determined target linear and/or angular velocity.
18 . The method of claim 16 , wherein the docking assist parameters comprise a target docking position and/or orientation for the mobile structure, and wherein the determining the one or more docking assist control signals comprises:
determining a target docking track for the mobile structure based, at least in part, on the target docking position and/or orientation and one or more docking safety parameters corresponding to the target docking track; and
determining the one or more docking assist control signals based, at least in part, on the determined target docking track, wherein the one or more docking assist control signals are configured to cause the navigation control system to maneuver the mobile structure according to the determined target docking track.
19 . The method of claim 16 , wherein:
the navigation control system comprises one or more of a steering actuator, a propulsion system, and a thrust maneuver system; and
the providing the one or more docking assist control signals to the navigation control system comprises controlling the one or more of the steering actuator, propulsion system, and thrust maneuver system to maneuver the mobile structure according to a target linear and/or angular velocity, a target docking track, and/or a target docking track position and/or orientation corresponding to the received docking assist parameters.
20 . The method of claim 16 , wherein the determining the one or more docking assist control signals comprises:
determining a relative velocity of and/or a range to a navigation hazard disposed within a monitoring perimeter of the perimeter ranging system based, at least in part, on the polar non-water object map and/or the polar vessel perimeter map;
determining the relative velocity of the navigation hazard towards the mobile structure is greater than a hazard velocity limit and/or the range to the navigation hazard is within a safety perimeter for the mobile structure; and
determining the one or more docking assist control signals based, at least in part, on the determined relative velocity of the navigation hazard and/or the determined range to the navigation hazard, wherein the one or more docking assist control signals are configured to cause the navigation control system to maneuver the mobile structure to evade the navigation hazard by decreasing the relative velocity of the navigation hazard towards the mobile structure and/or maintaining or increasing the range to the navigation hazard.