Systems and methods for dynamic route planning in autonomous navigation
원문보기
IPC분류정보
국가/구분
United States(US) Patent
등록
국제특허분류(IPC7판)
G05D-001/02
G05D-001/00
G01C-021/34
A47L-011/40
출원번호
US-0341612
(2016-11-02)
등록번호
US-10001780
(2018-06-19)
발명자
/ 주소
Gabardos, Borja Ibarz
Passot, Jean-Baptiste
출원인 / 주소
Brain Corporation
대리인 / 주소
Gazdzinski & Associates, PC
인용정보
피인용 횟수 :
0인용 특허 :
55
초록▼
Systems and methods for dynamic route planning in autonomous navigation are disclosed. In some exemplary implementations, a robot can have one or more sensors configured to collect data about an environment including detected points on one or more objects in the environment. The robot can then plan
Systems and methods for dynamic route planning in autonomous navigation are disclosed. In some exemplary implementations, a robot can have one or more sensors configured to collect data about an environment including detected points on one or more objects in the environment. The robot can then plan a route in the environment, where the route can comprise one or more route poses. The route poses can include a footprint indicative at least in part of a pose, size, and shape of the robot along the route. Each route pose can have a plurality of points therein. Based on forces exerted on the points of each route pose by other route poses, objects in the environment, and others, each route pose can reposition. Based at least in part on interpolation performed on the route poses (some of which may be repositioned), the robot can dynamically route.
대표청구항▼
1. A robot comprising: one or more sensors configured to collect data about an environment including detected points on one or more objects in the environment; anda controller configured to: create a map of the environment based at least in part on the collected data;determine a route in the map in
1. A robot comprising: one or more sensors configured to collect data about an environment including detected points on one or more objects in the environment; anda controller configured to: create a map of the environment based at least in part on the collected data;determine a route in the map in which the robot will travel;generate one or more route poses on the route, wherein each route pose comprises a footprint indicative of poses of the robot along the route and each route pose has a plurality of points disposed therein;determine forces on each of the plurality of points of each route pose, the forces comprising repulsive forces from one or more of the detected points on the one or more objects and attractive forces from one or more of the plurality of points on others of the one or more route poses;reposition one or more route poses in response to the forces on each point of the one or more route poses; andperform interpolation between one or more route poses to generate a collision-free path between the one or more route poses for the robot to travel. 2. The robot of claim 1, wherein: the one or more route poses form a sequence in which the robot travels along the route; andthe interpolation comprises a linear interpolation between sequential ones of the one or more route poses. 3. The robot of claim 1, wherein the interpolation generates one or more interpolation route poses having substantially similar footprints to the footprint of each route pose. 4. The robot of claim 1, wherein the determination of the forces on each point of the one or more route poses further comprises a computation of a force function that associates, at least in part, the forces on each point of each route pose with one or more characteristics of objects in the environment. 5. The robot of claim 4, wherein the one or more characteristics includes one or more of distance, shape, material, and color. 6. The robot of claim 4, wherein: the force function associates zero repulsive force exerted by a first detected point on a first object where a distance between the first detected point and a second point of a first route pose is above a predetermined distance threshold. 7. The robot of claim 1, wherein the footprint of each route pose has substantially similar size and shape as the footprint of the robot. 8. The robot of claim 1, wherein the robot comprises a floor cleaner. 9. A method for dynamic navigation of a robot in an environment, comprising: generating a map of the environment using data from one or more sensors;determining a route on the map, the route including one or more route poses, each route pose comprising a footprint indicative at least in part of a pose and a shape of the robot along the route and each route pose having a plurality of points disposed therein;computing repulsive forces from a point on an object in the environment onto the plurality of points of a first route pose of the one or more route poses;repositioning the first route pose in response to at least the repulsive forces; andperforming an interpolation between the repositioned first route pose and another of the one or more route poses. 10. The method of claim 9, further comprising determining attractive forces from a point on another of the one or more route poses exerted on the plurality of points of the first route pose. 11. The method of claim 9, further comprising: detecting a plurality of objects in the environment with the one or more sensors, each of the plurality of objects having detected points; anddefining a force function, the force function computing repulsive forces exerted by each of the detected points of the plurality of objects on the plurality of points of the first route pose, wherein each repulsive force comprises a vector. 12. The method of claim 11, wherein the repositioning of the first route pose comprises calculating a minimum of the force function. 13. The method of claim 9, wherein the repositioning of the first route pose comprises translating and rotating the first route pose. 14. The method of claim 9, wherein the performing of the interpolation comprises: generating an interpolation route pose having a footprint substantially similar to the shape of the robot; anddetermining a translation and rotation of the interpolation route pose based at least on a collision-free path between the translated and rotated first route pose and the another of the one or more route poses. 15. The method of claim 9, further comprising computing a magnitude of the repulsive forces as proportional to a distance between the point on the object and each of the plurality of points of the first route pose if the point on the object is outside of the footprint of the first route pose. 16. The method of claim 9, further comprising computing a magnitude of the repulsive forces as inversely proportional to a distance between the point on the object and each of the plurality of points of the first route pose if the point on the object is inside the footprint of the first route pose. 17. The method of claim 9, further comprising computing torque forces onto the plurality of points of the first route pose due to the repulsive forces. 18. A non-transitory computer-readable storage apparatus having a plurality of instructions stored thereon, the instructions being executable by a processing apparatus to operate a robot, the instructions configured to, when executed by the processing apparatus, cause the processing apparatus to: generate a map of an environment using data from one or more sensors;determine a route on the map, the route comprising one or more route poses, each route pose comprising a footprint indicative at least in part of a pose and a shape of the robot along the route and each route pose having a plurality of points disposed therein; andcompute repulsive forces from a point on an object in the environment onto the plurality of points of a first route pose of the one or more route poses. 19. The non-transitory computer-readable storage apparatus of claim 18, further comprising one or more instructions, which when executed by the processing apparatus, further cause the processing apparatus to determine attractive forces from a point on another of the one or more route poses exerted on the plurality of points of the first route pose. 20. The non-transitory computer-readable storage apparatus of claim 18, further comprising one or more instructions, which when executed by the processing apparatus, further cause the processing apparatus to determine torque forces from a point on another of the one or more route poses exerted on the plurality of points of the first route pose.
연구과제 타임라인
LOADING...
LOADING...
LOADING...
LOADING...
LOADING...
이 특허에 인용된 특허 (55)
Werbos Paul J., 3-brain architecture for an intelligent decision and control system.
Kerr Randal H. (Richford NY) Mesnard Robert M. (Endicott NY), Automatic generation of executable computer code which commands another program to perform a task and operator modificat.
Spoerre Julie K. (Tallahassee FL) Lin Chang-Ching (Tallahassee FL) Wang Hsu-Pin (Tallahassee FL), Machine performance monitoring and fault classification using an exponentially weighted moving average scheme.
Grossberg Stephen (Newton Highlands MA) Kuperstein Michael (Brookline MA), Massively parellel real-time network architectures for robots capable of self-calibrating their operating parameters thr.
Abdallah, Muhammad E; Platt, Robert; Wampler, II, Charles W.; Reiland, Matthew J; Sanders, Adam M, Method and apparatus for automatic control of a humanoid robot.
Pryor Timothy R. (all Windsor CAX) Hockley Bernard (all Windsor CAX) Liptay-Wagner Nick (all Windsor CAX) Hageniers Omer L. (all Windsor CAX) Pastorius W. J. (all Windsor CAX), Method and apparatus utilizing an orientation code for automatically guiding a robot.
Hillman, Jr., Henry L.; Knuth, Jr., David M.; Daly, Daniel M.; Coffman, Vinton; McCann, Ralph; Herr, Stephen D.; Thomas, Kevin L., Methods and systems for movement of an automatic cleaning device using video signal.
Hillman, Jr., Henry L.; Knuth, Jr., David M.; Daly, Daniel M.; Coffman, Vinton; McCann, Ralph; Herr, Stephen D.; Thomas, Kevin L., Methods and systems for movement of robotic device using video signal.
Yokono, Jun; Sabe, Kohtaro; Costa, Gabriel; Ohashi, Takeshi, Operational control method, program, and recording media for robot device, and robot device.
Hickman, Ryan; Kuffner, Jr., James J.; Bruce, James R.; Gharpure, Chaitanya; Kohler, Damon; Poursohi, Arshan; Francis, Jr., Anthony G.; Lewis, Thor, Shared robot knowledge base for use with cloud computing system.
Shaffer Gary K. (Butler PA) Whittaker William L. (Pittsburgh PA) West Jay H. (Pittsburgh PA) Clow Richard G. (Phoenix AZ) Singh Sanjiv J. (Pittsburgh PA) Lay Norman K. (Peoria IL) Devier Lonnie J. (P, System and method for detecting obstacles in the path of a vehicle.
Boyles, Tonnie Michael; Hillyer, Matthew Craig; Benady, Meny; Dagan, Erez; Gdalyahu, Yoram; Herzberg, Eran, Systems and methods for detecting pedestrians in the vicinity of a powered industrial vehicle.
Blumberg, Bruce; Brooks, Rodney; Buehler, Christopher J.; Deegan, Patrick A.; DiCicco, Matthew; Dye, Noelle; Ens, Gerry; Linder, Natan; Siracusa, Michael; Sussman, Michael; Williamson, Matthew M., Training and operating industrial robots.
Mochizuki, Yoshiyuki; Naka, Toshiya; Asahara, Shigeo, Virtual space control data receiving apparatus,virtual space control data transmission and reception system, virtual space control data receiving method, and virtual space control data receiving prog.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.