Method for applying constant force with nonlinear feedback control and constant force device using same
First Claim
1. An apparatus to apply estimated tool force substantially equal to a reference tool force on a workpiece surface, comprising:
- an actuator for exerting force on the tool;
a tool holder coupled to said actuator for holding the tool;
accelerometer means coupled to said actuator for measuring tool force acceleration effects;
load cell means coupled to said actuator and having a load cell means output for measuring force applied by said actuator;
a low-pass filter coupled to said load cell means for filtering said load cell output;
a processor coupled to said low-pass filter and said accelerometer means, said processor calculating the estimated tool force, including force applied by said actuator and said actuator acceleration effects;
a memory for storing processor programs and the reference tool force, said memory being coupled to said processor;
a processor interface for entering the reference tool force and processor programs into said processor, said processor interface being coupled to said processor; and
actuator force control means coupled to said actuator for rendering the estimated tool force substantially equal to the reference tool force on a workpiece surface under control of said processor.
1 Assignment
0 Petitions
Accused Products
Abstract
An actively controlled, pneumatically-actuated constant force device (CFD) which may be fixed to a stationary mount or moved in three-dimensional space proximate a work surface. The device applies substantially constant force from an actuator, through a linkage, to a tool in contact with a work surface, e.g., a drilling, grinding or finishing tool, or a laminating roller. A processor provides closed-loop control of estimated tool force applied to the work surface, regardless of tool orientation. CFD compliance and response time may be altered by adjustment of gas pressures in a pneumatic cylinder. Active control of estimated tool force includes processing of information on actuator force, actuator orientation, tool and linkage weight, and actuator motion, as well as work surface irregularities. The device automatically compensates for changes in desired (reference) tool force by adjusting gas pressures entering a pneumatic force generator to bring estimated applied tool force into substantial agreement with the reference tool force.
61 Citations
56 Claims
-
1. An apparatus to apply estimated tool force substantially equal to a reference tool force on a workpiece surface, comprising:
-
an actuator for exerting force on the tool; a tool holder coupled to said actuator for holding the tool; accelerometer means coupled to said actuator for measuring tool force acceleration effects; load cell means coupled to said actuator and having a load cell means output for measuring force applied by said actuator; a low-pass filter coupled to said load cell means for filtering said load cell output; a processor coupled to said low-pass filter and said accelerometer means, said processor calculating the estimated tool force, including force applied by said actuator and said actuator acceleration effects; a memory for storing processor programs and the reference tool force, said memory being coupled to said processor; a processor interface for entering the reference tool force and processor programs into said processor, said processor interface being coupled to said processor; and actuator force control means coupled to said actuator for rendering the estimated tool force substantially equal to the reference tool force on a workpiece surface under control of said processor. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12)
-
-
13. An apparatus positioned by a robot using robot position parameters proximate to a workpiece surface, the apparatus to apply estimated tool force substantially equal to a reference tool force on the workpiece surface, comprising:
-
an actuator for exerting force on the tool, said actuator having a range of motion; a tool holder coupled to said actuator for holding the tool; accelerometer means coupled to said actuator for measuring tool force acceleration effects; potentiometer means coupled to said actuator and the tool holder, said potentiometer means for maintaining said actuator substantially centered within said range of motion; load cell means coupled to said actuator and having a load cell means output for measuring force applied by said actuator; a low-pass filter coupled to said load cell means for filtering said load cell output; a processor coupled to said low-pass filter, said potentiometer means and said accelerometer means, said processor calculating the estimated tool force, including force applied by said actuator and said actuator acceleration effects; a memory for storing processor programs for controlling operation of said processor, and the reference tool force, said memory being coupled to said processor; a processor interface for entering the reference tool force and robot position parameters into said processor; and actuator force control means coupled to said actuator for rendering the estimated tool force substantially equal to the reference tool force on a workpiece surface under control of said processor. - View Dependent Claims (14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24)
-
-
25. An apparatus positioned by a robot using robot position parameters proximate to a workpiece surface, the apparatus to apply estimated tool force substantially equal to a reference tool force on the workpiece surface, comprising:
-
a double-acting pneumatic actuator for exerting force on the tool, said actuator having a first gas chamber and a second gas chamber, a movement axis, and a range of motion; a tool holder coupled to said actuator for holding the tool, said tool holder being capable of movement substantially parallel to said movement axis; accelerometer means coupled to said actuator for measuring a tool force acceleration component; potentiometer means coupled to said actuator and the tool, said potentiometer means for locating said actuator within said range of motion; load cell means coupled to said actuator and having a load cell means output for measuring force applied by said actuator; a low-pass filter coupled to said load cell means for filtering said load cell output; a processor coupled to said low-pass filter, said potentiometer means and said accelerometer means, said processor calculating the estimated tool force, including force applied by said actuator and said actuator acceleration effects; a memory for storing processor programs for controlling operation of said processor, and the reference tool force, said memory being coupled to said processor; a processor interface for entering the reference tool force and robot position parameters into said processor; and actuator force control means coupled to said first and second gas chambers for rendering the estimated tool force substantially equal to the reference tool force on a workpiece surface under control of said processor. - View Dependent Claims (26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37)
-
-
38. A method of applying an estimated tool force substantially equal to a reference tool force at a workpiece surface, comprising:
-
providing an actuator for applying an actuator component of tool force through a mechanical linkage, said actuator having a first side input and an opposite-acting second side input; estimating a tool force acceleration component due to acceleration of said actuator; estimating a tool force friction component due to friction in said mechanical linkage; measuring actuator force applied by said actuator; low-pass filtering said actuator force; estimating actual tool force based on said tool force acceleration component, said tool force friction component, and said filtered actuator force; comparing said estimated actual tool force with the reference tool force to obtain an error signal; producing said first side actuator input by processing said error signal through a proportional-integral-derivative controller; producing said second side actuator input by combining the the reference tool force and the tool force acceleration component; and applying said first and second side actuator inputs to said actuator to obtain said estimated actual tool force substantially equal to the reference tool force. - View Dependent Claims (39, 40, 41, 42, 43, 44, 45, 46, 47)
-
-
48. A method of using an actuator controlled by first side and second side signals, the actuator acting through a linkage to a tool to apply an estimated actual tool force substantially equal to a reference tool force at a workpiece surface, comprising:
-
estimating a tool force acceleration component due to acceleration of said actuator; estimating a tool force friction component due to friction in the linkage from actuator to tool; measuring actuator force applied by said actuator; low-pass filtering said actuator force with a filter having a half-power point between about 1 and 100 Hz; estimating actual tool force based on said tool force acceleration component, said tool force friction component, and said filtered actuator force; comparing said estimated actual tool force with the reference tool force to obtain an error signal; processing said error signal through a proportional-integral-derivative controller to form the first side signal; calculating the second side signal using a second side equation which includes the reference tool force and said tool force acceleration component as terms; and combining the first side and second side signals to control the actuator to apply through the linkage an estimated actual tool force substantially equal to the reference tool force. - View Dependent Claims (49, 50, 51, 52, 53, 54, 55, 56)
-
Specification