Invention Grant
- Patent Title: Multi-joint robot and control program thereof
- Patent Title (中): 多关节机器人及其控制程序
-
Application No.: US12303649Application Date: 2007-06-25
-
Publication No.: US08112179B2Publication Date: 2012-02-07
- Inventor: Yuichiro Nakajima
- Applicant: Yuichiro Nakajima
- Applicant Address: JP Toyota-shi, Aichi-ken
- Assignee: Toyota Jidosha Kabushiki Kaisha
- Current Assignee: Toyota Jidosha Kabushiki Kaisha
- Current Assignee Address: JP Toyota-shi, Aichi-ken
- Agency: Finnegan, Henderson, Farabow, Garrett & Dunner, LLP
- Priority: JP2006-175063 20060626
- International Application: PCT/JP2007/062675 WO 20070625
- International Announcement: WO2008/001713 WO 20080103
- Main IPC: G05B15/00
- IPC: G05B15/00 ; G05B19/00

Abstract:
The present invention provides a multi-joint robot that, when the loads acting on some of joints are overloaded, controls the joints so as to continue the work as far as possible while easing the overloaded state. The load estimate unit (32) estimates the load acting on each joint, and the overloaded joint specifying unit (34) specifies an overloaded joint of which the estimated load is greater than a threshold. The storage unit (40) stores a target state vector of an end link of the robot and stores a predetermined priority with respect to the components of the vector. The component extracting unit (42) extracts the same number of components as that of non-overloaded joints from the target state vector in order of a higher priority. The force control calculating unit (36) determines the target drive quantity for driving the overloaded joint in the same direction as that of the load. The inverse transformation unit determines the target drive quantities with respect to the non-overloaded joints so as to realize the extracted components. Thus, the non-overloaded joints can be controlled so as to follow the target state vector as far as possible, while the overloaded joints are controlled in a direction to reduce the load.
Public/Granted literature
- US20100234999A1 MULTI-JOINT ROBOT AND CONTROL PROGRAM THEREOF Public/Granted day:2010-09-16
Information query