Method for positioning a tool of a multi-joint robot

Claim 1

A method for positioning a tool of a multi-joint robot having a plurality of rotatable joints (G i-1 , G i , G i+1 ) defining robot joint axes, with one of the joints being connected to the tool and the location and the orientation of the tool being represented in a reference coordinate system and the respective position of the tool relative to the reference coordinate system and the angular positions of the robot joint axes being linked by a coordinate-transformation equation system having parameters which are determined by the desired distances and desired directions of the robot joints representing the ideal kinematic of the robot, comprising the following steps: (a) determining a preliminary desired angular position (θ i-1 , θ i , θ i+1 ) for each of the joints, respectively, for a desired position in space (x) of the tool based upon reference distances (a i-1 , a i , a i+1 d i-1 , d i , d i+1 ) and directions of the joint axes required to position the tool in the desired position; (b) determining the positioning error (Δx) of the tool due to the difference between the reference distance (a i-1 , a i , a i+1 , d i-1 , d i , d i+1 ) and the desired directions and the actual spacings and actual direction of the joints (G i-1 , G i , G i+1 ); (c) transforming the determined positioning error (Δx) into corresponding angular correction values (Δθ) for the preliminary desired angular positions (θ i-1 ,θ i , θ i+1 ) of the joints (G i-1 , G i , G i+1 ) by means of the inverse Jacobi matrix (Fθ(θ v ,F ref ) -1 ) of the ideal kinematic of the robot of the coordinate-transformation equation system; (d) calculating the error-corrected angular position (θ f ) for each of the joints (G i-1 , G i , G +1 ) by addition of the angular correction values (Δθ) determined in step c) to the preliminary desired angular positions (θ i-1 ,θ i , θi+1) determined in step a); and (e) moving the tool to the desired position by rotating the joints in accordance with the error-corrected angular position (θ f ) calculated in step (d).

Claim 2

A method for positioning a tool of a multi-joint robot having a plurality of rotatable joints (G i-1 , G i , G i+1 ) defining robot joint axes, with one of the joints being connected to the tool and the location and the orientation of the tool being represented in a reference coordinate system and the respective position of the tool relative to the reference coordinate system and the angular positions of the robot joint axes being linked by a coordinate-transformation equation system having parameters which are determined by the desired distances and desired directions of the robot joints representing the ideal kinematic of the robot, comprising the following steps: (a) determining a preliminary desired angular position (θ i-1 , θ i , θ i+1 ) for each of the joints, respectively, for a desired position in space (x) of the tool based upon reference distances (a i-1 , a i , a i+1 d i-1 , d i , d i+1 ) and directions of the joint axes required to position the tool in the desired position; (b) determining the positioning error (Δx) of the tool due to the difference between the reference distance (a i-1 , a i , a i+1 , d i-1 , d i , d i+1 ) and the desired directions and the actual spacings and actual direction of the joints (G i-1 , G i , G i+1 ); (c) transforming the determined positioning error (Δx) into corresponding angular correction values (Δθ) for the preliminary desired angular positions (θ i-1 ,θ i , θ i+1 ) of the joints (G i-1 , G i , G i+1 ) by means of the inverse Jacobi matrix (Fθ(θ v ,F ref ) -1 ) of the ideal kinematic of the robot of the coordinate-transformation equation system; (d) calculating the error-corrected angular position (θ f ) for each of the joints (G i-1 , G i , G +1 ) by addition of the angular correction values (Δθ) determined in step c) to the preliminary desired angular positions (θ i-1 ,θ i , θi+1) determined in step a); and (e) moving the tool to the desired position by rotating the joints in accordance with the error-corrected angular position (θ f ) calculated in step (d).