ROBOT CONTROL DEVICE

Title:

ROBOT CONTROL DEVICE

Document Type and Number:

WIPO Patent Application WO/2011/161765

Kind Code:

A1

Abstract:

Provided is a robot control device wherein direct teaching can be provided not only to tips by also to link sections. The robot control device is equipped with an articulation angle difference calculating unit (114) which calculates an articulation angle difference from a position error between a tip position value and a position command value; a torque command value calculating unit (115) which calculates a torque command value from the articulation angle difference; a drive torque estimating unit (106) which estimates the drive torque of an actuator (100); an external torque calculating unit (107) that calculates the difference between the drive torque and the torque command value as an external torque value, and that estimates, from the external torque value, an articulation-axis-under-external-force whereon an external force acts; a Jacobian matrix calculating unit (105) which calculates a partial Jacobian matrix on the basis of an articulation axis angle, and also calculates a Jacobian matrix; an external force calculating unit (108) which calculates the external force that acts on the articulation-axis-under-external-force from the partial Jacobian matrix and the external torque; a compliance correction amount calculating unit (110) which uses a compliance model to calculate a compliance correction amount, on the articulation-axis-under-external-force, with respect to a work coordinate system position, according to the external torque; and an articulation angle difference correction amount calculating unit (111) which calculates an articulation angle difference correction amount from the compliance correction amount and the partial Jacobian matrix. The articulation angle difference correction amount calculating unit calculates a pre-correction articulation angle difference from the position error and the Jacobian matrix by means of inverse kinematic calculation, and causes the sum of the articulation angle difference correction amount and the pre-correction articulation angle difference to be output as an articulation angle difference.

Inventors:

OHGA JUNICHIRO (JP)
OAKI JUNJI (JP)
OGAWA HIDEKI (JP)

Application Number:

PCT/JP2010/060543

Publication Date:

December 29, 2011

Filing Date:

June 22, 2010

Export Citation:

Click for automatic bibliography generation Help

Assignee:

TOSHIBA KK (JP)
OHGA JUNICHIRO (JP)
OAKI JUNJI (JP)
OGAWA HIDEKI (JP)

International Classes:

B25J9/22; B25J13/08

Foreign References:

JP2002283276A	2002-10-03
JPH09248322A	1997-09-22
JPS61224012A	1986-10-04

Other References: