The double ring detecting mechanism of robot joint speed reducer flexibility
Affiliated technical field:
The present invention is the robot joint speed reducer flexibility error detection mechanism, belongs to Robotics and automatic field, effectively the mechanical flexibility error in the detection machine person joint decelerator transmission system.
Background technology:
At present, generally use decelerator such as harmonic speed reducer, gear reduction unit etc. in the joint of robot, being used for the high rotating speed of motor, low rotating torque conversion of motion is low velocity, the motion of high rotating torque, drives joint motions then.But there is the problem of a significant mechanical flexibility error in the decelerator transmission system.In theory, the ratio of the input and output of decelerator is its speed reducing ratio.But in fact any object always produces the different distortion of degree when being subjected to external force, so when the output of decelerator bears certain moment of torsion, the actual output of decelerator is always exported deviation to some extent with theory, be not to be equal to input divided by speed reducing ratio, we are called the mechanical flexibility error of decelerator this deviation.
Current, robot control system mostly adopts detection means such as shaft-position encoder or potentiometer to detect the angle that rotate in the joint, and these senser elements or be installed in motor and rotate end perhaps are installed in the output of decelerator.A distinct disadvantage of this monocycle detection system is exactly the flexible error that can't quantitatively detect decelerator.When the flexible error of decelerator was very big, system will be affected to the control of motion.
Summary of the invention:
In order to detect the flexible error of decelerator transmission system,, the present invention proposes a kind of speed reducer flexibility error detection mechanism based on dicyclo for control system provides useful reference information.
The technical solution used in the present invention is: whole system comprises angle detection system, signal processing system and mechanical mechanism three parts.Wherein angle detection system is made up of motor rotation angle detecting sensor and decelerator output rotation angle detecting sensor and interface circuit; Signal processing system is made up of with corresponding software signals collecting and process computer; Mechanical mechanism partly is used for the support of entire system, and guarantees the correctness that senser element is installed.
Its main technical schemes is: the turning cylinder of motor links to each other with the importation of decelerator, and the output of decelerator is connected with the parts that will drive.Setting angle detecting sensor on the turning cylinder of motor is used for detecting the rotational angle of motor.During installation, need to satisfy certain axiality requirement between the turning cylinder of the sensor of installing on the turning cylinder of motor and the motor shaft.Must follow following principle during installation: the nonrotational part of sensor be installed in motor on or with fixed electrical machinery parts not in relative rotation on the parts, the turning cylinder of its turning cylinder and motor or link to each other with parts that turning cylinder is connected; Or the turning cylinder of sensor is installed on the motor or with fixed electrical machinery parts not in relative rotation on the parts, the turning cylinder of nonrotational part and motor or link to each other with parts that turning cylinder is connected.Simultaneously, setting angle detecting sensor on the output of decelerator, installation requirement and on motor rotation axis sensor installation require similarly, promptly mounted sensor must be able to be measured the rotational angle of decelerator output with respect to input.
Then with signal of sensor through interface circuit, (analog signal must carry out A/D conversion) in this way is transferred in the signal process computer.The measured angle information of sensor that is installed on the motor shaft does not comprise flexible error component, and the measured angle information of the sensor that is installed in the decelerator output includes flexible error component, so can obtain the information of flexible error from the information of the two.
The invention has the beneficial effects as follows:
1. can effectively detect the flexibility of joint error, detecting reliability is strong.
2. help the accurate control of joint motions.Detected control information is fed back in the control computer, and the adjusting by algorithm can improve control rate and the precision to the robot motion.
Description of drawings:
The present invention is further described below in conjunction with drawings and Examples.
Fig. 1 is a concrete application example frame for movement schematic diagram (profile)
Fig. 2 is the overall diagram of application example mechanical mechanism
Fig. 3 is the optical electric axial angle encoder pictorial diagram
Fig. 4 is a potentiometer size schematic diagram
Fig. 5 is the schematic diagram of dicyclo detection system
Among Fig. 1: 1. potentiometer stiff end 2. potentiometers 3. flexible shaft joint 4. decelerator outputs 5. bearings 6. decelerator inputs 7. harmonic speed reducers 8. optical electric axial angle encoders 9. motors
The specific embodiment:
The embodiment of this device is as follows:
The first step: as shown in fig. 1,6. motor rotation end 9. links to each other with the decelerator input by synchronous belt, to drive joint motions.8. optical electric axial angle encoder is installed in the rotating shaft of motor.5. 4. harmonic speed reducer output 7. realized and potentiometer stiff end relatively rotating 1. by bearing, according to the sensor installation guideline that in technical scheme, proposes, 2. potentiometer is connected with the potentiometer stiff end, 3. the turning cylinder of potentiometer links to each other with the decelerator output by flexible shaft joint, so just can guarantee that potentiometer can measure the relative rotation of decelerator output.The axiality of potentiometer and reducer output shaft mainly relies on the machining accuracy of the localization part of potentiometer holder to realize.
Second step: the optical electric axial angle encoder that is installed on the motor shaft is transferred in the signal process computer through interface circuit simultaneously with the measuring-signal that is installed in the potentiometer on the decelerator output, by analysis, just can calculate the size of the flexible error of decelerator to the difference of the two signal.