Non-Linear muscle-like compliant controller
First Claim
1. A compliant controller for an actuator that does not require the use of a force sensor comprising:
- a position sensor for sensing the position of the actuator to generate signals representing actuator position;
a processor responsive to sensed actuator position and operating in accordance with a force determining algorithm that is a function of an initial actuator position, a subsequently sensed actuator position and a position calculated from a nonlinear damping function to determine an actuating force, the actuating force being nonzero in the presence of a disturbing force, the processor comparing the difference between an initial actuator position and a subsequently sensed actuator position to a value representing a predetermined amount of movement, the processor resetting the calculated position to a predetermined value if the difference is less than the predetermined amount of movement to reduce the actuating force in the presence of a disturbing force and the processor setting the initial actuator position to the subsequently sensed actuator position if the difference is greater than the predetermined amount of movement.
1 Assignment
0 Petitions
Accused Products
Abstract
A compliant controller implements a biological model of a primate muscle so as to provide simultaneous position and force control with nonlinear damping for an actuator. The compliant controller uses one or more position sensors but does not require the use of a force sensor to provide force control. The compliant controller implements a force determining algorithm that is a function of an initial actuator position, a subsequently sensed actuator position, a desired actuator position and a position calculated from a nonlinear damping function. The algorithm updates or resets the initial actuator position or the calculated position depending upon the amount of actuator movement sensed. The compliant controller in accordance with the force determining algorithm and resetting of the various position values allows a desired position to be quickly attained while allowing the controller to compliantly respond to the presence or removal of an unknown or unexpected disturbing force.
79 Citations
20 Claims
-
1. A compliant controller for an actuator that does not require the use of a force sensor comprising:
-
a position sensor for sensing the position of the actuator to generate signals representing actuator position;
a processor responsive to sensed actuator position and operating in accordance with a force determining algorithm that is a function of an initial actuator position, a subsequently sensed actuator position and a position calculated from a nonlinear damping function to determine an actuating force, the actuating force being nonzero in the presence of a disturbing force, the processor comparing the difference between an initial actuator position and a subsequently sensed actuator position to a value representing a predetermined amount of movement, the processor resetting the calculated position to a predetermined value if the difference is less than the predetermined amount of movement to reduce the actuating force in the presence of a disturbing force and the processor setting the initial actuator position to the subsequently sensed actuator position if the difference is greater than the predetermined amount of movement. - View Dependent Claims (2, 3, 4)
-
-
5. A compliant controller for an actuator that does not require the use of a force sensor comprising:
-
a position sensor for sensing the position of the actuator to generate signals representing actuator position;
a processor responsive to sensed actuator position and operating in accordance with a force determining algorithm to determine an actuating force where the algorithm is a function of an initial actuator position, a subsequently sensed actuator position, a desired actuator position and a position calculated from a nonlinear damping function, the processor comparing the difference between an initial actuator position and a subsequently sensed actuator position to a value representing a predetermined amount of movement and the processor resetting the calculated position to a predetermined value if the difference is less than the predetermined amount of movement to adapt the actuating force to a disturbing force. - View Dependent Claims (6, 7, 8, 9, 10, 11, 12, 13)
-
-
14. A method for determining an actuator force for a compliant controller that controls an actuator without requiring a force sensor comprising:
-
sensing the position of an actuator;
calculating an actuating force in accordance with a force determining algorithm that is a function of an initial actuator position, a subsequently sensed actuator position, a desired position and a position calculated from a nonlinear damping function;
determining a difference between an initial actuator position and a subsequently sensed actuator position; and
resetting the calculated position to a predetermined value if the difference is less than the predetermined amount of movement to adapt the actuating force to a disturbing force. - View Dependent Claims (15, 16, 17, 18, 19, 20)
determining whether the controller is in a teaching mode or a control mode; and
storing in the teaching mode the sensed actuator positions as the actuator is manually moved to follow a desired path with the determined actuator force aiding in the movement of the actuator.
-
-
18. A method for determining an actuator force as recited in claim 14 including the step of setting the initial actuator position to the subsequently sensed actuator position if the difference is greater than the predetermined amount of movement.
-
19. A compliant controller as recited in claim 14 wherein said force determining algorithm simulates a primate muscle.
-
20. A compliant controller as recited in claim 14 wherein said processor calculates a position by integrating vn where n is an odd number representing an order of nonlinearity;
- v=rmus/(Bp*(|xp|−
xpo));
rmus=Kr * (xmus−
xp);
xmus is the difference between the initial actuator position and a subsequently sensed actuator position;
Kr is a stiffness constant;
Bp is a damping coefficient;
xpo is a nonzero constant and xp is the calculated position having an initialization value of zero.
- v=rmus/(Bp*(|xp|−
Specification