The manual device of the universal isomery formula of 6DOF robot
One, technical field
The present invention relates to the manual device of the universal isomery formula of human-computer interface device, especially 6DOF robot of robot control.
Two, background technology
Along with the extensive use of interactive teleoperation robot, the human-computer interface device that needs are a large amount of with power feel feedback effect.The manual device of data glove and robot is the human-computer interface device of two kinds of common teleoperation robots, because the variation that data glove can't be measured the human arm joint, and lack effective power feel feedback, therefore, the manual device of robot is the most effective human-computer interface device of realizing teleoperation robot control, it follows the tracks of the motion of staff on the one hand as the virtual machine hand in control instruction control manipulator or the virtual reality by the positional information of measure operator hand, on the other hand, power feel and tactile data that robot is fed back convert power or the moment that directly acts on staff to, make the operator be created in the power feel/sense of touch telepresenc effect that machine far away is manually done " on the spot in person " of scene or virtual robot working site, thereby realize control, perhaps in virtual environment, produce the real impression that touches robot band sensation.The manual device of robot can be divided into two kinds of isomorphism formula and isomery formulas, and existing hand controller mostly is the isomorphism formula, and isomorphism formula hand controller has the identical structure and the free degree with manipulator far away, takes the joint---the type of drive in joint.Though robot isomorphism formula hand controller control is simple, the robot control that it can only be used for specific model lacks versatility.Therefore, universal hand controller all adopts the isomery mode different with the robot architecture, and existing isomery formula hand controller has form of a stroke or a combination of strokes operation lever structure, parallel-connection structure, series/parallel mixed structure, incorporate closed chain formula structure and based on the isomery formula hand controller of Delta mechanism.The shortcoming of preceding 4 kinds of isomery formula hand controllers is to exist translation and the motion coupling between the rotation and the coupling of power that can't overcome, a kind of isomery formula hand controller shortcoming based on Delta mechanism in back is that working space is little, can't overcomes the influence of gravity, and controls complicated.
Three, technology contents
Technical problem the invention provides a kind of manual device of the universal isomery formula of 6DOF robot that helps improving certainty of measurement, and it can eliminate 3 dimension translations and 3 couplings of tieing up between rotating from structure itself.
The manual device of the universal isomery formula of a kind of 6DOF of technical scheme robot, by hand driving mechanism 10, support 1 and counterweight 2 are formed, on support 1, be provided with two parallel linkage mechanisms 8, this pair parallel linkage mechanism 8 is made of 3~4 link rods, three 2DOF universal joints are arranged on every link rod, on the universal joint that occupies the link rod centre, be provided with and detect the wherein angular displacement sensor 3 of one-dimensional translation, occupying the angular displacement sensor 4 that is provided with another dimension translation of detection on the middle universal joint of another link rod, two parallel linkage mechanism 8 is connected with counterweight connector 5 by being positioned at its 2DOF universal joint on one side, on this counterweight connector 5, be provided with the plane, this plane is connected with the above-mentioned 2DOF universal joint that is positioned at one side of two parallel linkage mechanisms 8, counterweight 2 is located on the counterweight connector 5, two parallel linkage mechanism by the position thereon the 2DOF universal joint of another side connect link mechanism connector 7, on this link mechanism connector 7, be provided with 2 orthogonal planes, wherein the 2DOF universal joint of another side is connected in a plane and the two parallel linkage mechanisms 8, on another plane, be rotatably connected to single parallel linkage mechanism 9, list parallel linkage mechanism 9 is rotatably connected to connector 6 again, this list parallel linkage mechanism 9 comprises 2 link rods at least, one end of these link rods and another plane of above-mentioned link mechanism connector 7 are rotationally connected, the other end of link rod and connector 6 are rotationally connected and tie point is positioned at same plane, on being rotationally connected a little, single parallel linkage mechanism 9 arbitrary be provided with the angular displacement sensor 11 that is used to detect again one-dimensional translation, be provided with on connector 6 and parallel plane plane, single parallel mechanism tie point place, hand rotating mechanism 10 is located on this plane.
Beneficial effect (1) the present invention realizes three-dimensional translating by single, double parallel linkage mechanism, and realize Three dimensional rotation by the hand rotating mechanism, make translation and rotate and can not be coupled, therefore, tie up translations and 3 couplings of tieing up between rotating from the structure supernatant except 3, center of gravity of the present invention falls within on the support, has avoided gravity to influence of the present invention, helps the raising of certainty of measurement.This technical scheme of the present invention combines with the measure of force feedback motor technology, the present invention is become have the hand controller of force feedback function, it can avoid position measurement and power feel in the reproducing control process translation with rotate between complicated coupled relation, improve the authenticity of certainty of measurement and power feel perception.(2) technical scheme of parallel linkage mechanism is compared with original Δ one mechanism and to be had less but the advantage that working space is bigger of volume.(3) hand rotating mechanism mutually vertical with 3 and that rotatable parts can close rotation constitute of the present invention has changed spherical rotating mechanism of the prior art, have easy to operate, not only can realize the moment feedback function of wrist, and the moment that can realize finger-joint is fed back kinetic energy, especially after the present invention has adopted the technical measures of torque motor, make the present invention become force feedback hand controlled device, and said structure have the advantage of being convenient to control motor realizable force feedback.(4) after the present invention adopts the fingerstall structure that the same dimension of an opposing connection rotates, make the present invention not only can control the motion of manipulator, and can directly control the extracting campaign of mechanical claw, job tasks such as the people's that is particularly suitable for operating machine grasping, stitching.
Four, description of drawings
Fig. 1 is the structural representation of the embodiment of the invention.
Fig. 2 is the structural representation of the two parallel linkage mechanism for implementing examples of the present invention.
Fig. 3 is the structural representation of two another embodiment of parallel linkage mechanism of the present invention.
Fig. 4 is the structural representation of the single parallel linkage mechanism for implementing of the present invention example.
Fig. 5 is the structural representation of hand rotating mechanism embodiment of the present invention.
Fig. 6 is the structural representation of another embodiment of hand rotating mechanism of the present invention.
" Δ " mark represents that this place maintains static among the figure, specifically can adopt the mode or other the fixed connected modes that link to each other with support.
Five, specific embodiments
Embodiment 1 present embodiment relates to the manual device of the universal isomery formula of a kind of 6DOF robot, by hand driving mechanism 10, support 1 and counterweight 2 are formed, it is characterized in that on support 1, being provided with two parallel linkage mechanisms 8, this pair parallel linkage mechanism 8 is made of 3~4 link rods, three 2DOF universal joints are arranged on every link rod, on the universal joint that occupies the link rod centre, be provided with and detect the wherein angular displacement sensor 3 of one-dimensional translation, occupying the angular displacement sensor 4 that is provided with another dimension translation of detection on the middle universal joint of another link rod, two parallel linkage mechanism 8 is connected with counterweight connector 5 by being positioned at its 2DOF universal joint on one side, on this counterweight connector 5, be provided with the plane, this plane is connected with the above-mentioned 2DOF universal joint that is positioned at one side of two parallel linkage mechanisms 8, counterweight 2 is located on the counterweight connector 5, counterweight connector 5 can constitute integral body with counterweight 2, can adopt and directly on counterweight, establish a plane and be connected with universal joint by this plane, counterweight connector 5 also can adopt the branch body structure with counterweight 2, can adopt and on counterweight connector 5, establish a screw rod and counterweight 2 is revolved thereon, two parallel linkage mechanism by the position thereon the 2DOF universal joint of another side connect link mechanism connector 7, on this link mechanism connector 7, be provided with 2 orthogonal planes, wherein a plane is connected with another 2DOF universal joint that connects in two parallel linkage mechanisms 8, on another plane, be rotatably connected to single parallel linkage mechanism 9, list parallel linkage mechanism 9 is rotatably connected to connector 6 again, this list parallel linkage mechanism 9 comprises 2 link rods at least, one end of these link rods and another plane of above-mentioned link mechanism connector 7 are rotationally connected, the other end of these link rods and connector 6 are rotationally connected and tie point is positioned at same plane, on being rotationally connected a little, single parallel linkage mechanism 9 arbitrary be provided with the angular displacement sensor 11 that is used to detect again one-dimensional translation, on connector 6, be provided with and parallel plane plane, single parallel mechanism tie point place, hand rotating mechanism 10 is located on this plane, hand rotating mechanism 10 comprises 3 rotatable parts 12,13,14, these 3 rotatable parts 12,13,14 is mutually vertical and be rotationally connected, at 3 rotatable parts 12,13, be respectively equipped with angular displacement sensor 15 on 14,16 and 17, one of them rotatable parts is " U " shape framework, two rotatable parts are respectively rotating shaft 131 and 141 in addition, are fixed with fingerstall on the rotatable parts 14.Embodiment 2 present embodiments relate to the manual device of the universal isomery formula of a kind of 6DOF robot, by hand driving mechanism 10, support 1 and counterweight 2 are formed, it is characterized in that on support 1, being provided with two parallel linkage mechanisms 8, this pair parallel linkage mechanism 8 is made of 3~4 link rods, three 2DOF universal joints are arranged on every link rod, on the universal joint that occupies the link rod centre, be provided with and detect the wherein angular displacement sensor 4 of one-dimensional translation, occupying the angular displacement sensor 3 that is provided with another dimension translation of detection on the middle universal joint of another link rod, two parallel linkage mechanism 8 is connected with counterweight connector 5 by being positioned at its 2DOF universal joint on one side, on this counterweight connector 5, be provided with the plane, this plane is connected with the above-mentioned 2DOF universal joint that is positioned at one side of two parallel linkage mechanisms 8, counterweight 2 is located on the counterweight connector 5, two parallel linkage mechanism by the position thereon the 2DOF universal joint of another side connect link mechanism connector 7, on this link mechanism connector 7, be provided with 2 orthogonal planes, wherein the 2DOF universal joint of another side is connected in a plane and the two parallel linkage mechanisms 8, on another plane, be rotatably connected to single parallel linkage mechanism 9, list parallel linkage mechanism 9 is rotatably connected to connector 6 again, this list parallel linkage mechanism 9 comprises 2 link rods at least, one end of these link rods and another plane of above-mentioned link mechanism connector 7 are rotationally connected, the other end of these link rods and connector 6 are rotationally connected and tie point is positioned at same plane, on being rotationally connected a little, single parallel linkage mechanism 9 arbitrary be provided with the angular displacement sensor 11 that is used to detect again one-dimensional translation, on connector 6, be provided with and parallel plane plane, single parallel mechanism tie point place, hand rotating mechanism 10 is located on this plane, hand rotating mechanism 10 comprises 3 rotatable parts 12,13,14, these 3 rotatable parts 12,13,14 is mutually vertical and be rotationally connected, at 3 rotatable parts 12,13, be respectively equipped with angular displacement sensor 15 on 14,16 and 17, rotatable parts 12 are " U " shape framework, another rotatable parts 14 are made up of 2 rotating shafts 141 and 142, on rotating shaft 141 and 142, be fixed with fingerstall 18 and 19 respectively, occupy on the link rod interposition universal joint in two parallel online structures and be provided with one-dimensional translation force feedback motor 20, be provided with another dimension translation force feedback motor 21 in the middle of another root link rod on universal joint occupying, on being rotationally connected a little, single parallel linkage mechanism arbitrary be provided with one-dimensional translation force feedback motor 22 again, at three rotatable parts 12 of hand rotating mechanism 10, be respectively equipped with moment feedback motor 23 on 13 and 14,24 and 25.The rotating element of above-mentioned angular displacement sensor and force feedback motor or moment feedback motor can be located on the same universal joint or make it constitute an overall structure, and promptly the rotating element of angular displacement sensor is fixedlyed connected (with reference to Fig. 3) with the output shaft of force feedback motor or moment feedback motor.