CN201525026U - Modular disaster relief robot - Google Patents

Abstract

The utility model discloses a modular disaster relief robot, which comprises a hexagonal main body module and a manipulator arranged on the main body module. The main body module is connected with a moving mechanism. The main body module comprises an identification unit, a movement control unit, a communication unit and a total control unit which are mutually communicated with by using bus technology, wherein the identification unity identifies movement means of the moving mechanism, and the movement control unit establishes a kinematical model according to the movement means and drives the moving mechanism in motion. A main body of the manipulator is a five-degree-of-freedom robot manipulator, a steering engine and a hand holding mechanism are arranged on the manipulator, and the steering engine is connected with the total control unit. By adopting the modular mechanical connection scheme of 'building block type', the modular disaster relief robot utilizes a mechanical self-adaptive double-track guide rail to fulfill the function of 'plug and play', realizes one object serving multiple purposes by using the main body module as a platform, and can quickly assemble various task modules according to environment and mission types kinematic.

Description

Modular disaster assistance robot

Technical field

The utility model relates to a kind of robot, relates in particular to a kind of modularization robot that can be applied in the disaster assistance.

Background technology

Natural calamities such as earthquake in China and the world wide, fire, flood take place frequently in recent years.Especially in 8.0 grades of Wenchuan violent earthquakes that take place May 12 this year, have 69207 to die in an accident.Many rescue actions in the earthquake relief work process, stranded because the rescue site situation is complicated.Wherein mostly because the rescue personnel can't enter in the ruins of narrow and small danger extends efficient help for the survivor.Multi-subject knowledges such as Robotics, rescue attempt technology, disaster are organically blended, the multi-functional disaster relief robot that development and exploitation are used to search and succour, be challenging frontier in the robotics research, be badly in need of a new difficult problem that solves especially under the New Times background.

So, many colleges and universities both domestic and external and research institute at rescue robot, independently rescue unmanned plane and ground and move rescue robot technical elements such as job that requires special skills robot and carried out research.Yet existing rescue, detection equipment be the kind complexity again, and none total system is with the various device realization that combines, realize modular multipurpose application, as various device is learnt from other's strong points to offset one's weaknesses, with technical approach it is integrated into task system unified, that possess interchangeability, will strengthens disaster assistance ability and dynamics greatly.Simultaneously, ripe rescue robot involves great expense, and unit price all more than hundreds thousand of dollars, is not suitable for a large amount of equipments, reaches when disaster takes place and uses on a large scale, is difficult to adapt to China's actual conditions.

For adapting to multiple space environment and mission requirements, robot need possess the adaptive capacity of various landform and the compatibility and the interchangeability of various functional units.The research of existing disaster robot can be divided into single basic machine, distributed control two general orientation.

The multipurpose rescue robot mechanical systems of single basic machine is fixed, and the chassis pattern is single, and load capacity is strong.This mode develops early, and is comparatively ripe, mostly is at special occasion design, because fixing chassis pattern can't adapt to the quick switching of multiple environment and different task function.

And multi-robot system can be realized the group certainly and the reconstruct of mechanical profile.The many child robots identical by several profiles, that function is different of this kind robot constitute, and assemble according to different environment, to adapt to different demands.But because the self structure characteristics, load capacity is less.

The utility model content

The purpose of this utility model provides a kind of being applied in the disaster assistance, has single body formula and has the robot that strong load capacity has both the flexible interchangeability of multirobot again.

For achieving the above object, the utility model is by the following technical solutions:

The utility model comprises hexagonal main body module and is positioned at mechanical arm on the main body module that main body module is connected with travel mechanism; Main body module comprises recognition unit, motion control unit, communication unit and the Master Control Unit that utilizes bussing technique to intercom mutually, wherein, the move mode of recognition unit identification travel mechanism, motion control unit are set up kinematics model according to this move mode and are driven travel mechanism's motion; The body of mechanical arm is a robot arm with five frees degree, is provided with steering wheel and hand clamping device on motion arm, and steering wheel is connected with Master Control Unit.

Above-mentioned travel mechanism comprises wheel undercarriage module and four coupled wheel modules, and each is taken turns module and all is connected with a motor; Motion control unit comprises motor and the velocity sensor thereof that is connected with the wheel module, the input of motor is connected with motor driver, the input of motor driver connects the pwm signal generator, the input of pwm signal generator connects the PID controller, the input of PID controller connects multiplier, described multiplier with the present speed value of velocity sensor sampling and historical speed value as input signal.

Above-mentioned travel mechanism comprises carries out leg chassis module and four coupled shoe leg modules, carries out the leg modules for four and is symmetrically distributed.

