Systems and methods for relative pose determination and field enforcement of materials handling vehicles using ultra-wideband radio technology

Patent metadata

Field	Value
Publication number	US-12066841-B2
Application number	US-202117493221-A
Country	US
Kind code	B2
Filing date	Oct 4, 2021
Priority date	Oct 5, 2020
Publication date	Aug 20, 2024
Grant date	Aug 20, 2024

Abstract

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 respectively 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.

First claim

What is claimed is:

1. A relative pose determination 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 second materials handling vehicle comprises a second UWB antenna array mounted to the vehicle body; and
each vehicle position processor is configured to:
transmit a first UWB signal from the first UWB antenna array of the first materials handling vehicle to the second UWB antenna array of the second materials handling vehicle;
receive the transmitted first UWB signal at the second UWB antenna array of the second materials handling vehicle;
determine a second materials handling vehicle set of information based on the received first UWB signal, the second materials handling vehicle set of information comprising a first angle of arrival (θ 1 ) and first associated timing information based on the first UWB signal received at the second UWB antenna array,
determine a first distance (d 1 ) between the first materials handling vehicle and the second materials handling vehicle based on the transmitted first UWB signal;
transmit a second UWB signal comprising the first angle of arrival (θ 1 ), the first associated timing information, and the determined first distance (d 1 ) from the second UWB antenna array of the second materials handling vehicle to the first UWB antenna array of the first materials handling vehicle;
determine a first materials handling vehicle set of information based on the transmitted second UWB signal, the first materials handling vehicle set of information comprising a second angle of arrival (θ 2 ) and second associated timing information received at the first UWB antenna array;
determine a second distance (d 2 ) between the first materials handling vehicle and the second materials handling vehicle based on the transmitted second UWB signal;
transmit a third UWB signal comprising the second angle of arrival (θ 2 ), the second associated timing information, and the second distance (d 2 ) from the first UWB antenna array of the first materials handling vehicle to the second UWB antenna array of the second materials handling vehicle, such that the first materials handling vehicle and the second materials handling vehicle receive mutual angle of arrival and distance information measured from the other vehicle;
determine a relative pose of each of the first and second materials handling vehicles with respect to each other based on the mutually received angle of arrival and distance information from the second UWB signal and the third UWB signal; and
operate at least one of the first and second materials handling vehicles based on the determined relative pose.

2. The relative pose determination system of claim 1 , wherein the determined first distance (d 1 ) is based on the associated timing information and comprises a distance between a pair of nodes of the second materials handling vehicle and the first materials handling vehicle.

3. The relative pose determination system of claim 1 , wherein the determined second distance (d 2 ) is based on the associated timing information and comprises a distance between a pair of nodes of the first materials handling vehicle and the second materials handling vehicle.

4. The relative pose determination system of claim 1 , each UWB antenna array further comprising four nodes on each of the second materials handling vehicle and the first materials handling vehicle.

5. The relative pose determination system of claim 4 , 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 a 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 and a relative offset of each UWB antenna to the center of the respective materials handling vehicle.

6. The relative pose determination system of claim 1 , wherein the first and second UWB antenna arrays comprise one or more nodes, each node comprising a UWB antenna arranged and positioned in the respective UWB antenna array and mounted on the vehicle body such that a 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.

7. The relative pose determination system of claim 6 , 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.

8. The relative pose determination system of claim 7 , 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.

9. The relative pose determination system of claim 7 , 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.

10. The relative pose determination system of claim 1 , the relative pose comprising a first vehicle pose and a second vehicle pose, the first vehicle pose comprising a pose of the first materials handling vehicle relative to the second materials handling vehicle based on at least the first materials handling vehicle set of information and relative coordinates of transmitting nodes of the each UWB antenna array of each vehicle, and the second vehicle pose comprising a pose of the second materials handling vehicle relative to the first materials handling vehicle based on at least the second materials handling vehicle set of information and the relative coordinates of transmitting nodes of the each UWB antenna array of each vehicle.

11. The relative pose determination system of claim 10 , wherein the first materials handling vehicle is configured to determine the second vehicle pose comprising the pose of the second materials handling vehicle relative to the first materials handling vehicle based on the second materials handling vehicle set of information transmitted with the second UWB signal, and the second materials handling vehicle is configured to determine the first vehicle pose comprising the pose of the first materials handling vehicle relative to the second materials handling vehicle based on the first materials handling vehicle set of information transmitted with the third UWB signal.

12. The relative pose determination system of claim 10 , wherein when each of the first and second materials handling vehicles are sensed to be constrained within

Assignees

• Crown Equip Corp

Inventors

• Estep Ryan
• Bennett Justin
• Ciholas Mike Etienne
• Morelli Ben
• Lefeld Chad
• Luthman Trisha Marie

Classifications

• G01C21/20

  Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence) · CPC title

• G05D1/692

  involving a plurality of disparate vehicles · CPC title

• G05D1/226 Primary

  Communication links with the remote-control arrangements · CPC title

• G05D1/693

  for avoiding collisions between vehicles · CPC title

• G05D1/24

  Arrangements for determining position or orientation · CPC title