IP Library Granted Patent US 12,397,434
Granted Patent B2
US 12,397,434 · App. 18/740,527 · Granted Aug 26, 2025

Safe motion planning for machinery operation

Inventors: Clara Vu (Cambridge, MA); Scott Denenberg (Newton, MA); Patrick Sobalvarro (Harvard, MA); Alberto Moel (Cambridge, MA)
Assignee: Symbotic LLC
B25J9/1694B25J9/1666B25J9/1676B25J9/1697G01S7/4808G01S17/04G01S17/87G01S17/89G06T17/10G01V8/20G05B2219/40202G06T17/05Y10S901/47Y10S901/49
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 12,397,434
App. No.
18/740,527
Granted
Aug 26, 2025
Kind
B2
Abstract

A method of safely operating machinery in a workspace includes recording images of a portion of a workspace. The method also includes generating a three-dimensional (3D) representation of the portion of the workspace based on the recorded images, where the 3D representation includes one or more volumes that correspond to the portion of the workspace. Additionally, the method includes identifying one or more of the volumes as being either occupied or unoccupied. Further, the method includes mapping one or more safe zones based on the one or more identified volumes, where the safe zones correspond to one or more regions within the portion of the workspace for safe operation of machinery.

Claims (49)

1. A method of safely operating machinery in a workspace, the method comprising:

recording images of a portion of a workspace;

generating a 3D representation of the portion of the workspace based on the recorded images, wherein the 3D representation comprises one or more volumes that correspond to the portion of the workspace;

identifying one or more of the volumes as being either occupied or unoccupied; and

mapping one or more safe zones based on the one or more identified volumes, wherein the safe zones correspond to one or more regions within the portion of the workspace for safe operation of machinery.

2. The method of claim 1 , wherein a particular safe zone of the one or more safe zones is detected based on user input.

3. The method of claim 2 , wherein:

recording images of the portion of the workspace comprises using a sensor associated with a grid of pixels configured to capture the recorded images, wherein the portion of the workspace is within a field of view of the sensor; and

the particular safe zone is disposed outside the sensor field of view.

4. The method of claim 2 , wherein:

recording images of the portion of the workspace comprises using a sensor associated with a grid of pixels configured to capture the recorded images, wherein the portion of the workspace is within a field of view of the sensor; and

the user input overrides a mapping based on images recorded by the sensor.

5. The method of claim 1 , wherein:

recording images of the portion of the workspace comprises using a sensor associated with a grid of pixels configured to capture the recorded images, wherein the portion of the workspace is within a field of view of the sensor; and

identifying a particular volume of the one or more volumes as occupied comprises receiving light via the sensor, wherein the light is reflected from an object disposed in the particular volume, and an intensity of the reflected light is higher than a predetermined threshold.

6. The method of claim 1 , wherein:

recording images of the portion of the workspace comprises using a sensor associated with a grid of pixels configured to capture the recorded images, wherein the portion of the workspace is within a field of view of the sensor; and

one or more objects within the sensor field of view are insufficiently reflective to reflect to the sensor light with an intensity higher than a predetermined threshold.

7. The method of claim 1 , further comprising associating the one or more safe zones with a safety criterion.

8. The method of claim 7 , wherein the safety criterion corresponds to a minimum distance from a piece of the machinery.

9. The method of claim 1 , wherein the one or more safe zones include only volumes of the one or more volumes that have been identified as unoccupied.

10. The method of claim 1 , further comprising, based on the recorded images, identifying a workpiece or an element of the machinery using a neural network.

11. The method of claim 1 , wherein:

recording images of the portion of the workspace comprises using a sensor associated with a grid of pixels configured to capture the recorded images, wherein the portion of the workspace is within a field of view of the sensor; and

identifying one or more of the volumes as being occupied or unoccupied comprises (i) detecting an occlusion in the sensor field of view, (ii) classifying volumes associated with the occlusion as occupied volumes, and (iii) classifying volumes between the sensor and the occupied volumes as unoccupied volumes.

12. The method of claim 1 , wherein:

recording images of the portion of the workspace comprises using a sensor associated with a grid of pixels configured to capture the recorded images, wherein the portion of the workspace is within a field of view of the sensor; and

the sensor comprises at least one of (i) a time-of-flight sensor, (ii) a 3D LIDAR sensor, or (iii) a stereo vision camera.

13. The method of claim 1 , further comprising:

recording images of another portion of a workspace;

generating another 3D representation of the other portion of the workspace based on the recorded images, wherein the other 3D representation comprises one or more other volumes that correspond to the other portion of the workspace; and

identifying one or more of the other volumes as being either occupied or unoccupied.

14. The method of claim 1 , further comprising:

receiving a task specification; and

generating a motion plan comprising a trajectory of the machinery for performing a specified task within the one or more safe zones.

15. The method of claim 14 , further comprising:

recording images of another portion of a workspace;

generating another 3D representation of the other portion of the workspace based on the recorded images, wherein the other 3D representation comprises one or more other volumes that correspond to the other portion of the workspace; and

identifying one or more of the other volumes as being either occupied or unoccupied;

wherein mapping the one or more safe zones is further based on the one or more identified other volumes.

16. The method of claim 14 , further comprising operating the machinery in accordance with the motion plan.

17. The method of claim 14 , wherein:

the motion plan comprises a plurality of trajectories of the machinery; and

the method further comprises (i) assigning a respective cost value to each of the trajectories, (ii) selecting one of the trajectories based at least in part on the respective cost value assigned to each of the trajectories, and (iii) causing the machinery to execute the selected trajectory.

18. The method of claim 17 , wherein the respective cost value associated with each of the trajectories is assigned based at least in part on (i) a length of the trajectory, (ii) an operation time of the machinery on the trajectory, or (iii) allowed kinematics of the trajectory.

19. The method of claim 14 , wherein the motion plan precludes entry into a zone outside the one or more safe zones by the machinery and any workpiece associated with the machinery or the task.

20. The method of claim 14 , further comprising:

monitoring the workspace in real-time; and

altering the motion plan in response to a change in the one or more safe zones.

