Virtual robot base
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 tracking target position indicative of a position of a target mounted on the robot base. A control system acquires an indication of an end effector destination, determines a tracking target position at least in part using signals from the tracking system, determines a virtual robot base position offset from the robot base and calculates a robot base path extending from the virtual robot base position to the end effector destination, using this to control the robot base actuator to cause the robot base to be moved along the robot base path.
1. A system for performing interactions within a physical environment, the system including:
a) a robot base;
b) a robot base actuator that moves the robot base relative to the environment, wherein the robot base actuator includes a boom mounted to a boom base, and wherein the robot base is mounted to the boom;
c) a robot arm mounted to the robot base, wherein the robot base is positioned between the robot arm and the boom, and wherein the robot arm includes an end effector mounted thereon;
d) a tracking system that measures a target position indicative of a position of a target relative to the environment, the target being mounted on the robot base; and
e) a control system that:
i) acquires an indication of an end effector destination defined relative to an environment coordinate system;
ii) determines the target position at least in part using signals from the tracking system;
iii) determines a virtual robot base position in a robot base actuator coordinate system offset from the robot base by transforming the target position to the virtual robot base position that is defined at least partially in accordance with an end effector position;
iv) transforms the end effector destination into the robot base actuator coordinate system using the target position;
v) calculates a robot base path in the robot base actuator coordinate system extending from the virtual robot base position to the end effector destination;
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.
2. A system according to claim 1 , wherein the virtual robot base position is coincident with a reference end effector position, the reference end effector position being at least one of:
a) an operative position indicative of a position of the end effector when performing an interaction in the environment;
b) a pre-operative position indicative of a position of the end effector prior to commencing an interaction in the environment; and
c) a default position indicative of a position of the end effector following performing an interaction in the environment.
3. A system according to claim 1 , wherein the boom is attached to a vehicle, and wherein the virtual robot base position is offset from the robot base to allow the vehicle to be provided in different positions relative to the environment.
4. A system according to claim 1 , wherein the control system:
a) calculates an end effector path extending to the end effector destination;
b) generates robot control signals based on the end effector path; and
c) applies the robot control signals to the robot arm to cause the end effector to be moved in accordance with the end effector path.
5. A system according to claim 4 , wherein the control system:
a) determines a current robot base position using signals from the tracking system; and
b) generates robot control signals based on the end effector path and the current robot base position.
6. A system according to claim 4 , wherein the control system calculates the end effector path in at least one of:
a) the environment coordinate system; and
b) the robot base coordinate system.
7. A system according to claim 4 , wherein the control system repeatedly:
a) calculates a robot base deviation based on the robot base position and an expected robot base position;
b) calculates a correction based on the robot base deviation, the correction being indicative of a path modification; and
c) generates control signals in accordance with the correction.
8. A system according to claim 4 , wherein the control system:
a) calculates robot arm kinematics using a current robot base position and the end effector path; and
b) generates robot control signals based on the end effector path and the calculated robot arm kinematics.
9. A system according to claim 8 , wherein the current robot base position is indicative of an origin point of the robot arm kinematics and the robot base position is determined in an environment coordinate system thereby allowing the robot arm to be controlled in the environment coordinate system.
10. A system according to claim 4 , wherein the control system repeatedly:
a) calculates the end effector path based on the current robot base position; and
b) generates robot control signals based on the end effector path.
11. A system according to claim 4 , wherein the control system calculates the end effector path at least in part using a reference robot base position indicative of at least one of:
a) a current robot base position;
b) a predicted robot base position based on movement of the robot base from a current robot base position;
c) a predicted robot base position based on movement of the robot base along the robot base path; and
d) an intended robot base position when end effector reaches the end effector destination.
12. A system according to claim 1 , wherein the control system:
a) acquires an indication of a plurality of end effector destinations including the end effector destination;
b) determines a robot base position at least in part using signals from the tracking system;
c) calculates the robot base path extending from the robot base position in accordance with the end effector destinations, the robot base path being configured to allow continuous movement of the robot base along the robot base path in accordance with a defined robot base path velocity profile;
d) generates robot base control signals based on the robot base path; and
e) 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.
13. A system according to claim 12 , 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 profile, depending on results of the monitoring.
14. A system according to claim 12 , wherein the robot base path includes an interaction window associated with each end effector destination, and wherein as the robot base enters an interaction window, the control system:
a) controls the robot arm to commence at least one of:
i) interaction; and
ii) movement of the end effector along an end effector path to the end effector destination;
b) 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) 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. A system according to claim 1 , wherein the system includes:
a) a first tracking system that measures a robot base position indicative of a position of the robot base relative to the environment; and
b) a second tracking system that measures movement of the robot base, and wherein the control system:
i) determines the robot base position at least in part using signals from the first tracking system; and
ii) in the event of failure of the first tracking system:
(1) determines a robot base position using signals from the second tracking system; and
(2) controls the robot arm to move the end effector along the end effector path at a reduced end effector speed.
16. A method for performing interactions within a physical environment using system including:
a) a robot base;
b) a robot base actuator that moves the robot base relative to the environment, wherein the robot base actuator includes a boom mounted to a boom base, and wherein the robot base is mounted to the boom;
c) a robot arm mounted to the robot base, wherein the robot base is positioned between the robot arm and the boom, and wherein the robot arm includes an end effector mounted thereon; and
d) a tracking system that measures a target position indicative of a position of a target relative to the environment, the target being mounted on the robot base, and wherein the method includes, in a control system:
i) acquiring an indication of an end effector destination defined relative to an environment coordinate system;
ii) determining the target position at least in part using signals from the tracking system;
iii) determining a virtual robot base position in a robot base actuator coordinate system offset from the robot base by transforming the target position to the virtual robot base position that is defined at least partially in accordance with an end effector position;
iv) transforming the end effector destination into the robot base actuator coordinate system using the target position:
v) calculating a robot base path in the robot base actuator coordinate system extending from the virtual robot base position to the end effector destination;
vi) generating robot base control signals based on the robot base path; and
vii) applying the robot base control signals to the robot base actuator to cause the robot base to be moved along the robot base path.