Optical flow navigation system
First Claim
1. A method for determining the state of a vehicle in terms of location and attitude relative to an external coordinate system defining first, second, and third mutually orthogonal coordinate axes, said method comprising the steps of:
- providing first and second two-dimensional imagers having their field of view (a) mutually aligned with said first external coordinate axis, and (b) oppositely directed relative to said first external coordinate axis, said first and second imagers each defining a positive first imager direction parallel with said third external coordinate axis, and a positive second imager direction mutually pointing in the same direction about said third coordinate axis;
providing third and fourth two-dimensional imagers having their fields of view (a) mutually aligned with said second external coordinate axis, and (b) oppositely directed relative to said second external coordinate axis, said third and fourth imagers each defining a positive first imager direction parallel with said third external coordinate axis, and a positive second imager direction mutually pointing in the same direction about said third coordinate axis;
operating said first, second, third and fourth imagers during flight of said vehicle, to thereby produce a time sequence of images from said first, second, third and fourth imagers;
for each imager direction of each or said first, second, third and fourth imagers, cross-correlating a time-sequence of the images to thereby generate average angular change of features in the images for each of said first and second imager directions;
summing the angular change of said first imager in said second imager direction with the angular change of said second imager in said second imager direction to thereby determine angular change relative to a point on said second coordinate axis of said coordinate system;
summing the angular change of said third imager in said second imager direction with the angular change of said fourth imager in said second imager direction to thereby determine angular change relative to a point on said first coordinate axis of said coordinate system;
summing the angular changes of said first, second, third and fourth imagers in said first imager direction, to thereby determine angular change along relative to a point on said third coordinate axis of said coordinate system;
summing said angular change of said first imager in said first imager direction with said angular change of said second imager in said first imager direction to thereby determine pitch change about said second coordinate axis;
summing said angular change of said third imager in said first imager direction with said angular change of said fourth imager in said first imager direction to thereby determine roll change about a first coordinate axis; and
summing said angular change of said first, second, third and fourth imagers in said second imager direction to thereby determine yaw change about said third coordinate axis; and
operating an automatic control device using at least one of said angular change, said pitch change, said roll change and said yaw change, to maintain a desired state of said vehicle.
1 Assignment
0 Petitions
Accused Products
Abstract
An optical navigation sensor includes four two-dimensional imagers, each aligned with an x or y axis of an orthogonal xyz coordinate system, and each defining mutually parallel vertical image directions and the same horizontal directions about a yaw axis. Translation or roll, pitch, and yaw cause image flow or movement, which can be determined by cross-correlation of successive images. Translation in the x or y direction is determined by differencing image motion in the horizontal direction, and translation in the z direction is determined by summing the image motion in the vertical direction. Pitch about x and roll about y are determined by differencing image motion in the vertical direction, and yaw about z is determined by summing the image flow in the horizontal direction.
-
Citations
20 Claims
-
1. A method for determining the state of a vehicle in terms of location and attitude relative to an external coordinate system defining first, second, and third mutually orthogonal coordinate axes, said method comprising the steps of:
-
providing first and second two-dimensional imagers having their field of view (a) mutually aligned with said first external coordinate axis, and (b) oppositely directed relative to said first external coordinate axis, said first and second imagers each defining a positive first imager direction parallel with said third external coordinate axis, and a positive second imager direction mutually pointing in the same direction about said third coordinate axis; providing third and fourth two-dimensional imagers having their fields of view (a) mutually aligned with said second external coordinate axis, and (b) oppositely directed relative to said second external coordinate axis, said third and fourth imagers each defining a positive first imager direction parallel with said third external coordinate axis, and a positive second imager direction mutually pointing in the same direction about said third coordinate axis; operating said first, second, third and fourth imagers during flight of said vehicle, to thereby produce a time sequence of images from said first, second, third and fourth imagers; for each imager direction of each or said first, second, third and fourth imagers, cross-correlating a time-sequence of the images to thereby generate average angular change of features in the images for each of said first and second imager directions; summing the angular change of said first imager in said second imager direction with the angular change of said second imager in said second imager direction to thereby determine angular change relative to a point on said second coordinate axis of said coordinate system; summing the angular change of said third imager in said second imager direction with the angular change of said fourth imager in said second imager direction to thereby determine angular change relative to a point on said first coordinate axis of said coordinate system; summing the angular changes of said first, second, third and fourth imagers in said first imager direction, to thereby determine angular change along relative to a point on said third coordinate axis of said coordinate system; summing said angular change of said first imager in said first imager direction with said angular change of said second imager in said first imager direction to thereby determine pitch change about said second coordinate axis; summing said angular change of said third imager in said first imager direction with said angular change of said fourth imager in said first imager direction to thereby determine roll change about a first coordinate axis; and summing said angular change of said first, second, third and fourth imagers in said second imager direction to thereby determine yaw change about said third coordinate axis; and operating an automatic control device using at least one of said angular change, said pitch change, said roll change and said yaw change, to maintain a desired state of said vehicle. - View Dependent Claims (2, 3)
-
-
4. A method for controlling the state of a vehicle in terms of location and attitude relative to a coordinate system defining first, second and third mutually orthogonal coordinate axes, said method comprising the steps of:
-
providing a vehicle body including propulsion system actuators and an automatic control device for receiving changes in the position and attitude of the vehicle body; providing first and second two-dimensional imagers having their fields of view (a) mutually aligned with said first external coordinate axis, and (b) oppositely directed relative to said first external coordinate axis, said first and second imagers each defining a positive first imager direction parallel with said third external coordinate axis, and a positive second imager direction mutually pointing in the same direction about said third coordinate axis; providing third and fourth two-dimensional imagers having their fields of view (a) mutually aligned with said second external coordinate axis, and (b) oppositely directed relative to said second external coordinate axis, said third and fourth imagers each defining a positive first imager direction parallel with said third external coordinate axis, and a positive second imager direction mutually pointing in the same direction about said third coordinate axis; operating said first, second, third and fourth imagers during flight of said vehicle, to thereby produce a time sequence of images from said first, second, third and fourth imagers; for each imager direction of each of said first, second, third and fourth imagers, correlating a time-sequence of the images to thereby generate average angular change of features in the images for each of said first and second imager directions; summing the angular change of said first imager in said second imager direction with the angular change of said second imager in said second imager direction to thereby determine angular change relative to a point on said second coordinate axis of said coordinate system; summing the angular change of said third imager in said second imager direction with the angular change of said fourth imager in said second imager direction to thereby determine angular change relative to a point on said first coordinate axis of said coordinate system; summing the angular changes of said first, second, third and fourth imagers in said first imager direction, to thereby determine angular change relative to a point on a said third coordinate axis of said coordinate system; summing said angular change of said first imager in said first imager direction with said angular change of said second imager is said first imager direction to thereby determine pitch change about said second coordinate axis; summing said angular change of said third imager in said first imager direction with said angular change of said fourth imager in said first imager direction to thereby determine roll change about said first coordinate axis; and summing said angular change of said first, second, third and fourth imagers in said second imager direction to thereby determine yaw change about said third coordinate axis; and coupling to said automatic control device said angular change along said second coordinate axis of said coordinate system, angular change along said first coordinate axis of said coordinate system;
angular change along said third coordinate axis of said coordinate system;
pitch change about said second coordinate axis;
roll change about said first coordinate axis; and
yaw change about said third coordinate axis; andoperating said automatic control device to maintain a given state.
-
-
5. A method for determining the state of a vehicle, said method comprising the steps of:
-
defining a coordinate system having mutually orthogonal first, a second and a third coordinate axes; providing first, second, third and fourth imagers, each of said imagers having a view of view aligned relative to a corresponding coordinate axis; operating said first, second, third and fourth imagers during flight of said vehicle to produce a time sequence of images from said first, second, third and fourth imagers; for each of said first, second, third and fourth imagers, cross-correlating the time-sequence of the images to generate an angular change of features in images; summing said angular change of said first imager in one of said imager directions with said angular change of said second imager in said one of said imager directions to determine angular change relative to a point on said first coordinate axis of said coordinate system; summing an angular change of said third imager in said one of said imager directions with an angular change of said fourth imager in said one of said imager directions to determine angular change relative to a point on said second coordinate axis of said coordinate system; summing said angular changes of said first, second, third and fourth imagers in another of said imager directions, to determine an angular change relative to a point on said third coordinate axis of said coordinate system; summing said angular change of said first imager in said another imager direction with said angular change of said second imager in said another imager direction to determine a pitch change about said second coordinate axis; summing said angular change of said third imager in said one of said imager directions with said angular change of said fourth imager in said one of said imager directions to thereby determine roll change about said first coordinate axis; summing said angular change of said first, second, third and fourth imagers in said another imager direction to determine yaw change about a third coordinate axis; and operating an automatic control device using at least one of said angular change, said pitch change, said roll change and said yaw change to control propulsion system actuators associated with said vehicle. - View Dependent Claims (6, 7, 8, 9, 10, 11, 12)
-
-
13. A system for determining the state of a vehicle, said system comprising
first, second, third and fourth imagers, each of said imagers having a field of view, and each of said imagers having an imager direction; -
a processor executing instructions for performing the steps of; operating said first, second, third and fourth imagers during flight of said vehicle to produce a time sequence of images from said first, second, third and fourth imagers; for each imager direction of each of said first, second, third and fourth imagers, cross-correlating the time-sequence of the images to generate an angular change of features in images; defining a coordinate system having mutually orthogonal first, a second and a third axes; summing said angular change of said first imager in one of said imager directions with said angular change of said second imager in said one of said imager directions to determine angular change relative to a point on said first coordinate axis of said coordinate system; summing an angular change of said third imager in said one of said imager directions with an angular change of said fourth imager in said one of said imager directions to determine angular change relative to a point on said second coordinate axis of said coordinate system; summing said angular changes of said first, second, third and fourth imagers in another of said imager directions, to determine an angular change relative to a point on said third coordinate axis of said coordinate system; summing said angular change of said first imager in said another imager direction with said angular change of said second imager in said another imager direction to determine a pitch change about said second coordinate axis; summing said angular change of said third imager in said one of said imager directions with said angular change of said fourth imager in said one of said imager directions to thereby determine roll change about said first coordinate axis; summing said angular change of said first, second, third and fourth imagers in said another imager direction to determine yaw change about a third coordinate axis; and operating an automatic control device using at least one of said angular change, said pitch change, said roll change and said yaw change to control propulsion system actuators associated with said vehicle. - View Dependent Claims (14, 15, 16, 17, 18, 19, 20)
-
Specification