Assignments (2)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Sep 10, 2024
From: VU, CLARA; DENENBERG, SCOTT; SOBALVARRO, PATRICK; MOEL, ALBERTO
To: VEO ROBOTICS, INC.
Reel/Frame 068542/0801 →
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Sep 4, 2024
From: VEO ROBOTICS, INC.
To: SYMBOTIC LLC
Reel/Frame 068839/0710 →
Continuity (7)
Continuation 18479933 · Oct 3, 2023
Continuation In Part 17101622 · Nov 23, 2020
Continuation 16129999 · Sep 13, 2018
Continuation 15889523 · Feb 6, 2018
Provisional Application 62455834 · Feb 7, 2017
Provisional Application 62455828 · Feb 7, 2017
Related Publication 20240326253A1 · Oct 3, 2024
References Cited (100)
US 6212444B1 · Kato et al. · 2001 [cited by applicant]
US 6297844B1 · Schatz et al. · 2001 [cited by applicant]
US 6816755B2 · Habibi et al. · 2004 [cited by applicant]
US 7336814B2 · Boca et al. · 2008 [cited by applicant]
US 8154590B2 · Krissel et al. · 2012 [cited by applicant]
US 8253792B2 · Wells et al. · 2012 [cited by applicant]
US 8437535B2 · Boca et al. · 2013 [cited by applicant]
US 8556999B2 · Boca · 2013 [cited by applicant]
US 8700197B2 · Plociennik et al. · 2014 [cited by applicant]
US 8914152B2 · Scheurer et al. · 2014 [cited by applicant]
US 9043025B2 · Brooks et al. · 2015 [cited by applicant]
US 9122266B2 · Franke et al. · 2015 [cited by applicant]
US 9240070B2 · Anderson-Sprecher et al. · 2016 [cited by applicant]
US 9283678B2 · Kuttner, Jr. et al. · 2016 [cited by applicant]
US 9452531B2 · Kikkeri et al. · 2016 [cited by applicant]
US 9692251B2 · Anderson-Sprecher et al. · 2017 [cited by applicant]
US 9734401B2 · Hunt · 2017 [cited by applicant]
US 9740193B2 · Hunt · 2017 [cited by applicant]
US 9757859B1 · Kolb · 2017 [cited by examiner]
US 9827681B2 · Naitou et al. · 2017 [cited by applicant]
US 10078333B1 · Bajracharya · 2018 [cited by examiner]
US 10150213B1 · Linnell · 2018 [cited by examiner]
US 11820025B2 · Vu · 2023 [cited by examiner]
US 12036683B2 · Vu · 2024 [cited by examiner]
US 20050207618A1 · Wohler et al. · 2005 [cited by applicant]
US 20080021597A1 · Merte et al. · 2008 [cited by applicant]
US 20080152192A1 · Zhu et al. · 2008 [cited by applicant]
US 20090015663A1 · Doettling et al. · 2009 [cited by applicant]
US 20110264266A1 · Kock · 2011 [cited by applicant]
US 20120022689A1 · Kapoor · 2012 [cited by applicant]
US 20120307067A1 · Chen et al. · 2012 [cited by applicant]
US 20130201292A1 · Walter et al. · 2013 [cited by applicant]
US 20130211766A1 · Rosenberg et al. · 2013 [cited by applicant]
US 20140093130A1 · Dasu et al. · 2014 [cited by applicant]
US 20140188274A1 · Namiki · 2014 [cited by applicant]
US 20140267266A1 · Crassin et al. · 2014 [cited by applicant]
US 20140288710A1 · Ikenaga et al. · 2014 [cited by applicant]
US 20150049911A1 · Doettling et al. · 2015 [cited by applicant]
US 20150199840A1 · Hatanaka · 2015 [cited by examiner]
US 20150217455A1 · Kikkeri et al. · 2015 [cited by applicant]
US 20150269427A1 · Kim et al. · 2015 [cited by applicant]
US 20150287196A1 · De Villiers et al. · 2015 [cited by applicant]
US 20150293600A1 · Sears · 2015 [cited by applicant]
US 20150294496A1 · Medasani et al. · 2015 [cited by applicant]
US 20160092739A1 · Oami et al. · 2016 [cited by applicant]
US 20160188977A1 · Kearns · 2016 [cited by applicant]
US 20160282126A1 · Watts et al. · 2016 [cited by applicant]
US 20160354927A1 · Kikkeri et al. · 2016 [cited by applicant]
US 20170057095A1 · Oestergaard et al. · 2017 [cited by applicant]
US 20170101278A1 · Stone et al. · 2017 [cited by applicant]
US 20170113352A1 · Lutz · 2017 [cited by applicant]
US 20170151676A1 · Atherton et al. · 2017 [cited by applicant]
US 20170249129A1 · McDaniel · 2017 [cited by applicant]
US 20170292836A1 · Jai et al. · 2017 [cited by applicant]
US 20170302905A1 · Shteinfeld et al. · 2017 [cited by applicant]
US 20170334063A1 · Komatsuzaki et al. · 2017 [cited by applicant]
US 20170334066A1 · Levine et al. · 2017 [cited by applicant]
US 20170334076A1 · Bordegnoni et al. · 2017 [cited by applicant]
US 20170341231A1 · Tan et al. · 2017 [cited by applicant]
US 20170355079A1 · Takahashi · 2017 [cited by applicant]
US 20180120804A1 · Higuchi et al. · 2018 [cited by applicant]
US 20180318704A1 · Ikenoue et al. · 2018 [cited by applicant]
US 20190061158A1 · Vu et al. · 2019 [cited by applicant]
CN 103582851A · 2014 [cited by applicant]
CN 104870147A · 2015 [cited by applicant]
CN 104933392A · 2015 [cited by applicant]
CN 110494900A · 2018 [cited by applicant]
EP 324874 · 2017 [cited by applicant]
JP 2010208002A · 2010 [cited by applicant]
WO WO2016122840 · 2016 [cited by applicant]
WO WO2017199261 · 2017 [cited by applicant]
WO WO2017203937 · 2017 [cited by applicant]
WO WO2017207436 · 2017 [cited by applicant]
Slembrouck et al., “Self-Learning voxel-based multi-camera occlusion maps for 3D reconstruction,” 2014 International Conference on Computer Vision Theory and Applications (VISAPP), vol. 2, pp. 502-509, https://ieeexplor… [cited by applicant]
Hansung et al., “Robust Foreground Segmentation from Color Video Sequences Using Background Subtraction with Multiple Thresholds,” Proc. KJPR, https://www.researchgate.net/publication/228950411_Robust_Foreground_Segment… [cited by applicant]
Cheung et al, “A Real Time Systems for Robust 3D Voxel Reconstruction of Human Motions”, Proceeding IEEE Conference on Computer Vision and Pattern Recognition, vol. 2, pp. 714-720, https://ieeexplore.ieee.org/document/8… [cited by applicant]
European Search Report, European Patent Application No. 22182665.4, dated Oct. 10, 2022, 9 pages. [cited by applicant]
International Search Report, for International Application No. PCT/US2018/016991, dated May 16, 2018, 12 pages. [cited by applicant]
Anandan, Tanya M. “The Shrinking Footprint of Robot Safety,” Robotics Online, Oct. 6, 2014, 9 pages. [cited by applicant]
Anandan, Tanya M., “The End of Separation: Man and Robot as Collaborative Coworkers on the Factory Floor,” Robotics Online, Jun. 6, 2013, 8 pages. [cited by applicant]
Cui, et al., “Robotics Safety: An Engineering Teaching Module,” University of Ontario, Institute of Technology, Minerva Canada, Mar. 2014, 39 pages. [cited by applicant]
Fretzner, et al., “Obstacle Detection and Tracking for Safe Human-Robot Interaction Based on Multi-Sensory Point Clouds”. [cited by applicant]
Flacco, et al., “A Depth Space Approach to Human-Robot Collision Avoidance,” 2012 IEEE International Conference Jn Robotics and Automation, May 14-18, 2012, 8 pages. [cited by applicant]
Frank, Rudiger, Dr., “Modular Sensor System for Safe Robots”, hllps://www.automalion.com/automation-news/article/ modular-sensor-system-for-safe-robots, Nov. 25, 2017, 14 pages. [cited by applicant]
Frese, et al., “Multi-Sensor Obstacle Tracking for Safe Human-Robol Inleralion,” Fraunhofer Institute of Optronics, System Technologies and Image Explilalion IOSB, 2014, 8 pages. [cited by applicant]
Kock, et al., “Taming the robot,” Robotic Highlights, ABB Review, Apr. 2006, 4 pages. [cited by applicant]
Lacevic, et al., “Kinetostatic danger field—A novel safety assessment for human-robot interation,” ResearchGate, Jun. 9, 2016, 8 pages. [cited by applicant]
Lasota, et al., “A Survey of Methods for Safe Human-Robt Interation,” Foundations and Trends in Robotics, vol. 5, No. J (2014), 92 pages. [cited by applicant]
Lasota, et al., “Toward Safe Close-Proximity Human-Robot Interaction with Standard Industrial Robots,” IEEE, 2014, 7 pages. [cited by applicant]
Lenz, et al., “Fusing multiple Kinects to survey shared Human-Robot-Workspaces,” Robotics and Embedded Systems Department of Infonmatics Technische Universit at Munchen, 6 pages. [cited by applicant]
Murray, et al., “Robot Motion Planning on a Chip,” Departments of Computer Science and Electrical & Computer Engineering Duke University, 9 pages. [cited by applicant]
Pilz, GB, “Safe human-robot collaboration: from theory to practice,” hllps:/lwww.pilz.com/en-GB/company/news/article/084837. Aug. 6, 2015, 4 pages. [cited by applicant]
Rybski, et al., “Sensor Fusion for Human Safety in Industrial Workcells,” Carnegie Mellon University Research showcase@CMU, Oct. 2012, 9 pages. [cited by applicant]
ABB Robotics Produce Management, “SafeMove2,” Jul. 24, 2017, 25 pages. [cited by applicant]
ABB Robotics Produce Management, “SafeMove2 Protecting operators & enhancing robot safety”, abb.com/robotics, 2 pages. [cited by applicant]
Vogel, et al., “A Projection-based Sensor System for Safe Physical Human-Robot Collaboration,” 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Nov. 3-7, 2013, 6 pages. [cited by applicant]
Zanchettin, et al., “Safety in Human-Robot Collaborative Manufacturing Environments: Metrics and Control,” IEEE Transactions on Automation Science and Engineering, vol. 13, No. 2, Apr. 2016, 12 pages. [cited by applicant]
Christiernin, et al., “Safety Critical Robot Programming and Testing for Operations in Industrial Co-production,” IEEE International Symposium on Software Reliability Engineering Workshops, 2014, 4 pages. [cited by applicant]
Graham, et al., “A Sensory-Based Robotic Safety System,” IEE Proceedings, vol. 132, PID, No. 4, Jul. 1985, 7 pages. [cited by applicant]
Graham, et al., “A Safety and Collision Avoidance System for Industrial Robots,” IEEE Transactions on Industry Application, vol. IA-22, No. 1 Jan./Feb. 1986, 9 pages. [cited by applicant]