A kind of teach-by-doing drags teaching robot of can hovering
Technical field
The invention belongs to robot teaching technical field, be specifically related to a kind of teach-by-doing and drag teaching robot of can hovering.
Background technology
Chinese patent document CN104162890A disclose a kind of hand-in-hand demonstration robot based on motor power-assisted and
Control method, this teaching robot includes each joint connecting shaft of base, multi-joint arm, multi-joint arm self, encoder, electricity
Machine, manipulation sensing mechanisms, cylinder balancing mechanism etc..Its principle is the pose as residing for multi-joint arm, and power-assisted arithmetic system passes through
Interpolation method obtains each joint shaft in positive direction or opposite direction just at static critical balance moment values, and exists according to operator
The signal shortcoming joint shaft rotation direction triggered in manipulation sensing mechanisms, is provided assist torque by motor to joint, makes multi-joint
Arm is prone to be dragged by operator carry out teaching.
Small contact in this patent document CN104162890A sensing mechanisms cannot ensure to feed back accurately, in fact it could happen that
It is delayed that signals collecting causes not in time, and it is relatively costly, it is impossible to realizes hovering.
Summary of the invention
For solving above-mentioned technical problem, the invention provides a kind of teach-by-doing and drag teaching robot of can hovering, employing is joined
The imbalance of the mode offset torque of galassing weighing apparatus, makes teaching operation lighter, and the counterweight balance that simultaneously can regulate enables it to
Enough realization is hovered reliably, can farthest reduce cost compared to traditional teaching robot.
For reaching above-mentioned purpose, technical scheme is as follows: a kind of teach-by-doing drags teaching robot of can hovering, bag
The connection of the multi-joint arm that the rotating seat include pedestal, being fixed on pedestal is connected with described rotating seat, multi-joint arm and rotating seat
Each joint of joint and multi-joint arm self is all rotationally connected by rotary joint axle, it is characterised in that: each described rotation
Turn and be equipped with for offset torque, the counterweight balancing mechanism of realization hovering on joint shaft,
-described counterweight balancing mechanism, it includes the balancing weight that weight linear meter and weight can regulate, one end of described weight linear meter
Propping up on balancing weight, its other end is rotationally connected with described rotary joint axle;
The weight linear meter of current counterweight balancing mechanism and corresponding joint arm are separately positioned on current counterweight balance
The rotary joint axle both sides at mechanism place;
The balancing weight of current counterweight balancing mechanism is overall with the weight that all joint arms of its rear end, balancing weight are formed is working as
Balance at the rotary joint axle at front counterweight balancing mechanism place.
In one preferred embodiment of the present invention, farther include to be further fixed on for mending on each described rotary joint axle
Repay the damping mechanism of torque difference.
In one preferred embodiment of the present invention, farther include the weight linear meter of current counterweight balancing mechanism and corresponding therewith
Both joint arms be separately positioned on current counterweight balancing mechanism place rotary joint axle both sides become 180 degree of straight lines.
In one preferred embodiment of the present invention, farther include described damping mechanism and include rub base, friction regulation
Base and friction plate, described friction base is fixed on rotary joint axle, and described friction adjusting base is fixed on pedestal, with institute
State and be all provided with on the face that rotary joint axle generation relative motion, described friction base and friction adjusting base are oppositely arranged
State friction plate, by the mutual frictional force between regulation bolt two friction plates of regulation.
In one preferred embodiment of the present invention, farther include to be respectively and fixedly provided with for remembering on each described rotary joint axle
The encoder of record rotary joint axle pose data, described encoder electrically connects with control system.
In one preferred embodiment of the present invention, farther include described balancing weight and include balancing weight body and be attached thereto
Regulating block, described balancing weight body and regulating block can be detachably fixedly arranged at described weight linear meter by securing member.
The invention has the beneficial effects as follows:
One, a kind of of the present invention drag teaching robot of can hovering by doing and illustrating, use the mode of counterweight balance to offset torsion
The imbalance of square, makes teaching operation lighter, and the counterweight balance that simultaneously can regulate is so that it can realize hovering, compared to biography
The teaching robot of system can farthest reduce cost;
Two, damping mechanism compensates torque difference by the way of regulation rotating friction force so that hover more reliable, and
Keep.
Accompanying drawing explanation
In order to be illustrated more clearly that the technical scheme in embodiment of the present invention technology, in embodiment technology being described below
The required accompanying drawing used is briefly described, it should be apparent that, the accompanying drawing in describing below is only some realities of the present invention
Execute example, for those of ordinary skill in the art, on the premise of not paying creative work, it is also possible to according to these accompanying drawings
Obtain other accompanying drawing.
Fig. 1 is the structural representation of the preferred embodiment of the present invention;
Fig. 2 is the structural representation of preferred embodiment of the present invention counterweight balancing mechanism;
Fig. 3 is the structural representation of preferred embodiment of the present invention damping mechanism.
Wherein: 1-pedestal, 2-rotating seat, 3-counterweight balancing mechanism one, 4-weight linear meter one, 5-rotary joint axle one, 6-hinders
Buddhist nun mechanism one, 7-encoder one, 8-J2 joint arm, 9-rotary joint axle two, 10-damping mechanism two, 11-encoder two, 12-joins
Weight balanced controls two, 13-J4 rotary shaft, 14-J3 joint arm, 15-J4 joint arm, 16-counterweight balancing mechanism three, 17-rotates pass
Nodal axisn three, 18-damping mechanism three, 19-encoder three, 20-J5 joint arm, 21-J6 joint arm, 22-J1 joint arm;
A-rubs base, and b-rubs adjusting base, and c-friction plate, d-regulates bolt;
E-weight linear meter, h-balancing weight, h1-balancing weight body, h2-regulating block.
Detailed description of the invention
Below in conjunction with the accompanying drawing in the embodiment of the present invention, the technical scheme in the embodiment of the present invention is carried out clear, complete
Describe, it is clear that described embodiment is only a part of embodiment of the present invention rather than whole embodiments wholely.Based on
Embodiment in the present invention, it is every other that those of ordinary skill in the art are obtained under not making creative work premise
Embodiment, broadly falls into the scope of protection of the invention.
Embodiment
A kind of drag teaching robot of can hovering by doing and illustrating as it is shown in figure 1, the present embodiment discloses, can be considered a kind of to
Industrial robot professor is about the instructional device of operating position data, especially for Six-DOF industrial robot, for
It has the data acquisition of robot operating position of 1:1 physical dimension, makes the terminal contacts can by optimized Structure Design
Arrive any one operating position easily, and by being arranged on the encoder record position of joint, its concrete structure is such as
Under:
The multi-joint arm being connected with described rotating seat 2 including pedestal 1, the rotating seat 2 that is fixed on pedestal 1, multi-joint arm
All it is rotationally connected by rotary joint axle with each joint connecting joint and multi-joint arm self of rotating seat 2, Mei Gesuo
State the encoder being respectively and fixedly provided with on rotary joint axle for recording rotary joint axle pose data, described encoder and control system
Electrical connection;It is equipped with for offset torque, the counterweight balancing mechanism of realization hovering on each described rotary joint axle, each described
The damping mechanism for compensating torque difference it is further fixed on rotary joint axle;
Described counterweight balancing mechanism includes the balancing weight h that weight linear meter e and weight can regulate, one end of described weight linear meter e
Propping up on balancing weight h, its other end is rotationally connected with described rotary joint axle;
The weight linear meter of current counterweight balancing mechanism and corresponding joint arm are separately positioned on current counterweight balance
The rotary joint axle both sides at mechanism place;
The balancing weight of current counterweight balancing mechanism is overall with the weight that all joint arms of its rear end, balancing weight are formed is working as
Balance at the rotary joint axle at front counterweight balancing mechanism place.
Concrete, as it is shown in figure 1, for the robot where applicable of six degree of freedom, have six joint arms, respectively J1 closes
Joint arm 22, J2 joint arm 8, J3 joint arm 14, J4 joint arm 15, J5 joint arm 20, J6 joint arm 21;
There are three counterweight balancing mechanisms, respectively counterweight balancing mechanism 1, counterweight balancing mechanism 2 12, counterweight balance
Mechanism 3 16;
There are three rotary joint axles, respectively rotary joint axle 1, rotary joint axle 29, rotary joint axle 3 17;
There are three damping mechanisms, respectively damping mechanism 1, damping mechanism 2 10, damping mechanism 3 18;
There are three encoders, respectively encoder 1, encoder 2 11, encoder 3 19;
Encoder 1 and damping mechanism 1 are fixed on rotary joint axle 1;
Encoder 2 11 and damping mechanism 2 10 are fixed on rotary joint axle 29;
Encoder 3 19 and damping mechanism 3 18 are fixed on rotary joint axle 3 17.
Rotating seat 2 is fixed on pedestal 1, and can be with 360 ° of rotations, the weight linear meter one 4 and J2 of weight linear meter balanced controls 1
Joint arm 8 is in one end of rotating seat 2, and can rotate around rotary joint axle 1, and damping mechanism 1 is fixed with encoder 1
On rotary joint axle 1, and weight linear meter 1 and J2 joint arm 8 are respectively in the both sides of rotating seat 2, become 180 degree of straight lines, counterweight
Bar 1 can not interfered with rotating seat 2, J1 joint arm 22 around around rotary joint axle 1 rotation with J2 joint arm 8;
Counterweight balancing mechanism 2 12 and J3 joint arm 14, respectively in the both sides of J2 joint arm 8, become 180 degree of straight lines, and counterweight is put down
Weighing apparatus mechanism 2 12 can rotate around rotary joint axle 29 with J3 joint arm 14 and not interfere with J2 joint arm 8;
Counterweight balancing mechanism 3 16 and J5 joint arm 20 can rotate around rotary joint axle 3 17, counterweight balancing mechanism 3 16
With J5 joint arm respectively in the both sides of J4 joint arm 18, becoming 180 degree of straight lines, counterweight balancing mechanism 3 16 and J5 joint arm can be around
Rotary joint axle 3 17 rotates and does not interferes with J4 joint arm.
Counterweight balancing mechanism 3 16 and the J5 joint arm 20 of end, J6 joint arm 21 balance at rotary joint axle 3 17;
Counterweight balancing mechanism 2 12 and rear end J3 joint arm 14, J4 joint arm 15, J5 joint arm 20, J6 joint arm 21, join
The weight that weight balanced controls 3 16 are formed is overall to be balanced at rotary joint axle 29;
Counterweight balancing mechanism 1 closes with rear end J2 joint arm 8, J3 joint arm 14, J4 joint arm 15, J5 joint arm 20, J6
The overall balance at rotary joint axle 1 of weight that joint arm 21, counterweight balancing mechanism 2 12, counterweight balancing mechanism 3 16 are formed.
So, the mode that the present invention uses counterweight to balance completely carrys out the imbalance of offset torque, makes teaching operation lighter,
The counterweight balance that simultaneously can regulate, can be maximum compared to traditional teaching robot so that it can realize hovering
Reduce cost.
Damping mechanism compensates torque difference by the way of regulation rotating friction force so that hovers more reliable, and keeps.
Concrete, as in figure 2 it is shown, described balancing weight h includes balancing weight body h1 and the regulating block h2 being attached thereto, described
Balancing weight body h1 and regulating block h2 can be detachably fixedly arranged on described weight linear meter e by securing member, adjustable weight
Balancing weight h teaching robot's entirety can be hovered, make teaching operation more convenient.
Concrete, as it is shown on figure 3, described damping mechanism includes rub base a, friction adjusting base b and friction plate c, institute
Stating friction base a to be fixed on rotary joint axle, described friction adjusting base b is fixed on pedestal, with described rotary joint axle
Produce and be equipped with described friction plate c on the face that relative motion, described friction base a and friction adjusting base b are oppositely arranged,
By the mutual frictional force between regulation bolt d two friction plate c of regulation.Damping mechanism is by regulating the side of rotating friction force
Formula compensates torque difference so that hovers more reliable, and keeps.
Described above to the disclosed embodiments, makes professional and technical personnel in the field be capable of or uses the present invention.
Multiple amendment to these embodiments will be apparent from for those skilled in the art, as defined herein
General Principle can realize without departing from the spirit or scope of the present invention in other embodiments.Therefore, the present invention
It is not intended to be limited to the embodiments shown herein, and is to fit to and principles disclosed herein and features of novelty phase one
The widest scope caused.