Robot base path planning

Patent metadata

Field	Value
Publication number	US-12353801-B2
Application number	US-201816631388-A
Country	US
Kind code	B2
Filing date	Jul 16, 2018
Priority date	Jul 15, 2016
Publication date	Jul 8, 2025
Grant date	Jul 8, 2025

Abstract

A system for performing interactions within a physical environment including a robot base, a robot base actuator that moves the robot base relative to the environment, a robot arm mounted to the robot base, the robot arm including an end effector mounted thereon and a tracking system that measures a robot base position indicative of a position of the robot base relative to the environment. A control system acquires an indication of end effector destinations, determines a robot base position, calculates a robot base path extending from the robot base position in accordance with the end effector destinations to allow continuous movement of the robot base along the robot base path in accordance with a defined robot base path velocity profile and uses the robot base path to cause the robot base to be moved along the robot base path in accordance with the robot base path velocity profile.

First claim

The invention claimed is:

1. A system for performing interactions within a physical environment, the system including:
a) a robot base being mounted on a boom;
b) a robot base actuator that moves the robot base relative to the environment;
c) a robot arm mounted to the robot base, the robot arm including an end effector mounted thereon;
d) a tracking system that measures a robot base position indicative of a position of the robot base relative to the environment; and
e) a control system that:
i) acquires an indication of a plurality of end effector destinations, wherein each of the end effector destinations are a static point relative to the environment;
ii) calculates an end effector path extending along the plurality of end effector destinations;
iii) determines the robot base position at least in part using signals from the tracking system;
iv) calculates a plurality of robot base destinations, wherein each of the plurality of robot base destinations is offset from a corresponding one of the end effector destinations;
v) calculates a robot base path offset from the end effector path and extending from the robot base position along the plurality of robot base destinations, the robot base path being configured to allow continuous movement of the robot base along the robot base path past multiple end effector destinations in accordance with a defined robot base path velocity profile;
vi) generates robot base control signals based on the robot base path; and
vii) applies the robot base control signals to the robot base actuator to cause the robot base to be moved along the robot base path in accordance with the robot base path velocity profile.

2. The system according to claim 1 , wherein, at least one of:
a) the robot base path does not include any discontinuities; and
b) robot base path velocity profile does not include any discontinuous velocity changes.

3. The system according to claim 1 , wherein, after an interaction has been performed, the control system:
a) acquires an indication of a next plurality of end effector destinations;
b) determines a robot base position at least in part using signals from the tracking system; and
c) calculates an updated robot base path.

4. The system according to claim 1 , wherein, to calculate the robot base path, the control system:
a) calculates robot base path segments interconnecting the plurality of robot base destinations;
b) interconnects the robot base path segments; and
c) performs smoothing of the interconnected robot base path segments.

5. The system according to claim 4 , wherein the control system is configured to determine the offset between the plurality of robot base destinations and the plurality of end effector destinations so at the calculated robot base path passes within a set distance of each end effector destination.

6. The system according to claim 1 , wherein the control system:
a) calculates robot base path velocities for a plurality of path segments; and
b) performs smoothing of the robot base path velocities to generate the robot base velocity profile.

7. The system according to claim 1 , wherein an interaction performed by the system involves moving the end effector along the end effector path and wherein the control system calculates the robot base path in accordance with at least one of:
a) an end effector path length;
b) an end effector velocity profile associated with the end effector path;
c) robot arm kinematics;
d) robot arm dynamics;
e) robot base actuator kinematics; and
f) robot base actuator dynamics.

8. The system according to claim 1 , wherein the control system:
a) determines interaction dependencies; and
b) calculates the robot base path at least in part in accordance with the interaction dependencies.

9. The system according to claim 1 , wherein the control system:
a) determines an interaction time indicative of a time to perform an interaction; and,
b) uses the interaction time to at least one of:
i) calculate the robot base path velocity profile; and
ii) define an interaction window at least in part using the interaction time.

10. The system according to claim 1 , wherein the control system:
a) defines an interaction window extending a set distance from one of the plurality end effector destinations or one of the plurality of robot base destinations; and
b) determines the robot base path at least in part using the interaction window.

11. The system according to claim 10 , wherein the control system:
a) determines if adjacent interaction windows overlap; and
b) at least one of:
i) modifies at least one of the overlapping interaction windows; and
ii) alters an end effector destination or robot base destination order.

12. The system according to claim 11 , wherein the control system:
a) determines interaction dependencies; and
b) alters at least one of the plurality of end effector destinations or an order of one or more of the plurality of robot base destinations in accordance with the interaction dependencies.

13. The system according to claim 1 , wherein the control system:
a) monitors end effector interaction; and
b) selectively modifies the robot base control signals to cause the robot base to move at a robot base velocity below the robot base path velocity, depending on results of the monitoring.

14. The system according to claim 1 , wherein the robot base path includes an interaction window associated with one or more of the plurality of end effector destinations or one or more of the plurality of robot base destinations, and wherein at least one of:
a) as the robot base enters an interaction window, the control system controls the robot arm to commence at least one of:
i) an interaction; and
ii) movement of the end effector along the end effector path to one or more of the plurality of end effector destinations;

b) the control system monitors interaction by determining if the interaction will be completed by the time the robot base approaches an exit to an interaction window; and,
c) the control system progressively reduces the robot base velocity to ensure the interaction is completed by the time the robot base reaches an exit to the interaction window.

15. The system according to claim 1 , wherein an interaction performed by the system includes a number of steps, and wherein the control system is configured to monitors the performance of the interaction by monitoring completion of steps.

16. The system according to claim 15 , wherein the control system:
a) determines an end effector path portion associated with a next step; and
b) generates control signals to move the end effector to thereby complete the next step.

17. A method to move a robot base relative to a physical environment with a robot base actuator, the robot base being mounted on a boom and having a robot arm including an end effector mounted thereon, and wherein a position of the robot base relative to the physical environment is determined by a tracking system, the method comprising:
a) acquiring an indication of a plurality of end effector destinations, wherein each of the end effector destinations are a static point relative to the environment;
b) calculating an end effector path extending along the plurality of end effector destinations:
c) determining a robot base position at least in part using signals from the tracking system;
d) calculating a plurality of robot base destinations, wherein each of the plurality of robot base destinations is offset from a corresponding one of the end effector destinations:
e) calculating a

Assignees

• Fastbrick Ip Pty Ltd

Inventors

• Pivac Mark Joseph
• Robertson James Gary

Classifications

• G05B19/416

  characterised by control of velocity, acceleration or deceleration (G05B19/19 takes precedence) · CPC title

• E04B2/04

  Walls having neither cavities between, nor in, the solid elements · CPC title

• B25J9/1697

  Vision controlled systems · CPC title

• B25J9/1679

  characterised by the tasks executed · CPC title

• G06F16/1734

  Details of monitoring file system events, e.g. by the use of hooks, filter drivers, logs · CPC title