Parallel link manipulator and its control device
AssigneeMurata Kikai Kabushiki Kaisha
InventorsKoichi Osuka, Yoichi Nakamura
Life of this patent
Estimating the term…
Loading patent…
AssigneeMurata Kikai Kabushiki Kaisha
InventorsKoichi Osuka, Yoichi Nakamura
Estimating the term…
Then an end effecter is used to operate a heavy object, a large bending moment may act on arms of a manipulator to bend them. Consequently, an operating section cannot precisely control positions. Thus, according to the present invention, three arms 14 are attached to a base section 11, each of the arms 14 being composed of a first link section 15 having one end connected to a rotating shaft 12 on the base section 11 and a second link section 17 connected to the first link section 15 via another rotating shaft 16. These arms 14 support an operating section 19. The second link section 17 is connected to the rotating shaft 16 and to the operating section 19 using universal joints 18a and 18b. Direct acting driving means 13 is composed of a driving shaft 13a and a driving source that advances and retreats the driving shaft 13a. The driving shaft 13a is driven to advance and retreat to move the operating section 19 to a desired position. In this case, the operating section 19 is always kept parallel with a particular plane. Loads on the operating section 19 act in the axial directions of the driving shafts 13a. This prevents the driving shafts 13a from being bent or deformed, thus enabling precise positional control.
A parallel link manipulator having an auxiliary mechanism configured to always keep a posture of an end effecter parallel with a particular plane, the manipulator being characterized by being provided with at least three direct-acting driving means composed of a driving shaft having a supported proximal side and a leading side connected to the end effecter using a pivoting bearing with a degree of freedom of 2 or more, and a driving source which advances and retreats the driving shaft toward and from a proximal support point.
A control device for a parallel link manipulator which moves an end effecter using a plurality of driving joints and a plurality of driven joints, the control device comprising inverse kinematic converting means for converting estimated values for task coordinate variables for the end effecter into estimated values for driving joint coordinate variables, forward kinematic converting means for updating the estimated values for the task coordinate variables so as to avoid deviations between the estimated driving joint coordinate variables and actual driving joint coordinate variables, and control means for providing feedback control to the driving joints so as to match target task coordinate variables with the estimated values for the task coordinate variables, the control device being characterized in that said forward kinematic converting means updates the estimated values for the task coordinate variables by multiplying said deviations by a transposed matrix of a Jacobian matrix and a gain integrating products obtained, the transposed matrix being used to convert a differentiation of the task coordinate variables into a differentiation of the driving joint coordinate variables.
Dependencies are inferred from the claim text.