Velocity controller with force feedback stiffness control
AssigneeThe University of British Columbia
InventorsNiall R. Parker, Peter D. Lawrence, Septimiu E. Salcudean
Life of this patent
Estimating the term…
Abstract
A force feedback velocity control measures the forces adjacent the end point of an arm being controlled and adjusts the stiffness of a manual controller in any one direction by scaling the end point force in the corresponding direction and adjusting the scaled force based on the degree of displacement of the manual controller away from a datum or zero velocity position in the one direction. A suitable deadband zone is provided surrounding the datum position.
Claims12
A method for applying force feedback to a manual control member of a velocity control system for an arm having an end point comprising determining the degree of displacement (d) of said manual control member from a datum position wherein no velocity commands are provided to move said arm, said displacement of said member defining the velocity signal desired by the operator, determining forces (f.sub.e) at said end point, defining a stiffness factor (K.sub.c) as a function of said determined forces (f.sub.e) at said end point, defining a feedback force (f.sub.m) based on the product of said stiffness factor (K.sub.c) and a function of said determined degree of displacement (d) of said manual control member from said datum position, and applying said feedback force (f.sub.m) to said manual control member to bias said manual control member toward said datum position.
A force feedback velocity control system for applying force feedback to a manual displaceable member for controlling an arm having an end point comprising a computer means, a master controller means, said manual displaceable member controlling said master controller, said master controller being mapped to provide a datum position of said manual displaceable member wherein no velocity signals are sent to said computer when said member is in said datum position and to adjust the velocity signal to said computer means to increase the velocity of said end point in a any one direction in an amount dependent on the degree of displacement (d) of said displaceable member from said datum position in the direction of movement of said member controlling movement of said end point in said one direction, means for applying feedback forces (f.sub.m) to said manual displaceable member to resist movement of said manual displaceable member away from said datum position, means to provide signals representing end point forces (f.sub.e) on said arm adjacent said end point, means to define a stiffness factor (K.sub.c) as a function of said end point force (f.sub.e) and generate force feedback signals based on said stiffness factor (K.sub.c), means for modifying said means for applying stiffness to modify said feedback force (f.sub.m) in said direction of movement controlling velocity of said end point in said one direction based on the product of said stiffness factor (K.sub.c) and a function of displacement (d) of said member from said datum in said direction of movement of said member controlling velocity of said end point in said one direction.
Dependencies are inferred from the claim text.