Invention Application
- Patent Title: ROBOT CONTROL APPARATUS, AND METHOD AND PROGRAM FOR OBTAINING ANGLE OF JOINT OF ROBOT
-
Application No.: US16360249Application Date: 2019-03-21
-
Publication No.: US20190299416A1Publication Date: 2019-10-03
- Inventor: Hirokazu WATANABE , Haruhiro TSUNETA
- Applicant: Nidec Corporation
- Priority: JP2018-067235 20180330
- Main IPC: B25J9/16
- IPC: B25J9/16 ; B25J9/06

Abstract:
In a method of obtaining an angle of each joint of a 6-axis vertical articulated robot when a position and a posture of an end effector attached on a sixth axis are given, a predetermined amount of offset exists between a sixth axis and a fourth axis, and the method includes sequentially determining a point of interest, which is a point on a circumference of a circle having the predetermined amount as a radius, around a first intersection point, on a plane which includes the first intersection point which is an intersection point of the sixth axis and the fifth axis and the plane which is orthogonal to the sixth axis, calculating a second intersection point, which is an intersection point of the fourth axis and the third axis, when it is assumed that the point of interest is an intersection point of the fifth axis and the fourth axis, calculating an inner product value of a first vector directed from the calculated second intersection point to the point of interest and a second vector directed from the point of interest to the first intersection point, and estimating that the point of interest, when an absolute value of the inner product value is less than or equal to a predetermined threshold, is an intersection point of the fifth axis and the fourth axis.
Public/Granted literature
- US11433540B2 Robot control apparatus, and method and program for obtaining angle of joint of robot Public/Granted day:2022-09-06
Information query
IPC分类: