Manipulator arm position sensing

Claim 1

A method of controlling the movement of an articulated arm comprising applying command to a control computer to define a target position for an end point of said articulated arm, applying an iterative pseudoinverse Jacobian having a damping factor for defining the amount of change of each joint angle for each joint to be actuated of said arm, changing the magnitude of said damping factor for each iteration in accordance with the calculated workspace distance between the end point and the target position so that said damping factor increases with an increase in said distance, adjusting the angles of said joints of said arms in accordance with angles determined using a number of iterations in the range of 1 to 20.

Claim 2

A method of controlling the movement of an articulated arm comprising applying command to a control computer to define a target position for an end point of said articulated arm, applying an iterative pseudoinverse Jacobian having a damping factor for defining the amount of change of each joint angle for each joint to be actuated of said arm, changing the magnitude of said damping factor for each iteration in accordance with the calculated workspace distance between the end point and the target position so that said damping factor increases with an increase in said distance, adjusting the angles of said joints of said arms in accordance with angles determined using a number of iterations in the range of 1 to 20.

Claim 6

A method of controlling the operation of an articulated arm to improve the operation of the arm adjacent singularities and in regions of high manipulability, said arm having arm segments pivotally interconnected by articulated joints forming adjustable joint angles between arm segments and actuators for changing said joint angles to move said arm, comprising applying a command to a computer control to define a target position for an end point on said arm, said computer determining the joint angles for said joints required to move said end point toward said target position using an iterative solution based on a pseudoinverse Jacobian matrix in accordance with the formula J.sup.+ (θ)=(J.sup.T (θ)J(θ)+k.sub.3 I).sup.-1 J.sup.T (θ) (13) where I=identity matrix k 3 =variable damping factor determined from the equation k.sub.3 =k∥δp∥.sup.x ( 12) where k=a preselected number in the range of 0.001 to 1 times the total length of the arm in meters ∥δp∥=the distance between the end point and target position after each iteration x=a number selected between 1 and 3 adjusting the value of k 3 for each iteration based on the calculated position of the end point relative to the target position and said computer actuating said actuators for adjusting the joint angles to move said end point on said arm toward said target position after a number of iterations in the range of 1 to 20.

Claim 7

A method of controlling the operation of an articulated arm to improve the operation of the arm adjacent singularities and in regions of high manipulability, said arm having arm segments pivotally interconnected by articulated joints forming adjustable joint angles between arm segments and actuators for changing said joint angles to move said arm, comprising applying a command to a computer control to define a target position for an end point on said arm, said computer determining the joint angles for said joints required to move said end point toward said target position using an iterative solution based on a pseudoinverse Jacobian matrix in accordance with the formula J.sup.+ (θ)=(J.sup.T (θ)J(θ)+k.sub.3 I).sup.-1 J.sup.T (θ) (13) where I=identity matrix k 3 =variable damping factor determined from the equation k.sub.3 =k∥δp∥.sup.x ( 12) where k=a preselected number in the range of 0.001 to 1 times the total length of the arm in meters ∥δp∥=the distance between the end point and target position after each iteration x=a number selected between 1 and 3 adjusting the value of k 3 for each iteration based on the calculated position of the end point relative to the target position and said computer actuating said actuators for adjusting the joint angles to move said end point on said arm toward said target position after a number of iterations in the range of 1 to 20.