Automated multi-vehicle position, orientation and identification system and method
The present invention provides a system and method for relative localization that provides an orientation signal and a position signal between at least two vehicles. The present invention also provides for vehicle formation, such that there is a leading vehicle and a follower vehicle that maintain a specific formation relative to one another. The orientation, relative position and identity signals are utilized to control that formation. Each vehicle has at least three ultrasonic sensors, at least one ultrasonic source and an optional pair of FM receiver/transmitter. By installing several acoustic sensors whose relative position are known and by measuring the difference in the time of arrival of the same signal from the various sensors on the same vehicle, the difference in time can be converted into a difference of distance and then into relative position of the sensors from the source based on the Time Difference of Arrival (TDOA).
1. A system for locating a first vehicle relative to a second vehicle comprising:
at least one source, operatively coupled to the first vehicle, for transmitting a signal;
at least four sensors, operatively coupled to the second vehicle, for receiving the signal; and
signal processing means, operatively coupled to the second vehicle, for processing the signal received by each of the at least four sensors to determine the relative location of the second vehicle to the first vehicle based on differences in time of arrival of the same signal by each of the at least four sensors;
wherein the first vehicle and the second vehicle are both unmanned;
wherein the time of arrival of the signal at each of the at least four sensors corresponds to an initial detection of a sinusoidal wave at each of the at least four sensors;
wherein the system determines the time of arrival of the signal from a series of samples taken along a period of time when the sinusoidal wave is at its peak, the time of arrival being determined to be when a first peak of the sinusoidal wave within the series of samples is detected;
wherein the peak of the sinusoidal wave occurs when a power of the signal is at a maximum level; and
wherein the relative location is validated by an infrared tracking means that includes at least one infrared camera that is in operative communication with at least one infrared marker operatively coupled to the first vehicle.
2. The system as in claim 1 , wherein the at least one source is two sources, wherein each source transmits a unique signal that is received by the at least four sensors.
3. The system as in claim 2 , wherein the signal processing means determines the relative orientation of the second vehicle to the first vehicle based on the difference in distance between the two sources compared to any two of the at least four sensors.
4. The system as in claim 2 , wherein the signal processing means includes a band pass filter for processing the signals received by the at least four sensors into independent signals.
5. The system as in claim 1 , wherein each sensor of the at least four sensors receives the signal from the at least one source.
6. The system as in claim 1 , wherein the at least one source is an ultrasonic source for transmitting sound waves.
7. The system as in claim 1 , wherein each of the at least four sensors is an ultrasonic sensor for receiving sound waves.
8. The system as in claim 1 , wherein at least one of the first vehicle and the second vehicle is an aerial vehicle.
9. A method for locating a first vehicle relative to a second vehicle comprising steps of:
(a) transmitting, by a digital signal transmitter, a signal from a source operatively coupled to the first vehicle;
(b) receiving the signal by at least four sensors operatively coupled to the second vehicle;
(c) processing, by a processor, the signal received by each of the at least four sensors;
(d) determining, by the processor, the relative location of the second vehicle to the first vehicle based on differences in time of arrival of the signal by each of the at least four sensors; and
(e) validating the relative location through an infrared tracking means that includes at least one infrared camera that is in operative communication with at least one infrared marker operatively coupled to the first vehicle;
wherein the first vehicle and the second vehicle are both unmanned;
wherein the source emits a sinusoidal wave intermittently;
wherein the time of arrival of the signal at each of the at least four sensors corresponds to an initial detection of the sinusoidal wave at each of the at least four sensors;
wherein a series of samples is taken along a period of time when the sinusoidal wave is at its peak so as to determine the time of arrival of the signal, the time of arrival being determined to be when a first peak of the sinusoidal wave within the series of samples is detected; and
wherein the peak of the sinusoidal wave occurs when a power of the signal is at a maximum level.
10. The method as in claim 9 , wherein steps (a) through (d) are performed continuously to maintain a specific distance between the first vehicle and the second vehicle as the vehicles move position.
11. The method as in claim 9 , wherein two unique signals are transmitted by two sources on the first vehicle for receipt by each of the at least four sensors.
12. The method as in claim 11 , wherein step (d) determines the relative orientation of the second vehicle to the first vehicle based on the difference in distance between the two sources compared to one of the at least four sensors.
13. The method as in claim 12 , wherein steps (a) through (d) are performed continuously to maintain a specific distance and orientation between the first vehicle and the second vehicle as at least one of the vehicles move position.
14. A system for locating a first vehicle relative to a second vehicle comprising:
at least one source, operatively coupled to the first vehicle, for transmitting a signal;
at least four sensors, operatively coupled to the second vehicle, for receiving the signal; and
signal processing means, operatively coupled to the second vehicle, for processing the signal received by each of the at least four sensors to determine the relative location of the second vehicle to the first vehicle based on differences in time of arrival of the same signal by each of the at least four sensors;
wherein the first vehicle and the second vehicle are both unmanned;
wherein the time of arrival of the si nal at each of the at least four sensors corresponds to an initial detection of a sinusoidal wave at each of the at least four sensors;
wherein the system determines the time of arrival of the signal from a series of samples taken along a period of time when the sinusoidal wave is at its peak, the time of arrival being determined to be when a first peak of the sinusoidal wave within the series of samples is detected;
wherein the peak of the sinusoidal wave occurs when a power of the signal is at a maximum level;
wherein the relative location is validated by an infrared tracking means that includes at least one infrared camera that is in operative communication with at least one infrared marker operatively coupled to the first vehicle; and
wherein at least one of the first vehicle and the second vehicle is an aerial vehicle.