Above-mentioned travel mechanism comprises omnidirectional's wheel chassis module and three 90 ° of Sweden wheels that circumferentially evenly distribute and be provided with at omnidirectional's wheel chassis module.

The change in resistance of the potentiometer in each joint of mechanical arm is passed to Master Control Unit after through the AD conversion, after Master Control Unit converts thereof into corresponding angle value, pass to the steering wheel in each joint on the mechanical arm.

The entity framework of aforementioned body module adopts photosensitive resin material, and its post beam section is embedded.

Be provided with at least one guide rail on main body module, guide rail is connected with task module; Guide rail is meant the interface of main body module and task module.

Above-mentioned task module is any one or a few combination in audio-visual delivery module, vital signs detecting module, space environment measurement module, locus locating module, the medical aid module.

Adopt the utility model of technique scheme, adopt the modular mechanical connectivity scenario of " building block system ", the mechanical self adaptation two-orbit guide rail of utilization original creation is to finish " plug and play " function, with the main body module is that platform is realized one-object-many-purposes, can assemble the multiple-task module fast according to the kind of environment and task, realize needed comprehensive rescue function with the fastest time, not only had the strong load capacity of single body formula robot but also had both the flexible interchangeability of multi-robot system.In addition, it adopts the aviation socket of unified specification to carry out the circuit integration, and control system uses embedded microcontroller to realize distributed control.System organically will have mature technology now and integrate, and open scheme is adopted in electronics and programming, so product is more conducive to subsequent development and update.

The mechanical framework of main body module adopts the 3D rapid laser-shaping technique in the native system, uses SomosProtoTool 20L photosensitive resin material, and the digitlization threedimensional model is generated as entity via the 3D laser fast shaping.Manufacture process is quick, environmental protection, at utmost utilizes the technical advantage of CAD and CAM, strengthens the frame for movement performance, saves cost.Analyze through the finite element Structure Calculation, find that there is stress concentration point in the main body frame crossbeam, defectives such as pillar voltage endurance capability difference.For overcoming this defective, the embedded microstructure technology of post beam section is adopted in design, and effectively weight reduction strengthens the mechanical property of structure simultaneously.

Robot system adopts distributed control, adopts a main frame-many slaves structure.Wherein Master Control Unit is finished host computer communication, bus arbitration, task scheduling, path planning as main frame; Motion control units etc. are finished tasks such as motor PID closed loop, external event are corresponding, surrounding environment sensing as sub-controller.And be connected by high-speed bus between main frame and sub-controller.Adopt modified UART communication protocol, carry out bus arbitration, and carry out the equipment line data exchange of going forward side by side of shaking hands by broadcasting by master controller.Owing to only use the two-wire system bus, equipment room connecting line quantity significantly reduces, and by the aviation socket of rule routing scheme, Rapid Thermal plug cooperative mechanical connects the modular design of realization.

In addition, mechanical arm of designing voluntarily in the utility model and maneuverability pattern thereof, the wireless video transmission technology is combined with the multiple degrees of freedom Teaching instrument, the task visual field at operator first visual angle is provided, and operator's arm action directly can be controlled the motion of mechanical arm via teaching equipment.

Description of drawings

Fig. 1 is the structure chart of wheeled travel mechanism among the utility model embodiment 1;

Fig. 2 is the outling of truss figure of the utility model main body module;

Fig. 3 is the overall structure figure of robot among the utility model embodiment 1;

Fig. 4 is the electrical structure block diagram of main body module in the utility model;

Fig. 5 is the theory diagram of motion control unit among the utility model embodiment 1;

Fig. 6 is a PID control block diagram among the utility model embodiment 1;

Fig. 7 is the kinematics model of setting up among the utility model embodiment 1;

Fig. 8 is the schematic diagram that calculates running resistance in the utility model embodiment 1 kinematics model;

Fig. 9 is the structure diagram of mechanical arm in the utility model;

Figure 10 is the structural representation of mechanical arm and hand clamping device in the utility model;

Figure 11 is the electrical installation schematic diagram of the utility model integral body;

Figure 12 is the major cycle flow chart of main body module in the utility model;

Figure 13 is the progress of work figure of main body module in the utility model;

Figure 14 is the overall structure figure of robot among the utility model embodiment 3;

Figure 15 is the stretching, extension attitude athletic posture figure of robot among the utility model embodiment 3;

Figure 16 is the single-blade overlap joint attitude athletic posture figure of robot among the utility model embodiment 3;

Figure 17 lifts figure athletic posture figure for robot among the utility model embodiment 3;

Figure 18 is the overall structure figure of robot among the utility model embodiment 4;

Figure 19 is the overall reference frame kinematics model figure that sets up among the utility model embodiment 4;

