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 (Toshiba Corporation 1-1, Shibaura 1-chome, Minato-k, Tokyo 01, 〒1058001, JP)
大賀 淳一郎 (〒01 東京都港区芝浦一丁目１番１号 株式会社 東芝 知的財産部内 Tokyo, 〒1058001, JP)
OAKI Junji (Toshiba Corporation 1-1, Shibaura 1-chome, Minato-k, Tokyo 01, 〒1058001, JP)
大賀 淳一郎 (〒01 東京都港区芝浦一丁目１番１号 株式会社 東芝 知的財産部内 Tokyo, 〒1058001, JP)
OAKI Junji (Toshiba Corporation 1-1, Shibaura 1-chome, Minato-k, Tokyo 01, 〒1058001, JP)
Application Number:
JP2010/060543
Publication Date:
December 29, 2011
Filing Date:
June 22, 2010
Export Citation:
Assignee:
KABUSHIKI KAISHA TOSHIBA (1-1 Shibaura 1-chome, Minato-ku Tokyo, 01, 〒1058001, JP)
株式会社 東芝 (〒01 東京都港区芝浦一丁目１番１号 Tokyo, 〒1058001, JP)
OHGA Junichiro (Toshiba Corporation 1-1, Shibaura 1-chome, Minato-k, Tokyo 01, 〒1058001, JP)
大賀 淳一郎 (〒01 東京都港区芝浦一丁目１番１号 株式会社 東芝 知的財産部内 Tokyo, 〒1058001, JP)
株式会社 東芝 (〒01 東京都港区芝浦一丁目１番１号 Tokyo, 〒1058001, JP)
OHGA Junichiro (Toshiba Corporation 1-1, Shibaura 1-chome, Minato-k, Tokyo 01, 〒1058001, JP)
大賀 淳一郎 (〒01 東京都港区芝浦一丁目１番１号 株式会社 東芝 知的財産部内 Tokyo, 〒1058001, JP)
International Classes:
B25J13/08; B25J9/22
Attorney, Agent or Firm:
KATSUNUMA Hirohito et al. (Kyowa Patent & Law Office, Room 323 Fuji Bldg., 2-3, Marunouchi 3-chome, Chiyoda-k, Tokyo 05, 〒1000005, JP)
Download PDF:
Claims: