Systems and methods for relative pose determination and field enforcement of materials handling vehicles using ultra-wideband radio technology
According to the embodiments described herein, system and methods for determining relative pose of materials handling vehicles in an industrial environment may include utilizing ultra-wideband (UWB) antenna array systems respective mounted on the materials handling vehicles to send mutually received information to determine the relative pose between the vehicles, determining one or more fields of each materials handling vehicle, and determining one or more overlapping fields between the materials handling vehicles based on the determined one or more fields and the relative pose. A vehicle control may be implemented based on the determined relative pose and the overlapping fields as a field enforcement, such as a control action to avoid collision between the vehicles.
1. A field enforcement system comprising a first materials handling vehicle, and a second materials handling vehicle, each materials handling vehicle comprising a vehicle body and a vehicle position processor, wherein:
the first and second materials handling vehicles are configured to navigate a vehicle transit surface in a warehouse environment;
the first materials handling vehicle comprises a first ultra-wideband (UWB) antenna array mounted to the vehicle body, the first UWB antenna array comprising at least two antennas and a first UWB antenna array center;
the second materials handling vehicle comprises a second UWB antenna array mounted to the vehicle body, the second UWB antenna array comprising at least two antennas and a second UWB antenna array center; and
each vehicle position processor is configured to:
transmit respective UWB signals comprising vehicle information including center information of the first UWB antenna array center and the second UWB antenna array center between respective UWB antenna arrays of the first and second materials handling vehicles;
determine a relative pose comprising position and orientation of each of the first and second materials handling vehicles with respect to each other based on the respective transmitted UWB signals comprising the vehicle information and measurements based on the center information of the first UWB antenna array center and the second UWB antenna array center;
determine a first virtual field for the first materials handling vehicle and a second virtual field for the second materials handling vehicle based on the respective transmitted UWB signals comprising the vehicle information;
determine a field infringement occurrence when a portion of the first virtual field overlaps a portion of a second virtual field based on the determined relative pose of each of the first and second materials handling vehicles; and
operate at least one of the first and second materials handling vehicles based on the field infringement occurrence.
2. The field enforcement system of claim 1 , wherein each of the first and second virtual fields comprise one of a static field or a dynamic field, wherein the dynamic field is configured to adjust size, shape, or both based on vehicle velocity, relative pose, steer direction, fork or operator compartment lift height, wire guidance status, vehicle model type, load weight, or combinations thereof.
3. The field enforcement system of claim 1 , wherein the field infringement occurrence is determined when the portion of the first virtual field overlapping the portion of second virtual field comprise matching field types comprising an awareness field type, a slow field type, and a stop field type.
4. The field enforcement system of claim 1 , wherein each of the first and second virtual fields comprise a field type, the field type comprising, a slow field, and a stop field.
5. The field enforcement system of claim 4 , wherein the stop field overlaps with a portion of the slow field, the slow field being larger than the stop field.
6. The field enforcement system of claim 4 , wherein the stop field and the slow field are both within an awareness zone, and the awareness zone is representative of a zone surrounding the respective materials handling vehicle in which the materials handling vehicle is configured to detect one or more field infringements.
7. The field enforcement system of claim 6 , wherein the stop field is representative of an area for vehicular travel at a minimum speed limit and the slow field is representative of an area of vehicular travel in which the respective materials handling vehicle would be reduced to the minimum speed limit.
8. The field enforcement system of claim 4 , wherein the field infringement occurrence is determined based on an overlap of the slow fields, and the first and second materials handling vehicles are each configured to decelerate based on the field infringement occurrence.
9. The field enforcement system of claim 4 , wherein when the field infringement occurrence is determined based on an overlap of the stop fields for each the first and second materials handling vehicles, at least one of the first and second materials handling vehicles is set to operate at a maximum speed of 1.0 miles per hour based on the overlap.
10. The field enforcement system of claim 1 , wherein at least one of the first and second materials handling vehicles is configured to slow or stop based on the field infringement occurrence.
11. The field enforcement system of claim 1 , wherein each node of the first UWB antenna array and the second UWB antenna array comprises a UWB antenna arranged and positioned in the respective UWB antenna array and mounted on the vehicle body such that the center of the respective UWB antenna array is calibrated with respect to a center of the respective materials handling vehicle on which the respective UWB antenna array is mounted.
12. The field enforcement system of claim 11 , wherein each UWB antenna comprises a printed circuit board (PCB) including a PCB longitudinal axis, an antenna feature comprising an antenna longitudinal axis aligned in parallel with or perpendicular to the PCB longitudinal axis, and an antenna enclosure shaped and sized to receive the PCB and the antenna feature.
13. The field enforcement system of claim 12 , wherein each UWB antenna comprising the antenna feature with the antenna longitudinal axis aligned in parallel with the PCB longitudinal axis comprises a teardrop shape, the teardrop shape comprising tapered in sidewalls of the PCB with the antenna feature disposed at a shortest end of the tapered sidewalls.
14. The field enforcement system of claim 12 , wherein the antenna enclosure comprises a wall defining a pair of apertures to receive mounting prongs extending from the PCB, such that when a wall longitudinal axis of wall is disposed in parallel with the PCB longitudinal axis, the mounting prongs extend perpendicular to the PCB longitudinal axis to mount to the vehicle body at a ninety-degree angle, and when the wall longitudinal axis of wall is disposed perpendicular to with the PCB longitudinal axis, the mounting prongs extend in parallel with the PCB longitudinal axis to mount to the vehicle body at a zero-degree angle.
15. The field enforcement system of claim 1 , further comprising one or more lights configured to mount to the vehicle body, the one or more lights comprising a plurality of symbols, the plurality of symbols comprising at least a first symbol with a first color representative of vehicle operation without error, a second symbol with a second color representative of a cautionary vehicle warning operation, and a third symbol comprising a third color representative of a negative vehicle warning operation.
16. The field enforcement system of claim 15 , wherein the first color is green, the second color is yellow, and the third color is red, and wherein the one or more lights are configured to generate an associated alert based on whether the first symbol, second symbol, or third symbol is lit.
17. A field enforcement system comprising a vehicle position processor, a first materials handling vehicle, and a second materials handling vehicle, each materials handling vehicle comprising a vehicle body, wherein:
the first and second materials handling vehicles are configured to navigate a vehicle transit surface in a warehouse environment;
the first materials handling vehicle comprises a first ultra-wideband (UWB) antenna array mounted to the vehicle body, the first UWB antenna array comprising at least two antennas and a first UWB antenna array center;
the second materials handling vehicle comprises a second UWB antenna array mounted to the vehicle body, the second UWB antenna array comprising at least two antennas and a second UWB antenna array center; and
the vehicle position processor is configured to:
transmit respective UWB signals comprising vehicle information including center information of the first UWB antenna array center and the second UWB antenna array center between respective UWB antenna arrays of the first and second materials handling vehicles;
determine a relative pose comprising position and orientation of each of the first and second materials handling vehicles with respect to each other based on the respective transmitted UWB signals comprising the vehicle information and measurements based on the center information of the first UWB antenna array center and the second UWB antenna array center;
determine a first virtual field for the first materials handling vehicle and a second virtual field for the second materials handling vehicle based on the respective transmitted UWB signals comprising the vehicle information;
determine a field infringement occurrence when a portion of the first virtual field overlaps a portion of the second virtual field based on the determined relative pose of each of the first and second materials handling vehicles; and
operate at least one of the first and second materials handling vehicles based on the field infringement occurrence.
18. The field enforcement system of claim 17 , wherein the field infringement occurrence is determined when the portion of the first virtual field overlapping the portion of second virtual field comprise matching field types comprising an awareness field type, a slow field type, and a stop field type.
19. A method for field enforcement between a first materials handling vehicle and a second materials handling vehicle, each materials handling vehicle comprising a vehicle body, the first materials handling vehicle comprising a first ultra-wideband (UWB) antenna array mounted to the vehicle body, the first UWB antenna array comprising at least two antennas and a first UWB antenna array center, the second materials handling vehicle comprising a second UWB antenna array mounted to the vehicle body, the second UWB antenna array comprising at least two antennas and a second UWB antenna array center, the method comprising:
transmitting respective UWB signals comprising vehicle information including center information of the first UWB antenna array center and the second UWB antenna array center between respective UWB antenna arrays of the first and second materials handling vehicles;
determining a relative pose comprising position and orientation of each of the first and second materials handling vehicles with respect to each other based on the respective transmitted UWB signals comprising the vehicle information and measurements based on the center information of the first UWB antenna array center and the second UWB antenna array center;
determining a first virtual field for the first materials handling vehicle and a second virtual field for the second materials handling vehicle based on the respective transmitted UWB signals comprising the vehicle information;
determining a field infringement occurrence when a portion of the first virtual field overlaps a portion of the second virtual field based on the determined relative pose of each of the first and second materials handling vehicles; and
operating at least one of the first and second materials handling vehicles based on the field infringement occurrence.