Tooltip stabilization
View Patent ↗Robotic control systems and methods may include providing an end effector tool of a robotic device configured to perform a task on a work surface within a worksite coordinate frame. Unintended movement over time of the end effector tool with respect to the work surface and with respect to the worksite coordinate frame may be determined based on image data indicative of the work surface, first location data indicative of a first location of the end effector tool with respect to the worksite coordinate frame, and second location data indicative of a second location of the end effector tool with respect to the work surface. One or more control signals for the robotic device may be adjusted in order to counteract the unintended movements of the end effector tool with respect to the work surface and worksite coordinate frame.
1. A computer-implemented method comprising:
receiving, from a robotic device that includes a sensor and an end effector tool, a location that is estimated for the end effector tool using sensor data that is generated by the sensor included on the robotic device;
receiving, from each of first and second global sensors that are not included on the robotic device, a location that is estimated for the end effector tool using sensor data that is generated by the global sensor;
determining an adjustment to apply to the end effector tool using (i) the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device, (ii) the location that is estimated for the end effector tool using the sensor data that is generated by the first global sensor, and (iii) the location that is estimated for the end effector tool using the sensor data that is generated by the second global sensor; and
providing, to the robotic device, an instruction to apply the adjustment to the end effector tool.
2. The method of claim 1 , wherein the sensor included on the robotic device has a higher refresh rate and a lower spatial accuracy than both the first and second global sensors.
3. The method of claim 2 , wherein the first global sensor has a higher refresh rate and a lower spatial accuracy than the second global sensor.
4. The method of claim 1 , wherein the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device is estimated using dead reckoning or optical flow.
5. The method of claim 1 , wherein the locations that are estimated for the end effector tool using sensor data that is generated by first and second global sensors comprise locations of the end effector tool with respect to a worksite coordinate frame.
6. The method of claim 1 , wherein the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device comprises a location of the end effector tool with respect to a work surface.
7. The method of claim 1 , wherein the first global sensor comprises a camera.
8. The method of claim 7 , wherein the second global sensor comprises a laser tracker.
9. The method of claim 1 , wherein the robotic device further includes markers for use by the second global sensor in generating the sensor data.
10. A system comprising:
one or more computers; and
a non-transitory computer-readable medium coupled to the one or more computers having instructions stored thereon which, when executed by the one or more computers, cause the one or more computers to perform operations comprising:
receiving, from a robotic device that includes a sensor and an end effector tool, a location that is estimated for the end effector tool using sensor data that is generated by the sensor included on the robotic device;
receiving, from each of first and second global sensors that are not included on the robotic device, a location that is estimated for the end effector tool using sensor data that is generated by the global sensor;
determining an adjustment to apply to the end effector tool using (i) the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device, (ii) the location that is estimated for the end effector tool using the sensor data that is generated by the first global sensor, and (iii) the location that is estimated for the end effector tool using the sensor data that is generated by the second global sensor; and
providing, to the robotic device, an instruction to apply the adjustment to the end effector tool.
11. The system of claim 10 , wherein the sensor included on the robotic device has a higher refresh rate and a lower spatial accuracy than both the first and second global sensors.
12. The system of claim 11 , wherein the first global sensor has a higher refresh rate and a lower spatial accuracy than the second global sensor.
13. The system of claim 10 , wherein the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device is estimated using dead reckoning or optical flow.
14. The system of claim 10 , wherein the locations that are estimated for the end effector tool using sensor data that is generated by first and second global sensors comprise locations of the end effector tool with respect to a worksite coordinate frame.
15. The system of claim 10 , wherein the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device comprises a location of the end effector tool with respect to a work surface.
16. The system of claim 10 , wherein the first global sensor comprises a camera.
17. The system of claim 16 , wherein the second global sensor comprises a laser tracker.
18. The system of claim 10 , wherein the robotic device further includes markers for use by the second global sensor in generating the sensor data.
19. A non-transitory computer storage medium encoded with a computer program, the computer program comprising instructions that when executed by one or more processors cause the one or more processors to perform operations comprising:
receiving, from a robotic device that includes a sensor and an end effector tool, a location that is estimated for the end effector tool using sensor data that is generated by the sensor included on the robotic device;
receiving, from each of first and second global sensors that are not included on the robotic device, a location that is estimated for the end effector tool using sensor data that is generated by the global sensor;
determining an adjustment to apply to the end effector tool using (i) the location that is estimated for the end effector tool using the sensor data that is generated by the sensor included on the robotic device, (ii) the location that is estimated for the end effector tool using the sensor data that is generated by the first global sensor, and (iii) the location that is estimated for the end effector tool using the sensor data that is generated by the second global sensor; and
providing, to the robotic device, an instruction to apply the adjustment to the end effector tool.
20. The medium of claim 19 , wherein:
the sensor included on the robotic device has a higher refresh rate and a lower spatial accuracy than both the first and second global sensors, and
the first global sensor has a higher refresh rate and a lower spatial accuracy than the second global sensor.