Control system and control method
AssigneeMatsushita Electric Industrial Co., Ltd.
InventorsTakashi Nakatsuka, Atsumi Hashimoto, Yasushi Mukai, Kiyoshi Ohishi
Life of this patent
Estimating the term…
Abstract
A control system which comprises a reduction gear unit containing gears, a motor being disposed on an input side of said reduction gear unit, a sensor for detecting a turning angle of said motor, and control means for inputting output from said sensor and controlling turning of said motor. The control system further includes gear output angle variation estimation means for estimating a gear output angle variation of said reduction gear unit based on the motor turning angle. An angle transmission error is estimated based on the motor turning angle, whereby load tip locus accuracy can be improved without lowering responsivity of the control system.
Claims21
A control system comprising:
- a reduction gear unit for connection to a load, said reduction gear unit containing gears;
- a motor being disposed on an input side of said reduction gear unit;
- a sensor for detecting a turning angle of said motor and generating an output corresponding to said turning angle;
- means for estimating a torsion torque variation;
- control means for receiving said output from said sensor and controlling turning of said motor;
- and
- gear output angle variation estimation means for estimating a gear output angle variation of said reduction gear unit based on the motor turning angle;
- and
- wherein said gear output angle variation and said torsion torque variation are estimated independent of each other.
A control system comprising:
- a reduction gear unit for connection to a load, said reduction gear unit containing gears;
- a motor being disposed on an input side of said reduction gear unit;
- a sensor for detecting a turning angle of said motor and generating an output corresponding to said turning angle;
- control means for receiving said output from said sensor and controlling turning of said motor;
- gear output angle variation estimation means for estimating a gear output angle variation of said reduction gear unit based on the motor turning angle;
- gear ratio variation estimation means for estimating a torsion torque variation of said reduction gear unit based on the motor turning angle;
- and
- gear friction force estimation means for estimating a gear friction force of said reduction gear unit based on the motor turning angle;
- and
- wherein said gear output angle variation, said torsion torque variation, and said gear friction force are estimated independent of each other.
A control system comprising:
- a reduction gear unit for connection to a load, said reduction gear unit containing gears;
- a motor disposed on an input side of said reduction gear unit;
- a sensor for detecting a turning angle of said motor and generating an output corresponding to said turning angle;
- control means for receiving said output from said sensor and controlling turning of said motor;
- and
- state amount estimation means for estimating a load tip speed of the load and a torsion angle of a tip of the load from a motor driving current and a motor rotation speed, or the motor turning angle, said state amount estimation means utilizing:
- a gear output angle variation constant that estimates a gear output angle variation of said reduction gear unit;
- a gear ratio variation constant that estimates a gear ratio variation of said reduction gear unit;
- and
- a gear friction force constant that estimates a gear friction force of said reduction gear unit.
A method of controlling a motor which drives a reduction gear unit connected to a load, said method comprising the steps of:
- detecting a turning angle of said motors;
- estimating a torsion torque variation;
- estimating a gear output angle variation of said reduction gear unit from the detected motor turning angle;
- and
- using the estimated gear output angle variation to control turning of the motor;
- and
- wherein said gear output angle variation and said torsion torque variation are estimated independent of each other.
A method of controlling a motor which drives a reduction gear unit connected to a load, said control method comprising the steps of:
- detecting a turning angle of said motor;
- estimating a gear output angle variation, a torsion torque variation, and a gear friction force of said reduction gear unit from the detected motor turning angle;
- and
- using the estimated gear output angle variation, the estimated torsion torque variation, and the estimated gear friction force to control turning of the motor;
- and
- wherein said gear output angle variation, said torsion torque variation, and said gear friction force are estimated independent of each other.
A method of controlling a motor which drives a reduction gear unit connected to a load, said method comprising the steps of:
- estimating a load tip speed of the load and a torsion angle of a tip of the load from a motor driving current and a motor rotation speed, or the motor turning angle, said estimating step using:
- a gear output angle variation constant that estimates a gear output angle variation of said reduction gear unit;
- a gear ratio variation constant that estimates a gear ratio variation of said reduction gear unit;
- and
- a gear friction force constant that estimates a gear friction force of said reduction gear unit;
- and
- controlling output to the motor from the gear output angle variation constant, the gear ratio variation constant, the gear friction force constant, and the estimated torsion angle.
A method of controlling a motor which drives a reduction gear unit connected to a load, said reduction gear unit having first and second gears, said method comprising the steps of:
- estimating a torsion torque arising from the connection of the reduction gear unit to the load;
- estimating a reaction force at the motor from the torsion torque using a ratio of the radii of the first and second gears;
- and
- using the estimated reaction force to control turning of the motor.
Dependencies are inferred from the claim text.