Velocity controller with force feedback stiffness control

Claim 3

A method as defined in claim 1 wherein said stiffness factor (K c ) is obtained by scaling said determined end point forces f e .

Claim 4

A method as defined in claim 1 further comprising providing a deadband zone d.sub.(db) wherein movement of said manual member does not result in movement of said end point, said deadband zone d.sub.(db) surrounding said datum position.

Claim 5

A method as defined in claim 2 further comprising providing a deadband zone d.sub.(db) wherein movement of said manual member does not result in movement of said end point, said deadband zone d.sub.(db) surrounding said datum position.

Claim 6

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 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 e ) on said arm adjacent said end point, means to define a stiffness factor (K c ) as a function of said end point force (f e ) and generate force feedback signals based on said stiffness factor (K c ), means for modifying said means for applying stiffness to modify said feedback force (f 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 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.

Claim 7

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 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 e ) on said arm adjacent said end point, means to define a stiffness factor (K c ) as a function of said end point force (f e ) and generate force feedback signals based on said stiffness factor (K c ), means for modifying said means for applying stiffness to modify said feedback force (f 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 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.

Claim 8

A system as defined in claim 3 wherein a deadband zone (d.sub.(db)) wherein movement of said manual displaceable member produces no changes in velocity of said end point encircles said datum position.

Claim 9

A method as defined in claim 1 wherein said stiffness factor K c is determined using the formula K.sub.c =K.sub.nom +f.sub.e K.sub.r where K nom is the stiffness factor tending to force the manual control member to said datum position when f e is zero K r is a scaling factor.

Claim 10

A method as defined in claim 3 wherein said deadband zone is determined by d.sub.(db) =f.sub.m(db) /K.sub.nom where d.sub.(db) is the displacement of said manual control member from said datum position to the outer boundary of said deadband zone f m (db) is the biasing force on said manual controller member that must be overcome to leave said deadband zone.

Claim 11

A method as defined in claim 8 wherein said stiffness factor K c is determined using the formula K.sub.c =K.sub.nom +f.sub.e K.sub.r where K nom is the stiffness factor tending to force the manual control member to said datum position when f e is zero K r is a scaling factor.

Claim 12

A system as defined in claim 5 wherein said stiffness factor K c is determined using the formula K.sub.c =K.sub.nom +f.sub.e K.sub.r where K nom is the stiffness factor tending to force the manual control member to said datum position when f e is zero K r is a scaling factor.

Claim 13

A system as defined in claim 6 wherein said deadband zone is determined by d.sub.(db) =f.sub.m(db) /K.sub.nom where d.sub.(db) is the displacement of said manual control member from said datum position to the outer boundary of said deadband zone F m (db) is the biasing force on said manual controller member that must be overcome to leave said deadband zone.

Claim 14

A system as defined in claim 11 wherein said stiffness factor K c is determined using the formula K.sub.c =K.sub.nom +f.sub.e K.sub.r where K nom is the stiffness factor tending to force the manual control member to said datum position when f e is zero K r is a scaling factor.