A system and method for determining orientation of a vehicle is provided. The method includes the steps of providing a vehicle having a hinge joint such that sections of the chassis are capable of rotation with respect to each other. A first and second wheel is mounted to one and the other of the chassis sections, respectively. vehicle geometric data defining a distance between the hinge joint and the centers of the first and second wheels, respectively, and the diameter of the wheels is provided. surface geometric data defining the curvature of the surface can be provided. The angle of rotation about the hinge joint is measured. An orientation of the vehicle relative to the surface based on the vehicle geometric date, the surface geometric data, and the measured angle of rotation can be determined. A system and method for determining the orientation of an object is also provided.
|
1. A method for determining orientation of a vehicle relative to a surface having defined geometric data that represents a curvature of the surface, the method comprising the steps of:
measuring an angle of rotation about a hinge joint that is part of the vehicle, wherein the vehicle is configured to travel along the surface;
determining the orientation of the vehicle relative to the surface based on vehicle geometric data, the surface geometric data and the measured angle of rotation using a processor located on board the vehicle; and
controlling operation of the vehicle in view of the determined orientation using the processor,
wherein the surface comprises a cylindrical pipe and the step of determining the orientation of the vehicle corresponds to determining one orientation out of four possible orientations relative to a centerline of the cylindrical pipe and the method further includes the step of storing an original orientation of the vehicle and all further orientation changes of the vehicle and determining which one of the four possible orientations is a true orientation of the vehicle based on the original orientation and all the further orientation changes of the vehicle.
19. A system for determining orientation of a vehicle relative to a surface having defined geometric data that represents a curvature of the surface comprising:
a drivable vehicle including:
a hinge joint connecting a first part of the vehicle to a second part of the vehicle such that the first and second parts are capable of movement with respect to one another as the vehicle is driven across the surface, the movement of the first and second parts being translated into rotation of the hinge joint;
a sensor configured to measure an angle of rotation about the hinge joint; and
a processor configured to determine an orientation of the vehicle relative to the surface based on defined vehicle geometric data, the defined geometric data of the surface, and a measured angle of rotation about the hinge joint and wherein the processor is configured to control operation of the vehicle in view of a determined orientation,
wherein the surface comprises a cylindrical pipe, and
wherein to determine the orientation of the vehicle, the processor is further configured to determine one orientation out of four possible orientations relative to a centerline of the cylindrical pipe by storing an original orientation of the vehicle and all further orientation changes of the vehicle and determining which one of the four possible orientations is a true orientation of the vehicle based on the original orientation and all the further orientation changes of the vehicle.
2. The method of
3. The method of
4. The method of
5. The method of
6. The method of
7. The method of
8. The method of
9. The method of
10. The method of
0. 11. The method of
12. The method of
13. The method of
14. The method of
15. The method of
0. 16. A method for determining a diameter of a curved structure over which a vehicle travels comprising the steps of:
determining geometric data of the vehicle;
determining an orientation of the vehicle relative to the curved structure; and
measuring an angle of rotation about a hinge joint that is part of the vehicle to determine the diameter of the curved structure.
0. 17. The method of
0. 18. The method of
20. The system of
21. The system of
22. The system of
23. The system of
24. The system of
25. The system of
|
This determine
Where JF is the Jacobean matrix of the system F(X):
Solving the above equation involves finding the inverse of the Jacobean, which can be time consuming and result in high demand of computing resources. Therefore the following system of linear equations can be used for faster results:
JF−1(Xn)(Xn+1−Xn)=−FF(Xn)
For the first iteration, the vector Xn is the initial guess X0. The initial guess used to ensure convergence towards a solution is the case where hinge point has the same y-coordinate as the driving wheel axis and angle hinge Φ is 180 degrees. In this case the initial guess becomes:
After solving the non-linear system, the hinge angle Φ is then calculated in terms of X as follows: ( )
A summary for the sequence of calculations in the forward model can be represented as follows:
##STR00001##
Inverse Model
In the inverse model, hinge angle Φ is given (measured using a potentiometer or other suitable sensor) and the vehicle orientation θ is to be calculated. In this case the major axis a is unknown. To calculate Φ, a system of seven non-linear equations can be constructed to solve the six unknowns in the model (x1, y1, x2, y2, xh, yh, a). These equations are the same six equations from the forward model plus the hinge angle equation Φ. The equations thus are:
This system can also be solved using Newton Raphson method and the initial guess is:
After solving the non-linear system, the vehicle orientation θ can be calculated in terms of X as follows:
A summary for the sequence of calculations in the forward model can be represented as follows:
##STR00002##
In order to To determine when every loop of the helical path ends and the next one starts, a combination of sensor readings can be used including wheel encoders and IMU data (e.g., data obtained from accelerometers, gyroscopes, and magnetometers). The localization scheme used relies on the pipe orientation with respect to the ground because it affects which sensors provide useful readings. If the pipe 80 is horizontal, as shown in
Therefore, in the case of a horizontal pipe, the master microcontroller can depend on the accelerometer values to determine the end and start of the helix loops. On an inclined pipe, the accelerometer values can be used as long as the inclination is not close to being vertical; because if the pipe is vertical or close to vertical then the accelerometer values will stay constant or their changes will not be sufficient for meaningful determinations. In this case, other means can be used including magnetometer readings, dead reckoning using wheel encoder values, and/or monitoring external visual references. A Kalman filter or other suitable sensor fusion algorithm can be used to fuse these data for the case of a vertical pipe.
Accordingly, the above equations provide an exemplary method for determine orientation/hinge angle of a vehicle on a curved surface. The method can be adapted to different structures of vehicles/mechanisms that are capable of self-adjusting to a known curvature in a measurable way (e.g., having a hinge that is measured).
The method for determining the orientation of the vehicle can be performed by a computer having a processor with memory for executing code. As shown in
The functional elements shown in
For example, sensors measuring the angle of the hinge can provide electrical input signals to the processor. Such signals can undergo analog or digital signal processing before being inputted to the processor 202, such as by a pre-processing module implemented as computer code. Such a module can receive output from an analog-to-digital converter, which in turn receives signals from a sensor, e.g., a strain gauge. The calculations used to determine the orientation of the vehicle can be performed by processors located on board the robotic vehicle. Alternatively, or in addition, sensed data can be transmitted (e.g., through wireless communications) to a remote processor (e.g., a field laptop computer, smartphone, tablet, etc.) to perform the processing to determine the orientation and location of the vehicle.
Determining the orientation of the vehicle is particularly useful in robotic inspection applications. For example, the orientation information can be used to calculate a trajectory of the vehicle as it travels along the surface. This can be used to determine the absolution absolute location of the vehicle. For example, to orientation information can be combined with a measured distance traveled by the vehicle (e.g., by counting rotations of the drive wheel) to determine where along the surface the vehicle is located. In addition, the orientation information can be particularly useful when the vehicle is being used to inspect the surface itself and the vehicle needs to pass over the surface to inspect it. The orientation information can be used to determine whether a desired sweep pattern has been achieved by the robot. For example, the distance and orientation information can be collected as data points and combined to build a map of travel of the vehicle. The map can be a three-dimensional map (e.g., using a cylindrical coordinate system) or can be displayed as a two-dimensional map by converting the cylindrical surface into a flat planar surface. Further, since the trajectory of the robot can be mapped, that location information can be combined with inspection data collected, to create detailed maps in which a map of the structure is overlaid with the inspection data. Thus, data points can be generated that include location information and inspection information (e.g., condition of the surface at that location). The data points can be used to create a detailed map of a pipeline in which areas of corrosion are highlighted on the map. Without the system and method of the present invention, the localization data required to produce such maps would be based in relative referencing with drifting errors which would accumulate over time.
Incorporating the system and method of the present invention in robotic vehicle 10, for example, can provide significant benefits. The system and method can be used for measuring the angle of the hinge as the robot maneuvers on a pipe and permits the absolute orientation of the robot with respect to the centerline (or the flow) of the pipe to be accurately calculated. This method can be extrapolated to other mechanisms, vehicles and curved surfaces. This method is unique in that it out performs IMUs in the particular case where the direction of the gravitational force around the vehicle is aligned with the axis of rotation around which the vehicle is pivoting. This alignment between the gravitational force and the axis of rotation can occur, for example, in a condition in which the robot located at the 12 o'clock position on a horizontal pipe and the robot is pivoting/steering in circles in place.
As discussed above, this method has particular application in the control of robotic inspection vehicles. For example, if a robot were to advance along a cylindrical pipe, a particular measurement of a hinge angle can correspond to four possible orientations of the robot relative to the pipe centerline or flow. However, if the original orientation of the robot was known, the system can be configured to store that date data and further store data indicating all further orientation changes. As such, the system can keep track of previous measurements of the hinge angle and easily deduce which one of those four possible current orientations is the true one based on the starting orientation and previous orientation changes.
In addition, if the geometry of the robot is known and the orientation of the robot relative to a pipe is known, the measured angle about the hinge can be used to determine the diameter of the pipe. Further, a robot can be placed on a pipe of unknown diameter and then commanded to pivot 181 degrees around its own driving wheel and map the data acquired from the sensor measuring the angle about the hinge. The system can record the maximum angle as the robot rotates, which occurs when the robot is oriented normal to the flow of the pipe (i.e. as if the robot was about to start driving in circles around the pipe circumference). The maximum measured angle, combined with the geometer data of the robot, can be used for determining the diameter of the pipe upon which the robot is traveling. The method can be adapted to different structures of vehicles/mechanisms that are capable of self-adjusting to a known curvature in a measurable way (e.g., having a hinge that is measured). A vehicle could be used to inspect ship hulls, including aerospace and marine hulls. In addition, if such an inspection tool were used on a structure that had a unique curvature over its circumference, the tool's position could be determined by measuring a hinge angle. For example, if the curvature of a submarine were unique across its hull and was known (e.g., could be represented graphically as a parabola), a measured hinge angle could be used to calculate the vehicle orientation and position.
As discussed above, the described technique could be used to vehicles and other mechanisms more generally. For example, a hinged pincer could employee the described methods for determining the orientation of an object being held by the pincers.
The method described above can provide useful data on applications where IMUs would not provide similar information. For example, smart grippers in automated assembly lines (e.g., pincers consisting of first and second prongs connected by a hinge) can be constructed according to the principles of this invention to grab scrambled objects (e.g., a pile of objects in a pile having random orientations), self-adjust to their shape and use the measured changes in the body of the gripper to determine which way the object was grabbed. For example,
Referring to
Referring to
Referring to
Referring to
It should be understood that various combination, alternatives and modifications of the present invention could be devised by those skilled in the art. The present invention is intended to embrace all such alternatives, modifications and variances that fall within the scope of the appended claims.
While the invention has been particularly shown and described with reference to a preferred embodiment thereof, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the invention.
Abdellatif, Fadl, Outa, Ali, Carrasco Zanini, Pablo
Patent | Priority | Assignee | Title |
Patent | Priority | Assignee | Title |
10451222, | Jul 12 2017 | Saudi Arabian Oil Company | Magnetic crawler vehicle with passive rear-facing apparatus |
5213176, | Dec 08 1989 | Hitachi, Ltd. | Self-propelled vehicle |
5284096, | Aug 06 1991 | OSAKA GAS CO , LIMITED | Vehicle for use in pipes |
5565633, | Jul 30 1993 | Spiral tractor apparatus and method | |
6199000, | Jul 15 1998 | Trimble Navigation LTD | Methods and apparatus for precision agriculture operations utilizing real time kinematic global positioning system systems |
6243657, | Dec 23 1997 | Honeywell International, Inc | Method and apparatus for determining location of characteristics of a pipeline |
6896078, | Jan 31 2003 | JVC Kenwood Corporation | Movable robot |
7731210, | Dec 20 2002 | Vehicle with a tiltable chassis | |
7949437, | Mar 12 2007 | Tamkang University | Omnidirectional movement control system |
8190337, | Mar 20 2003 | AGJUNCTION LLC | Satellite based vehicle guidance control in straight and contour modes |
8327960, | Oct 06 2006 | FLIR DETECTION, INC | Robotic vehicle |
8515612, | Sep 03 2008 | Murata Machinery, Ltd | Route planning method, route planning device and autonomous mobile device |
8957355, | Jan 26 2012 | The Boeing Company | Inertial measurement unit apparatus for use with guidance systems |
9056629, | Mar 26 2012 | Aisin Seiki Kabushiki Kaisha | Personal vehicle control device |
9586636, | Oct 28 2014 | The United States of America as represented by the Secretary of the Navy | Multi-segmented magnetic robot |
20040039510, | |||
20070235238, | |||
20090164067, | |||
20090293622, | |||
20110166737, | |||
20110196583, | |||
20110282536, | |||
20120185129, | |||
20130054133, | |||
20130140801, | |||
20140373496, | |||
20150151572, | |||
EP177112, | |||
GB2226633, | |||
JP1049229, | |||
JP274272, | |||
KR101228516, | |||
KR2013001651, | |||
WO2014076806, | |||
WO9843062, |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Jan 21 2015 | OUTA, ALI | Saudi Arabian Oil Company | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 062840 | /0880 | |
Jan 22 2015 | ABDELLATIF, FADL | Saudi Arabian Oil Company | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 062840 | /0880 | |
Jan 22 2015 | CARRASCO ZANINI, PABLO | Saudi Arabian Oil Company | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 062840 | /0880 | |
Dec 21 2020 | Saudi Arabian Oil Company | (assignment on the face of the patent) | / |
Date | Maintenance Fee Events |
Dec 21 2020 | BIG: Entity status set to Undiscounted (note the period is included in the code). |
Date | Maintenance Schedule |
Jun 06 2026 | 4 years fee payment window open |
Dec 06 2026 | 6 months grace period start (w surcharge) |
Jun 06 2027 | patent expiry (for year 4) |
Jun 06 2029 | 2 years to revive unintentionally abandoned end. (for year 4) |
Jun 06 2030 | 8 years fee payment window open |
Dec 06 2030 | 6 months grace period start (w surcharge) |
Jun 06 2031 | patent expiry (for year 8) |
Jun 06 2033 | 2 years to revive unintentionally abandoned end. (for year 8) |
Jun 06 2034 | 12 years fee payment window open |
Dec 06 2034 | 6 months grace period start (w surcharge) |
Jun 06 2035 | patent expiry (for year 12) |
Jun 06 2037 | 2 years to revive unintentionally abandoned end. (for year 12) |