Invention Grant
- Patent Title: Method and device for controlling mechanical articulated arm
- Patent Title (中): 用于控制机械铰接臂的方法和装置
-
Application No.: US13807220Application Date: 2011-06-22
-
Publication No.: US09302392B2Publication Date: 2016-04-05
- Inventor: Xiaogang Yi , Xiang Zhou , Antao Chen , Qiulian Deng
- Applicant: Xiaogang Yi , Xiang Zhou , Antao Chen , Qiulian Deng
- Applicant Address: CN Changsha CN Changsha
- Assignee: Hunan Sany Intelligent Control Equipment Co., Ltd.,Sany Heavy Industry Co., Ltd.
- Current Assignee: Hunan Sany Intelligent Control Equipment Co., Ltd.,Sany Heavy Industry Co., Ltd.
- Current Assignee Address: CN Changsha CN Changsha
- Agency: Bozicevic, Field & Francis LLP
- Agent Bret E. Field
- Priority: CN201010219928 20100701
- International Application: PCT/CN2011/076099 WO 20110622
- International Announcement: WO2012/000400 WO 20120105
- Main IPC: G05B15/00
- IPC: G05B15/00 ; G05B19/00 ; B25J9/16

Abstract:
A control method of a mechanical articulated arm, wherein at least two tilt sensors are arranged in different positions of the articulated arm, comprising: calibrating zero positions of tilt sensors when articulated arm does not have elastic deformation, setting position of tail end of articulated arm as point P and point P′ before and after elastic deformation of articulated arm, and selecting point R on the articulated arm; detecting angles of two different positions of the articulated arm with the tilt angles before and after the elastic deformation, obtaining the angle offset Δθ of the articulated arm due to the elastic deformation, and calculating the length parameter La and the angle parameter θa of the articulated arm after deformation based on the lengths of OR and RP′; and controlling the action of the articulated arm according to position parameters Xp′ and Yp′ (to the point P′) obtained according to length parameter La and angle parameter θa.
Public/Granted literature
- US20130197695A1 METHOD AND DEVICE FOR CONTROLLING MECHANICAL ARTICULATED ARM Public/Granted day:2013-08-01
Information query