Real-time self collision and obstacle avoidance using weighting matrix
원문보기
IPC분류정보
국가/구분
United States(US) Patent
등록
국제특허분류(IPC7판)
G05B-019/04
G05B-019/18
출원번호
US-0258184
(2008-10-24)
등록번호
US-8396595
(2013-03-12)
발명자
/ 주소
Dariush, Behzad
출원인 / 주소
Honda Motor Co., Ltd.
대리인 / 주소
Fenwick & West LLP
인용정보
피인용 횟수 :
3인용 특허 :
29
초록▼
A system, method, and computer program product for avoiding collision of a body segment with other structures in an articulated system are described. According to one aspect, a collision function is determined for avoiding such collision. A distance between the body segment and one such structure is
A system, method, and computer program product for avoiding collision of a body segment with other structures in an articulated system are described. According to one aspect, a collision function is determined for avoiding such collision. A distance between the body segment and one such structure is measured. A weighting matrix is generated based on the collision function and the distance, and used to determine a redirected motion for the body segment. The body segment is redirected based on the redirected motion to avoid colliding with the structure.
대표청구항▼
1. A method for avoiding collision of a body segment in an articulated system, the method comprising: determining a collision function for avoiding collision between the body segment and other structures in the articulated system;measuring a distance between the body segment and a first structure, t
1. A method for avoiding collision of a body segment in an articulated system, the method comprising: determining a collision function for avoiding collision between the body segment and other structures in the articulated system;measuring a distance between the body segment and a first structure, the first structure being one of the other structures;determining a joint limit function for avoiding self collision between the body segment and the other structures in the articulated system;measuring a joint vector between the body segment and a second structure, the second structure being one of the other structures;generating, using a processor, a collision gradient weighting matrix based on the collision function and the measured distance;generating, using a processor, a joint limit gradient weighting matrix based on the joint limit function and the measured joint vector;generating a combined weighting matrix based on the collision gradient weighting matrix and the joint limit gradient weighting matrix;determining a redirected motion that prevents the body segment from colliding with the first structure based on the combined weighting matrix; andredirecting the body segment based on the redirected motion to avoid colliding with the first structure. 2. The method of claim 1, wherein the first structure is not directly connected with the body segment. 3. The method of claim 1, wherein the collision function comprises elements each representing a degree to which a corresponding degree of freedom influences the distance. 4. The method of claim 3, wherein the collision gradient weighting matrix comprises an n×n diagonal matrix with diagonal elements, the diagonal elements comprising elements of the collision function. 5. The method of claim 1, wherein the collision function has a maximum value when the distance equals zero and decays exponentially towards zero as the distance increases, and wherein the collision function has an adjustable parameter that affects a rate of decay. 6. The method of claim 1, wherein a value of the collision function varies depending upon the distance between the body segment and the first structure. 7. The method of claim 1, further comprising: receiving a motion descriptor;generating a joint variable based on the motion descriptor; andcontrolling motion of the body segment toward a target based on the joint variable,wherein determining the redirected motion comprises determining the redirected motion that directs the body segment towards the target while preventing the body segment from colliding with the first structure, andwherein redirecting the body segment further comprises redirecting the body segment toward the target without colliding with the first structure. 8. The method of claim 7, wherein the motion descriptor describes a human motion, the articulated system comprises a humanoid robot, and the joint variable controls the humanoid robot to simulate the human motion. 9. The method of claim 1, wherein redirecting the body segment further comprises: generating a redirected motion descriptor based on the redirected motion;generating a redirected joint variable based on the redirected motion descriptor; andredirecting the body segment based on the redirected joint variable to avoid colliding with the first structure. 10. The method of claim 1, wherein the combined weighting matrix is normalized by a total number of collision pairs in the articulated system. 11. The method of claim 1, wherein the redirected motion is calculated using a closed loop inverse kinematics (CLIK) algorithm. 12. A computer program product for avoiding collision of a body segment in an articulated system, the computer program product configured to be stored in a non-transitory computer-readable storage medium, the computer program product comprising executable computer program code for performing a method comprising: determining a collision function for avoiding collision between the body segment and other structures in the articulated system;measuring a distance between the body segment and a first structure, the first structure being one of the other structures;determining a joint limit function for avoiding self collision between the body segment and the other structures in the articulated system;measuring a joint vector between the body segment and a second structure, the second structure being one of the other structures;generating, using a processor, a collision gradient weighting matrix based on the collision function and the measured distance;generating, using a processor, a joint limit gradient weighting matrix based on the joint limit function and the measured joint vector;generating a combined weighting matrix based on the collision gradient weighting matrix and the joint limit gradient weighting matrix;determining a redirected motion that prevents the body segment from colliding with the first structure based on the combined weighting matrix; andredirecting the body segment based on the redirected motion to avoid colliding with the first structure. 13. The computer program product of claim 12, wherein the collision function comprises elements each representing a degree to which a corresponding degree of freedom influences the distance. 14. The computer program product of claim 13, wherein the collision gradient weighting matrix comprises an n×n diagonal matrix with diagonal elements, the diagonal elements comprising elements of the collision function. 15. The computer program product of claim 12, wherein the method further comprises: receiving a motion descriptor;generating a joint variable based on the motion descriptor; andcontrolling motion of the body segment toward a target based on the joint variable,wherein determining the redirected motion comprises determining the redirected motion that directs the body segment towards the target while preventing the body segment from colliding with the first structure, andwherein redirecting the body segment further comprises redirecting the body segment toward the target without colliding with the first structure. 16. A system for avoiding collision of a body segment in an articulated system, the system comprising: a computer processor for executing executable computer program code;a computer-readable storage medium containing the executable computer program code for performing a method comprising: determining a collision function for avoiding collision between the body segment and other structures in the articulated system;measuring a distance between the body segment and a first structure, the first structure being one of the other structures;determining a joint limit function for avoiding self collision between the body segment and the other structures in the articulated system;measuring a joint vector between the body segment and a second structure, the second structure being one of the other structures;generating, using a processor, a collision gradient weighting matrix based on the collision function and the measured distance;generating, using a processor, a joint limit gradient weighting matrix based on the joint limit function and the measured joint vector;generating a combined weighting matrix based on the collision gradient weighting matrix and the joint limit gradient weighting matrix;determining a redirected motion that prevents the body segment from colliding with the first structure based on the combined weighting matrix; andredirecting the body segment based on the redirected motion to avoid colliding with the first structure. 17. The system of claim 16, wherein the collision function comprises elements each representing a degree to which a corresponding degree of freedom influences the distance. 18. The system of claim 17, wherein the collision gradient weighting matrix comprises an n×n diagonal matrix with diagonal elements, the diagonal elements comprising elements of the collision function. 19. The system of claim 16, wherein the method further comprises: receiving a motion descriptor;generating a joint variable based on the motion descriptor; andcontrolling motion of the body segment toward a target based on the joint variable,wherein determining the redirected motion comprises determining the redirected motion that directs the body segment towards the target while preventing the body segment from colliding with the first structure, andwherein redirecting the body segment further comprises redirecting the body segment toward the target without colliding with the first structure.
연구과제 타임라인
LOADING...
LOADING...
LOADING...
LOADING...
LOADING...
이 특허에 인용된 특허 (29)
Gunter D. Niemeyer, Aspects of a control system of a minimally invasive surgical apparatus.
Gunter D. Niemeyer ; Gary S. Guthart ; William C. Nowlin ; Nitish Swarup ; Gregory K. Toth ; Robert G. Younge, Camera referenced control in a minimally invasive surgical apparatus.
Red Walter E. (Provo UT) Davies Brady R. (Orem UT) Wang Xuguang (Provo UT) Turner Edgar R. (Provo UT), Device and method for correction of robot inaccuracy.
Megherbi Dalila (106 E. Manning St. ; #1C Providence RI 02906), Method and apparatus for controlling robot motion at and near singularities and for robot mechanical design.
Wang, Yulun; Uecker, Darrin; Laby, Keith P.; Wilson, Jeff D.; Jordan, Charles S.; Wright, James W.; Ghodoussi, Modjtaba, Method and apparatus for performing minimally invasive surgical procedures.
Sawhney,Harpreet Singh; Kumar,Rakesh; Hsu,Steve; Samarasekera,Supun, Method of pose estimation and model refinement for video representation of a three dimensional scene.
Maille,Bruno; Ramstein,Edouard; Chedmail,Patrick, Moving a virtual articulated object in a virtual environment while avoiding collisions between the articulated object and the environment.
Tierney Michael J. ; Cooper Thomas G. ; Julian Chris A. ; Blumenkranz Stephen J. ; Guthart Gary S. ; Younge Robert G., Surgical robotic tools, data architecture, and use.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.