Figure 20 is for adding the kinematics model figure of local reference frame among the utility model embodiment 4;

Figure 21 is the overall structure figure of robot among the utility model embodiment 6;

Figure 22 is the workflow diagram of task module among the utility model embodiment 7.

The specific embodiment

Embodiment 1

As Fig. 1, shown in Figure 3, present embodiment comprises hexagonal main body module 1 and is positioned at mechanical arm 4 on the main body module 1, and main body module 1 is connected with travel mechanism 3 by aviation plug, and in the present embodiment, travel mechanism 3 adopts wheeled travel mechanism.Wherein, main body module 1 provides power and master control for each travel mechanism 3, as heart and brain, guarantees whole normal operation.And after aviation plug connected, main body module 1 is the mobile chassis mode of identification travel mechanism 3 automatically, thereby uses the corresponding mobile program, reaches the effect of " plug and play ".This modularized design can be selected to adapt to the travel mechanism of this environment according to different rescue environment change travel mechanisms, thereby can bring into play the effect of rescue robot to the full extent, effectively improves its utilization ratio.

As shown in Figure 2, in the utility model, main body module 1 adopts hexagon as body nucleus module outling of truss.At first, hexagon space availability ratio height.Adopt hexagon as basic form as can be known from honeycomb, body module 1 adopts the hexagon outside framework can fully increase the inner space, effectively reduces space hold when pegging graft with the external world simultaneously; Secondly, hexagonal structure is firm, and mechanical property is good, and this point hexagonal structure from crystal is comparatively firm just as can be seen.In actual design, adopt finite element analysis software COSMOSWorks to carry out structural design analysis, optimal design goes out the most suitable hexagon outside framework, makes its intensity, rigidity, anti-pressure ability excellence, and is in light weight simultaneously, cost is reasonable, meets design requirement.

As shown in Figure 4, internally in the electrical control, main body module 1 comprises recognition unit, motion control unit, communication unit and the Master Control Unit that utilizes bussing technique to intercom mutually, wherein, the move mode of recognition unit identification travel mechanism 3, motion control unit are set up kinematics model according to this move mode and are driven travel mechanism's 3 motions; Master Control Unit is implemented monitoring to total system; Communication unit provides communication protocol, the communication between responsible each functional unit of internal system and the communication work of system and external command equipment.

In the present embodiment, travel mechanism 3 adopts wheeled travel mechanism.As shown in Figure 1, travel mechanism 3 comprises wheel undercarriage module 5 and four coupled wheel modules 6, and each is taken turns module 6 and all is connected with a motor 12.Wherein wheel undercarriage module 5 adopts differential driving, and they carry out drive to four motors 12, and this kind type of drive not only can provide powerful driving force, also has powerful obstacle detouring and climbing capacity, is particularly suitable for outdoor application.

On the basis of adopting wheeled travel mechanism, the motion control unit of present embodiment as shown in Figure 5, what this control was adopted is closed loop servo control, can guarantee that motor moves more exactly, it comprises motor 12 and the velocity sensor thereof that is connected with wheel module 6, the input of motor is connected with motor driver, the input of motor driver connects the pwm signal generator, the input of pwm signal generator connects the PID controller, the input of PID controller connects multiplier, and above-mentioned multiplier is with the present speed value n (t) and the historical speed value n of velocity sensor sampling ₀(t) as input signal.

What the constant speed control of one side wheel was adopted is the PID controller, and ratio P, the integration I and the differential D that are about to deviation constitute controlled quentity controlled variable by linear combination, with this controlled quentity controlled variable controlled device are controlled.

The expression formula of pid algorithm is in the simulation system:

$P\left(t\right)=K_p[e\left(t\right)+\frac{1}{T_I}\∫e\left(t\right)\mathrm{dt}+T_D\frac{\mathrm{de}\left(t\right)}{\mathrm{dt}}]---\left(1\right)$

In the formula (1): P (t) is the output of adjuster; E (t) is the deviation signal of adjuster, equals the poor of measured value and set-point; K _pProportionality coefficient for adjuster; T _iBe the time of integration of adjuster; T _DBe the derivative time of adjuster.

Computer control is a kind of controlling of sampling, can only calculate controlled quentity controlled variable according to the deviate of sampling instant, handles so must carry out discretization to following formula earlier, and the available summation expression formula of integration item represents that differential term available delta expression formula is represented:

${\∫}_0^{n}e\left(t\right)\mathrm{dt}=\underset{i=0}{\overset{n}{\mathrm{\Σ}}}e\left(i\right)\mathrm{\Δt}=T\underset{i=0}{\overset{n}{\mathrm{\Σ}}}e\left(i\right)$

$\frac{\mathrm{de}\left(t\right)}{\mathrm{dt}}\≈\frac{e\left(k\right)-e(k-1)}{\mathrm{\Δt}}=\frac{e\left(k\right)-e(k-1)}{T}$

Top two formula substitution (1) formulas can be obtained replacing with the difference equation of digital form the differential equation of continuous system:

$U\left(n\right)=\mathrm{Kp}\×e\left(n\right)+\mathrm{Ki}\underset{N=0}{\overset{n}{\mathrm{\Σ}}}e\left(n\right)+\mathrm{Kd}[e\left(n^{\′}\right)-e(n^{\′}-1)]---\left(2\right)$

Motor control signal output when U (n) is for sampling instant n in the formula (2), the site error value when e (n) is sampling instant n, Kp, Ki, Kd are respectively ratio, integration, the differential coefficient of PID controller, and n ' is the differential sampling time.The PID control block diagram of corresponding (2) formula as shown in Figure 6.

In Fig. 5, Kp plays proportional control action: the deviation of reaction system in proportion, and in a single day deviation has appearred in system, and ratio is regulated and is produced regulating action immediately to reduce deviation.Proportional action is big, can accelerate to regulate, and reduces error, but excessive ratio, makes the stability decreases of system.Only can there be steady-state error in the system of proportional control.

Ki plays autocatalytic reset action: the integration of the output of controller and error originated from input signal (all previous error amount summation) is proportional, can eliminate the steady-state error of system, improves no margin.Add the integration adjusting stability of a system is descended, dynamic response is slack-off, often is used in combination with other two kinds of adjusting rules.

Kd plays derivation regulating action: the differential of the output of controller and error originated from input signal (being the error change rate) is proportional, the rate of change of differential action reflection system deviation signal, has foresight, can produce leading control action, the leading amount of its introducing will be offset the error of inertial element and lag element generation.Therefore, can improve dynamic performance, reduce hyperharmonic and regulate the time.Regulate but cross strong differential, unfavorable to system's interference free performance.The differential action need be used in combination with other two kinds of adjusting rules equally.

In this process, motion control unit is that two caterpillar drive modes are set up kinematics model with the equivalence of wheeled travel mechanism.Suppose that at first robot crawler belt grounding pressure in the smooth-riding surface is evenly distributed, set up XOY base coordinate system as shown in Figure 7:

(1) average geostatic pressure:

The supposition vehicle weight is evenly distributed on the landing ground during calculating, but is difficult to accomplish that load distributes fully evenly, and in fact, the load that is positioned under inducer, the driving wheel is bigger.

$p=\frac{\mathrm{<figure-callout\; id="2"\; label="W"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">W</figure-callout>}}{2\mathrm{bL}},$ Wherein, W is a vehicle weight; B is a crawler width; L is the length that lands, and is the total length of two crawler belts of a side here.

(2) radius of turn:

Vehicle equivalent line speed $v_m=\frac{{\mathrm{<figure-callout\; id="1"\; label="v"\; filenames="H2009202241971E00011.png,H2009202241971E00032.png"\; state="\{\{state\}\}">v</figure-callout>}}_1+{\mathrm{<figure-callout\; id="2"\; label="v"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">v</figure-callout>}}_2}{2}$

The vehicle radius of turn $r_m=\frac{\mathrm{<figure-callout\; id="2"\; label="B"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">B</figure-callout>}}{2}\&times;\frac{{\mathrm{<figure-callout\; id="1"\; label="v"\; filenames="H2009202241971E00011.png,H2009202241971E00032.png"\; state="\{\{state\}\}">v</figure-callout>}}_1+v_2}{v_1-{\mathrm{<figure-callout\; id="2"\; label="v"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">v</figure-callout>}}_2}$

Left and right sides crawler belt/wheel reverse drive can be obtained the spin rotation; Monolateral crawler belt/wheel is stopped to obtain the pivot rotation.

(3) running resistance:

As shown in Figure 8, the running resistance of travel mechanism is mean resistance and rotational resistance sum, in common two caterpillar running systems system, is W as if establishing vehicle weight, then the resistance of left and right sides crawler belt

$R_r={\mathrm{\&mu;}}_0\frac{\mathrm{<figure-callout\; id="2"\; label="W"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">W</figure-callout>}}{2}+\frac{\mathrm{\&mu;WL}}{4B}$

$R_l={\mathrm{\&mu;}}_0\frac{W}{2}-\frac{\mathrm{\&mu;WL}}{4B}$

In the formula, μ ₀Be coefficient of rolling resistance; μ is the coefficient of friction of track and crawler belt.

Like this, under the kinematics model that PID controls and set up, motion control unit is divided into rectilinear motion and the two kinds of situations of turning with wheeled moving, and the wheel module 6 of robot both sides moves at the uniform velocity and realizes the rectilinear motion functions; The wheel module 6 of both sides oppositely or variable-speed motion realize that the robot slippage turns to.In the specific implementation, external command equipment sends control instruction, and the Master Control Unit in the main body module 1 receives this control instruction and conveys to each functional unit, each functional unit teamwork, make motor 12 move at last, robot just can be according to the instruction running of setting like this.

In addition, in the present embodiment, the body of mechanical arm 4 is the robot arms with five frees degree, on motion arm, be provided with steering wheel and hand clamping device, wherein, steering wheel is connected with Master Control Unit, and finishes actions such as various clampings according to the instruction of Master Control Unit.

As shown in Figure 9, mechanical arm 4 has five movable members, and five joints are formed, so its free degree is F=5 * 3-5 * 2=5.Therefore, when implementing, its support cradle head adopts TowerPro MG945 steering wheel to drive, and ancon and wrist joint then adopt TowerPro SG90 steering wheel to drive.

Table 1

By the motion arm connecting rod parameter of above-mentioned table 1, it is as follows to try to achieve the connecting rod transformation matrix:

${}_1{}^0\mathrm{<figure-callout\; id="1"\; label="T"\; filenames="H2009202241971E00011.png,H2009202241971E00032.png"\; state="\{\{state\}\}">T</figure-callout>}=\left[\begin{array}{c}{\mathrm{c\&theta;}}_1,-{\mathrm{s\&theta;}}_1,\mathrm{0,0}\\ {\mathrm{s\&theta;}}_1,{\mathrm{c\&theta;}}_1,\mathrm{0,0}\\ \mathrm{0,0,1,0}\\ \mathrm{0,0,0,1}\end{array}\right]$ ${}_2{}^1\mathrm{<figure-callout\; id="2"\; label="T"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">T</figure-callout>}=\left[\begin{array}{c}{\mathrm{c\&theta;}}_2,{-\mathrm{s\&theta;}}_2,\mathrm{0,0}\\ \mathrm{0,0,1,0}\\ {-\mathrm{s\&theta;}}_2,-{\mathrm{c\&theta;}}_2,\mathrm{0,0}\\ \mathrm{0,0,0,1}\end{array}\right]$ ${}_3{}^{2}T=\left[\begin{array}{c}{\mathrm{c\&theta;}}_3,-{\mathrm{s\&theta;}}_3,0,{\mathrm{<figure-callout\; id="2"\; label="l"\; filenames="H2009202241971E00091.png"\; state="\{\{state\}\}">l</figure-callout>}}_2\\ {\mathrm{s\&theta;}}_3,{\mathrm{c\&theta;}}_3,\mathrm{0,0}\\ \mathrm{0,0,1,0}\\ \mathrm{0,0,0,1}\end{array}\right]$

${}_4{}^3\mathrm{<figure-callout\; id="4"\; label="T"\; filenames="H2009202241971E00011.png,H2009202241971E00043.png"\; state="\{\{state\}\}">T</figure-callout>}=\left[\begin{array}{c}{\mathrm{c\&theta;}}_4,-{\mathrm{s\&theta;}}_4,0,l_3\\ {\mathrm{s\&theta;}}_4,{\mathrm{c\&theta;}}_4,\mathrm{0,0}\\ \mathrm{0,0,1,0}\\ \mathrm{0,0,0,1}\end{array}\right]$ ${}_5{}^4\mathrm{<figure-callout\; id="5"\; label="T"\; filenames="H2009202241971E00011.png"\; state="\{\{state\}\}">T</figure-callout>}=\left[\begin{array}{c}{\mathrm{c\&theta;}}_5,{-\mathrm{s\&theta;}}_5,\mathrm{0,0}\\ \mathrm{0,0},-\mathrm{1,0}\\ {\mathrm{s\&theta;}}_5,{\mathrm{c\&theta;}}_5,\mathrm{0,0}\\ \mathrm{0,0,0,1}\end{array}\right]$

Hand clamping device 13 as shown in figure 10, its adopts TowerPro SG90 steering wheel to drive, two moduluses, the number of teeth are identical, the gear that strap clamp is held paw is meshing with each other and forms, its clamping range θ is 0～180 °.

The chucking power F of hand clamping device 13 is calculated by following formula can get M η ₁η ₂=F * L

In the following formula, M is the output torque of steering wheel, is 1.3kgcm;

η ₁Being the meshing efficiency between the gear, is 0.9;

η ₂Being mechanical friction efficient, is 0.9;

L is an arm of force length, is 5cm

Then $F=\frac{{\mathrm{M\&eta;}}_1{\mathrm{\&eta;}}_2}{L}=\frac{1.3\&times;9.8\&times;0.9\&times;0.9}{5}=2N$

Clamping weight N=2 μ F=2 * 0.3 * 2=1.2N,

Wherein μ is the coefficient of friction between gripper and the object, is about 0.2～0.4.

In the utility model, the communication unit in the main body module 1 provides communication protocol, and the communication work of the communication between each functional unit of responsible internal system and system and external command equipment.

In the communication protocol that communication unit provides, its each communication comprises two 82 binary information, promptly the first byte and time bit byte.During devices communicating, Master Control Unit sends the first byte, broadcasts by bus, and ADD3～ADD0 constitutes the appointed equipment address, and Mod2～Mod0 constitutes the mode of operation of designated equipment; Master Control Unit sends time bit byte more then, broadcasts by bus; Then, after designated equipment received broadcasting, time bit byte as corresponding with ADD3～ADD0, was read in contrast equipment of itself address, carries out assigned operation; At last, designated equipment sends response message according to practice condition.

Wherein, the definition of the first byte is as shown in table 2:

Table 2

The definition of inferior bit byte is as shown in table 3:

Table 3

As shown in figure 11, in piece electrical of the present utility model system, main control unit in the main body module 1 adopts ARM to develop, electric machine controller, the steering engine controller in the mechanical arm 4, communication unit, acceleration transducer and other sensors in it and each travel mechanism 3 communicate, and assign control instruction after obtaining integrated information.

As shown in figure 12, under the state of robot start, external command equipment carries out radio communication to main body module 1 earlier and detects, and then sends the buzzing warning if mistake occurs; During inerrancy, main body module 1 begins each equipment is broadcasted roll-call, and each equipment is replied successively, and response message is passed to main body module 1, after main body module 1 is judged the state of body, and the process of starting working.

As shown in figure 13, after main body module 1 is started working process, at first receive the control instruction that external command equipment sends, and current state carried out analysis decision, be the main body module 1 mobile chassis mode of identification travel mechanism 3 automatically, be wheeled move mode or carry out any in leg formula move mode or the wheeled move mode of omnidirectional.After determining to be wheeled move mode, continue to receive the control instruction of external command equipment, in motion control unit, carry out motion planning and final fill order then.

Embodiment 2

Present embodiment as different from Example 1, in the present embodiment, the entity framework of main body module 1 adopts photosensitive resin material, and its post beam section is embedded.

In preparation process, the mechanical processing technique of main body module 1 has adopted advanced laser fast forming technology, uses Somos ProtoTool 20L photosensitive resin material, and the digitlization threedimensional model is generated as entity via the 3D laser fast shaping.Manufacture process is quick, environmental protection, at utmost utilizes the technical advantage of CAD and CAM, strengthens the frame for movement performance, saves cost.Analyze through the finite element Structure Calculation, find that there is stress concentration point in the main body frame crossbeam, defectives such as pillar voltage endurance capability difference.For overcoming this defective, the embedded microstructure technology of post beam section is adopted in design, and effectively weight reduction strengthens the mechanical property of structure simultaneously.

The other technologies feature is identical with embodiment 1.

Embodiment 3

Present embodiment as different from Example 1, in the present embodiment, travel mechanism 3 adopts carries out leg formula travel mechanisms.As shown in figure 14, travel mechanism 3 comprises carries out leg chassis module 7 and four coupled shoe leg modules 8, carry out leg module 8 for four and be symmetrically distributed, the motor that leg module 8 is carried out in control is positioned on the shoe leg chassis module 7, and each carries out leg module 8 corresponding control motors.In addition, carry out on the leg chassis module 7 can load various instruments, equipment is used to finish every job task, it is a carrying platform, generally keeps horizontal attitude at the volley.Carrying out leg module 8 is moving cells, and it can rotate auxiliary robot climbing obstacle detouring around the robot body.

As shown in figure 14, carry out leg type mobile robot and have four frees degree, crawler belt self rotates and the leg structure is rotated around main body.Wherein, in crawler belt self rotated, robot was by the little Athey wheel of motor direct-drive at little Athey wheel place, and with the steamboat rotation, its free degree changes the crawler belt rotational freedom into, realizes that robot moves forward and backward; In main body was rotated, two direct current generator driving leg structure divisions in the robot crawler belt module rotated around main body along the y direction of principal axis and produce 2 rotary freedoms in the leg structure.

In general, carrying out leg type mobile robot has three kinds of typical athletic postures at the volley, promptly stretches attitude, single-blade overlap joint attitude and lifts figure.Above-mentioned stretching, extension attitude is the robot attitude of normally advancing, and as shown in figure 15, and normally advances and is divided into rectilinear motion and the two kinds of situations of turning, and the crawler belt movement at the uniform velocity in the robot both sides moving cell realizes the straight line moving function; Reverse or variable-speed motion realizes that the robot slippage turns to.As shown in figure 16, it is the robot obstacle detouring that single-blade overlaps attitude, stride the ditch attitude, effect is at the robot obstacle detouring, strides and can launch barrier or the zanjon opposite that wing plate snaps into eminence in the ditch process, help climbing to robot by providing support power, perhaps in the robot motion, occur as the attitude that resets.As shown in figure 17, lifting figure is that the robot architecture is out of shape attitude, and this attitude can rise the monitor that is installed on the main body by lifting intermediate host height, enlarges scope of investigation thereby widen the robot sight line.

Because the movement characteristic of above-mentioned shoe leg type mobile robot, thus motion control unit will carry out the leg chassis module also equivalence be that two caterpillar drive modes are set up kinematics model, identical among the foundation of its model and the embodiment 1.

The other technologies feature is identical with embodiment 1.

Embodiment 4

Present embodiment as different from Example 1, in the present embodiment, travel mechanism 3 adopts wheeled travel mechanisms of omnidirectional.As shown in figure 18, travel mechanism 3 comprises omnidirectional's wheel chassis module 9 and three 90 ° of Sweden wheels 10 that circumferentially evenly distribute and be provided with at omnidirectional's wheel chassis module 9.Sweden's wheel is technology well known to those of ordinary skill in the art.Sweden's wheel radial of three 90 ° is installed symmetrically, and roller is perpendicular to each main wheel.This special construction of Sweden's wheel construction has produced the motion of full decoupling, for roller and main wheel provide the direction of motion of quadrature, makes that (x, y θ) move, thereby reach the purpose of omnidirectional moving on this robot can at any time any direction.

Because wheeled travel mechanism of omnidirectional, motion control unit is set up kinematics model, and it comprises sets up overall reference frame and local reference frame.Its overall reference frame adds behind the local reference frame as shown in figure 20 as shown in figure 19.After adding specific local reference frame in the robot, by at the center selected element P of robot, then robot is arranged in consistently with the old framework of local ginseng, make spool overlapping of XR and wheel 2.

Can get by the mapping relations between the motion vector in motion vector in the overall reference frame and the local reference frame

Wherein

Be the motion vector in the overall reference frame, by 2 translational speeds and 1 rotating speed indicating;

R (θ) is the quadrature spin matrix; J _1fBe a matrix with projection, this matrix projects on the moving of their each wheel planes; J ₂Be normal diagonal angle 3*3 matrix, its entity is the radius r of whole standard wheel;

Be the motion vector in the local reference frame, by the rotating speed indicating of 3 wheels.

So, as long as know motion vector in the overall reference frame and any one in the motion vector in the local reference frame, just can be in the hope of another one, thus reach the purpose of controlled motion.

The other technologies feature is identical with embodiment 1.

Embodiment 5

What present embodiment and the foregoing description 1, embodiment 2, embodiment 3, embodiment 4 were different is that the mechanical arm 4 in the present embodiment is by moving " teaching " position and posture.Its principle is to pass to Master Control Unit after the change in resistance of the potentiometer in each joint of teaching arm of equal size is changed through AD, Master Control Unit converts thereof into corresponding angle value, pass to the steering wheel in each joint on the actual machine arm 4 through communication protocol, thereby reach the purpose of control.Like this, when practical operation, mechanical arm 4 can be moved to an expectation position and this position noted, when teaching in this way, robot needn't require to return original coordinate system, and this coordinate system can be that local coordinate system also can be a fixed coordinate system.

Other technologies feature and embodiment 1, embodiment 2, embodiment 3, embodiment 4 are identical.

Embodiment 6

Present embodiment in the present embodiment, is provided with a plurality of guide rails 11 as different from Example 3 on main body module 1, guide rail 11 is connected with task module 2; Guide rail 11 is meant the interface of main body module 1 and task module 2, as shown in figure 21.

Need to prove, the quantity of guide rail 11 can be set according to the quantity of the task module 2 of actual setting, can for one, two, three or even more a plurality of, this can improve the rescue work efficient of robot greatly, and mounting or dismounting are convenient, rapidly, reliable.In addition, seven position locations can be set on the guide rail 11, four position locations also can be set.

In the present embodiment, task module 2 is audio-visual delivery module.Specifically, it comprises two cameras of size: big camera is the infrared water-proof CCD camera of 1.2GHz, be installed in the locator slide above the hexagon main body module, can in time provide rescue site environment screen clearly for the operator, help the rescue personnel to obtain first-hand rescue site information, provide good visual angle for operating personnel simultaneously, be convenient to the manipulation robot and carry out various motions, and this camera has the infrared night vision function, can obtain respond well screen information under the environment of dark; Little camera is miniature pinhole cameras, be installed in top, hand clamping device 13 ground, can together move with mechanical arm 4, thereby expansion angular field of view, simultaneously can be when mechanical arm 4 reaches in the slit gripping thing, for the operator provides the screen data, be convenient to operating personnel and effectively finish gripping work.

The other technologies feature is identical with embodiment 3.

Embodiment 7

What present embodiment was different with the foregoing description is that present embodiment can be set up guide rail 11 on main body module 1 on the basis of above-mentioned all embodiment, link to each other with task module 2 by guide rail 11, carries out the functions expanding of disaster assistance robot.Above-mentioned task module 2 can be any one or its several combinations in vital sign detecting module, space environment measurement module, locus locating module, the medical aid module.

Wherein, the vital signs detecting module adopts existing body temperature and electric field vital signs detecting instrument technology, is core with the mechanical arm in conjunction with above-mentioned module implementation trade-off system.

That the space environment measurement module mainly comprises is infrared, ultrasonic wave, laser ranging unit, according to development of projects and self-ability, selects different distance measuring methods to carry out modular design by Yi Zhinan.Technical grade sensor can be adopted, item difficulty will be reduced greatly with conventional data bus.

The locus locating module adopts business level radio position finding radio directional bearing and the GPS locating module with conventional data bus, and the locus to robot positions in real time, and can store and draw out unknown space map by the road locus of points.

In addition, the workflow diagram of each task module as shown in figure 22: under the state of robot start, when the call request of main body module 1 arrives, reply this call request, and formulate the corresponding work decision-making, thus the process of starting working.In this process, can receive the control instruction of main body module 1; If wrongly also can carry out buzzing and report to the police.

Other technologies feature and embodiment 1, embodiment 2, embodiment 3, embodiment 4, embodiment 5, embodiment 6 are identical.

Claims (8)

1. modular disaster assistance robot is characterized in that: it comprises hexagonal main body module (1) and is positioned at mechanical arm (4) on the main body module (1) that main body module (1) is connected with travel mechanism (3); Described main body module (1) comprises recognition unit, motion control unit, communication unit and the Master Control Unit that utilizes bussing technique to intercom mutually, wherein, the move mode of recognition unit identification travel mechanism (3), motion control unit are set up kinematics model according to this move mode and are driven travel mechanism (3) motion; The body of described mechanical arm (4) is a robot arm with five frees degree, is provided with steering wheel and hand clamping device (13) on motion arm, and described steering wheel is connected with Master Control Unit.

2. according to the described modular disaster assistance of claim 1 robot, it is characterized in that: described travel mechanism (3) comprises wheel undercarriage module (5) and four coupled wheel modules (6), and each is taken turns module (6) and all is connected with a motor; Described motion control unit comprises motor and the velocity sensor thereof that is connected with wheel module (6), the input of motor is connected with motor driver, the input of motor driver connects the pwm signal generator, the input of pwm signal generator connects the PID controller, the input of PID controller connects multiplier, described multiplier with the present speed value of velocity sensor sampling and historical speed value as input signal.

3. according to the described modular disaster assistance of claim 1 robot, it is characterized in that: described travel mechanism (3) comprises that carrying out leg chassis module (7) and coupled four carries out leg modules (8), carries out leg modules (8) for four and is symmetrically distributed.

4. according to the described modular disaster assistance of claim 1 robot, it is characterized in that: described travel mechanism (3) comprises omnidirectional's wheel chassis module (9) and three the 90 ° of Sweden wheels (10) that circumferentially evenly distribute and be provided with at omnidirectional's wheel chassis module (9).

5. according to the described modular disaster assistance of claim 1 robot, it is characterized in that: the change in resistance of the potentiometer in each joint of mechanical arm (4) is passed to Master Control Unit after through the AD conversion, after Master Control Unit converts thereof into corresponding angle value, pass to the steering wheel that mechanical arm (4) is gone up each joint.

6. according to the described modular disaster assistance of claim 1 robot, it is characterized in that: the entity framework of described main body module (1) adopts photosensitive resin material, and its post beam section is embedded.

7. according to the arbitrary described modular disaster assistance of claim 1～6 robot, it is characterized in that: be provided with at least one guide rail (11) on main body module (1), guide rail (11) is connected with task module (2); Described guide rail (11) is meant the interface of main body module (1) and task module (2).

8. according to the described modular disaster assistance of claim 7 robot, it is characterized in that: described task module (2) is any one or a few combination in audio-visual delivery module, vital signs detecting module, space environment measurement module, locus locating module, the medical aid module.

Images