A kind of three-wheel foot formula string and series-parallel robot
Technical field
The invention belongs to the Multifeet walking robot field, especially relate to a kind of three-wheel foot formula string and series-parallel robot mechanism.
Technical background
At present both at home and abroad the traveling gear of robot can be divided into wheeled, leg formula, crawler type etc. by move mode.Yet they all exist corresponding defective separately, and wheeled construction speed is fast, and control is flexible, but obstacle climbing ability is limited.Leg formula structure is adaptable, sight might as well, but energy consumption is large, control is complicated, and is unsuitable for alerting ability, occasion that rapidity requirement is high.Caterpillar mobile robot weight is large, and energy consumption is high.
Summary of the invention
Can not take into account the deficiency of simple in structure, alerting ability and rapidity in order to overcome the robot that is movably walking, the present invention proposes a kind of in simplified structure, three-wheel foot formula string and series-parallel robot with good alerting ability and rapidity.
For the technical scheme that solves the problems of the technologies described above proposition is:
A kind of three-wheel foot formula string and series-parallel robot, described three-wheel foot formula string and series-parallel robot comprise carrying platform, battery, control system, the wheel foot combined type movement side chain of camera and 3 6DOFs, on the described carrying platform battery is installed, control system and camera, the described sufficient combined type movement side chain of taking turns is installed below described carrying platform, described take turns sufficient combined type movement side chain comprise the driftage joint, the driftage knuckle support, upper pitching joint, thigh, middle pitching joint, middle pitching knuckle support, upper roll joint, shank, lower pitching joint, lower pitching knuckle support, lower roll joint, power wheel support and power wheel, captive joint with described carrying platform below in described driftage joint, described driftage joint is installed in driftage knuckle support top, described driftage knuckle support side is installed the pitching joint, captive joint with the thigh upper end in upper pitching joint, described thigh lower end is connected with middle pitching joint, described middle pitching joint is installed on the middle pitching knuckle support, described middle pitching knuckle support is connected with lower roll joint, described lower roll joint is connected with the shank upper end, described shank lower end is connected with lower pitching joint, described lower pitching joint is installed on the lower pitching knuckle support, described lower pitching knuckle support is connected with lower roll joint, described lower roll joint is connected with the power wheel support, on the described power wheel support power wheel is installed.
Further, rotary joint is all adopted in described driftage joint, upper pitching joint, middle pitching joint, upper roll joint, lower pitching joint, lower roll joint, and described rotary joint comprises joint shell, left end output bearing, left end cap, absolute encoder fixed muffle, absolute encoder, output flange, the oval plug of wave producer, wave producer bearing, flexbile gear, steel wheel, fixed mount, key, input flange, planetary gear, sleeve, DC servo motor, drg, incremental encoder, incremental encoder fixed muffle, right-hand member output bearing and right end cap; Absolute encoder is positioned the absolute encoder base by the absolute encoder fixed muffle, the joint shell is rotatably connected by left end output bearing and absolute encoder base, the joint shell is affixed by screw and fixed mount simultaneously, fixed mount is by the steel wheel of the affixed harmonic speed reducer of bolt, the flexbile gear of harmonic speed reducer is fixed together by bolt and input flange, the oval plug of output flange and wave producer joins with screw, and the output shaft of planetary gear is connected with output flange by key, sleeve is captiveed joint with the incremental encoder base with input flange respectively by bolt, described planetary gear, DC servo motor, drg and incremental encoder are positioned at sleeve, drg is connected with incremental encoder, DC servo motor output shaft one end is connected with drg, the DC servo motor output shaft other end is connected with planetary gear, joint shell and right end cap are forwarded by the right-hand member output shaft and are dynamically connected, and incremental encoder is located and is fixed in the right end cap by the incremental encoder fixed muffle.
Further again, the angle on the every limit of described carrying platform is 60 °, and carrying platform is the equilateral triangle shape.
Technical conceive of the present invention is: because existing wheeled, leg formula, crawler type mechanism have merits and faults, if will be wherein 2 kinds or various structures combines, performance advantage separately remedies deficiency each other, and the walking performance of robot is very significantly improved.
Three-wheel foot formula string and series-parallel robot have that rigidity is large, load-carrying capacity is strong, mode of motion is flexible, the volume magnification ratio large, obstacle detouring and climb very steep slopes ability by force, the characteristics such as multi-function operation.This is adapted in the complex environments such as the moon or martian surface so that this robot has wide military affairs and space operation purposes, and assistance even alternative cosmonaut carry out space exploration task.Therefore, research three-wheel foot formula string and series-parallel robot are for exploitation new construction Multifeet walking robot, and the application of widening Multifeet walking robot has important theory and engineering significance.
The useful effect that the present invention has is:
1. large many than single wheeled, leg formula, crawler type mechanism of the working space of novel three-wheeled sufficient formula string provided by the invention and series-parallel robot mechanism, can finish the large space scope obstacle detouring, cross abrupt slope and other tasks;
2. " shank " of each movement branched chain of novel three-wheeled sufficient formula string of the present invention and series-parallel robot mechanism can fold advance " thigh " inner, " thigh " then arranged along each edge direction of carrying platform triangle, this structure so that whole robot all be contracted within the carrying platform triangle scope, although this volumetric shrinkage than large characteristics so that three-wheel foot formula string and series-parallel robot joint component One's name is legion, but the volume after shrinking is little, be easy to carry very much, be particularly suitable for parking and delivering of the limited spacecraft in inner space;
3. novel three-wheeled sufficient formula string and series-parallel robot mechanism also have other several functions.Carrying platform installed inside battery and computer controller can be controlled the robot motion, and to each joint motor power supply of robot.
4. camera is installed in the carrying platform triangle outside, can make this robot carry out walking, obstacle detouring, keep away the multitasks such as barrier, target crawl, boring, detection, transportation, maintenance, assembling, automatic butt, recharging, multimachine co-ordination by visual processes and motion control;
5. novel three-wheeled sufficient formula string of the present invention and series-parallel robot are simple in structure, rationally distributed;
6. novel three-wheeled sufficient formula string of the present invention and series-parallel robot have the characteristics such as rigidity is large, mode of motion is flexible.
Description of drawings
Fig. 1 is three-wheel foot formula string and series-parallel robot schematic three dimensional views.
Fig. 2 is the sufficient formula movement branched chain schematic three dimensional views of wheel.
Fig. 3 is the joint cutaway view.
Fig. 1: 1, the sufficient formula movement branched chain of wheel, 2, camera, 3, battery unit, 4, control system, 5, carrying platform;
Fig. 2: 6, power wheel, 7, the power wheel support, 8, the roll joint, 9, the pitching knuckle support, 10, the pitching joint, 11, shank, 12, the roll joint, 13, the pitching knuckle support, 14, the pitching joint, 15, thigh, 16, the pitching joint, 17, the driftage knuckle support, 18, the driftage joint;
Fig. 3: 19, joint shell, 20, left end output bearing, 21, left end cap, 22, absolute encoder fixed muffle, 23, absolute encoder, 24, output flange, 25, the oval plug of wave producer, 26, wave producer bearing, 27, flexbile gear, 28, steel wheel, 29, fixed mount, 30, key, 31, input flange, 32, planetary gear, 33, sleeve, 34, DC servo motor, 35, drg, 36, incremental encoder, 37, the incremental encoder fixed muffle, 38, right-hand member output bearing, 39, right end cap.
The specific embodiment
The present invention will be further described below in conjunction with accompanying drawing.
With reference to Fig. 1~Fig. 3, a kind of three-wheel foot formula string and series-parallel robot are taken turns sufficient formula movement branched chain 1 and are formed by carrying platform 5, camera 2, control unit 4, battery unit 3 and 3 structures are duplicate.
Described each movement branched chain is by driftage joint 18, driftage knuckle support 17, upper pitching joint 16 as seen from Figure 2, middle pitching joint 14, lower pitching joint 10, middle pitching knuckle support 13, middle pitching knuckle support 9, upper roll joint 12, lower roll joint 8, thigh 15, shank 11, power wheel 6, power wheel support 7 consist of.
The end cap in driftage joint 18 is fixed together by screw and carrying platform 5, without relatively rotating, and the joint shell in the joint 18 of going off course simultaneously is connected with driftage knuckle support 17 by screw and drive 17 rotations of driftage knuckle support, driftage knuckle support 17 is affixed by the end cap in screw and upper pitching joint 16, without relatively rotating, the joint shell in upper pitching joint 16 is connected with thigh 15 by screw and drives thigh 15 and rotates, thigh 15 is affixed by the end cap in screw and middle pitching joint 14, without relatively rotating, the joint shell in middle pitching joint 14 is connected with middle pitching knuckle support 13 by screw and drives pitching knuckle support 13 and rotates, in to face upward knuckle support 13 affixed by the end cap in screw and upper roll joint 12, without relatively rotating, the joint shell in upper roll joint 12 is connected with shank 11 by screw and drives shank 11 and rotates, shank 11 is affixed by the end cap in screw and lower pitching joint 10, without relatively rotating, the joint shell in lower pitching joint 10 is connected with lower pitching knuckle support 9 by screw and drives pitching knuckle support 9 and rotates, it is affixed by the end cap in screw and lower roll joint 8 to face upward down knuckle support 9, without relatively rotating, the joint shell in lower roll joint 8 is connected with power wheel support 7 by screw and drives 7 rotations of power wheel support, and power wheel support 7 is connected with power wheel 6.
As shown in Figure 3, described joint is comprised of joint shell 19, left end output bearing 20, left end cap 21, absolute encoder fixed muffle 22, absolute encoder 23, output flange 24, the oval plug 25 of wave producer, wave producer bearing 26, flexbile gear 27, steel wheel 28, fixed mount 29, key 30, input flange 31, planetary gear 32, sleeve 33, DC servo motor 34, drg 35, incremental encoder 36, incremental encoder fixed muffle 37, right-hand member output bearing 38, right end cap 39.
Absolute encoder 23 is positioned left end cap 21 by absolute encoder fixed muffle 22, joint shell 19 is rotatably connected with absolute encoder base 21 by left end output bearing 20, joint shell 19 is affixed by screw and fixed mount 29, fixed mount 29 is by the steel wheel 28 of the affixed harmonic speed reducer of bolt, the steel wheel 28 of described harmonic speed reducer and 27 engagements of the flexbile gear of harmonic speed reducer, the flexbile gear 27 of harmonic speed reducer is fixed together by bolt and input flange 31, output flange 24 joins with the oval plug of wave producer 25 usefulness screws, and the output shaft of planetary gear 32 is connected with output flange 24 by key, sleeve 33 is captiveed joint with right end cap 39 with input flange 31 respectively by bolt, described planetary gear 32, DC servo motor 34, drg 35 and incremental encoder 36 are positioned at sleeve 33, drg 35 is connected with incremental encoder 36, DC servo motor 34 output shafts one end is connected with drg 35, the other end is connected with planetary gear 32, joint shell 19 is rotationally connected by right-hand member output bearing 38 with right end cap 34, and incremental encoder 36 is located and is fixed in the right end cap 39 by incremental encoder fixed muffle 37.
The principle of work of the said three-wheel foot formula string of the present invention and series-parallel robot is to come shank and the rotation of thigh and locking and the rotation of control power wheel in the controlled motion side chain by the rotation of controlling DC servo motor 34 in three movement branched chain, thereby realize 2 kinds of motions of carrying platform 5, i.e. walking movement and rolling are advanced.
And the principle of work in each joint is that planetary gear 32 is by output flange 24 and the oval plug 25 of key 30 driving wave producers, the oval plug 25 of wave producer further drives steel wheel 28 by wave producer bearing 26 and flexbile gear 27, joint shell 19 is affixed by fixed mount 29 and steel wheel 28, thereby the rotation of steel wheel 28 is delivered to joint shell 19.In this joint, flexbile gear 27 connects firmly together with input flange 31, planetary gear 32, sleeve 33, DC servo motor 34, drg 35, incremental encoder 36, incremental encoder fixed muffle 37, right end cap 39, do not relatively rotate between them, so joint shell 19 is rotatably connected with left end cap 21 and right end cap 39 by left end output bearing 20 and right-hand member output bearing 38, and exists between them and relatively rotate.Therefore when DC servo motor 34 is rotated, relatively rotating after harmonic speed reducer slows down just arranged between joint shell 19 and left end cap 21 and the right end cap 39, joint shell 19 just can drive affixed thigh 15 and shank 11 thereon and rotate.
Three-wheel of the present invention foot formula string and series-parallel robot by wheel foot combined type movement side chain, carrying platform, battery, the control system of 3 6DOFs, shooting is first-class forms, as shown in Figure 1.Each movement branched chain is identical, and can become the mechanical arm of independently connecting, as shown in Figure 2.Each is taken turns sufficient formula movement branched chain and contains driftage, pitching, pitching, roll, pitching, roll joint, pitching, driftage support and power wheel and power wheel support.The robot carrying platform is designed to equilateral triangle, and each movement branched chain is installed in carrying platform equilateral triangle vertex position by the driftage joint.The movement branched chain end is power wheel.In described each movement branched chain, upper pitching joint is rotatably connected by driftage joint and carrying platform, thigh and upper pitching joint are for being rotationally connected, again with middle pitching joint for being rotationally connected, upper roll joint can be rotated around middle pitching joint, shank and lower pitching joint and upper roll joint are for being rotationally connected, and lower roll joint can be rotated around lower pitching joint, and power wheel can rotate around lower roll joint.
Shank is rotatable until fold in thigh around the pitching joint in the above-mentioned movement branched chain, and thigh can be in the pitching joint turns folding the carrying platform triangle, and it is arranged along each edge direction of carrying platform triangle, thereby so that the whole piece movement branched chain all be contracted within the carrying platform triangle scope.
In the described joint, as shown in Figure 3, absolute encoder is positioned the absolute encoder base by the absolute encoder fixed muffle, the joint shell is rotatably connected by left end output bearing and absolute encoder base, affixed by screw and fixed mount simultaneously, fixed mount is by the steel wheel of the affixed harmonic speed reducer of bolt, the flexbile gear of harmonic speed reducer is fixed together by bolt and input flange, the oval plug of output flange and wave producer joins with screw, and the output shaft of planetary gear is connected with output flange by key, sleeve is captiveed joint with the incremental encoder base with input flange respectively by bolt, described planetary gear, DC servo motor, drg and incremental encoder are positioned at sleeve, drg is connected with incremental encoder, DC servo motor output shaft one end is connected with drg, the other end is connected with planetary gear, joint shell and incremental encoder base are forwarded by the right-hand member output shaft and are dynamically connected, and incremental encoder is located and is fixed in the incremental encoder base by the incremental encoder fixed muffle.
The steel wheel of the harmonic speed reducer in the above-mentioned joint is fixed together by bolt and fixed mount, and the joint shell is affixed by screw and fixed mount, so can be with the movable joint shell to rotate together when steel wheel rotates.The wave producer of harmonic speed reducer has been removed coupler, directly is connected by screw by output flange and drives the oval plug rotation of wave producer, designs like this escapable cost and alleviates joint weight.