The utility model content
The purpose of this utility model is to address the above problem, a kind of charged repairing robot master-slave mode hydraulic coupling feedback mechanical arm control system is provided, this charged repairing robot master-slave mode hydraulic coupling feedback mechanical arm control system adopts position, force servo double circle controling mode, and pass through wireless with high voltage electric field and people's isolation, control accuracy height, real-time are good, stable and reliable for performance, more convenient to operate, satisfy the requirement of electrification in high voltage robot manipulating task task.
For achieving the above object, the utility model adopts following technical scheme:
A kind of charged repairing robot master-slave mode hydraulic coupling feedback mechanical arm control system, comprise handheld terminal, embedded main hand controls and mechanical arm controller, described handheld terminal comprises microprocessor I, and it links to each other with embedded main hand controls with the man-machine interface unit respectively; Described embedded main hand controls comprises microprocessor II, it is connected with microprocessor I by serial ports, microprocessor II communicates by letter with A/D converter I by data/address bus, address bus, control bus, and A/D converter I is connected with the potentiometer of each joint of the master of robot hand; Microprocessor II also is connected by the torque-motor of motor driver with main each joint of hand; Microprocessor II is connected with wireless module I; Described mechanical arm controller comprises microprocessor III, and microprocessor III communicates by letter with wireless module I by wireless module II; Microprocessor III also is connected with A/D converter II with control bus by address bus, data/address bus simultaneously, and A/D converter II then is connected with the potentiometer of each joint of mechanical arm; Microprocessor III also is connected with D/A converter by data/address bus, clock bus simultaneously, D/A converter is connected with hydraulic amplifier, hydraulic amplifier is connected with some servo valves, and the oil inlet and oil return mouth of each servo valve is equipped with pressure sensor, and pressure sensor is connected with A/D converter II; Each servo valve is connected with corresponding hydraulic cylinder, and the hydraulic cylinder output shaft is connected with mechanical arm.
What described mechanical arm adopted is the hydraulic machinery arm that U.S. kraft Telerobotics company produces, and in existing sale on the market, does not just describe in detail at this.
Described mechanical arm is 7 degree-of-freedom manipulators, and pressure sensor is measured the differential pressure of oil-in and oil return opening, reflects the size and Orientation of mechanical arm to environmental pressure; Hydraulic power source is provided with magnetic valve and is used for switch hydraulic source.
The main hand of described mechanical arm is a 6DOF master hand, and each joint rotating shaft place on it all has potentiometer, is with 5 torque motors, comprises waist revolution, big arm pitching, forearm pitching, wrist pitching, wrist nosing force torque motor.
The microprocessor I of described handheld terminal is connected with serial ports by serial ports receiver transmitter MAX3232 chip, and microprocessor I also is connected with voltage stabilizing chip I, voltage stabilizing chip I I simultaneously; Microprocessor I is connected with the keyboard administration module with Liquid Crystal Module by logic level translator, and the keyboard administration module is connected with keyboard.
The microprocessor II of described embedded main hand controls is connected with serial ports by MAX3232I, be connected with wireless module I by MAX3232II, be connected with motor drive module by motion-control module, motor drive module is connected with splicing ear I, splicing ear I is connected with the light-coupled isolation module I through module I, and the light-coupled isolation module I is connected with microprocessor II; Microprocessor II is connected with the light-coupled isolation module ii, the light-coupled isolation module ii is connected with the O module, and the O module is connected with splicing ear II, and splicing ear II is connected with the A/D modular converter, the A/D modular converter is connected with multiplexer, and multiplexer is connected with microprocessor II.
The microprocessor III of described mechanical arm controller is connected with wireless module II by MAX3232III; Microprocessor III is connected with the servo valve amplifier by the D/A modular converter, and the servo valve amplifier is connected with the servo valve of mechanical arm; Microprocessor III is connected with the O module by the light-coupled isolation module, and the O module is connected with magnetic valve; Each pressure sensor of mechanical arm is connected with microprocessor III by A/D modular converter II; Each potentiometer of mechanical arm is connected with microprocessor III by A/D modular converter II.
Adopt such scheme, the utlity model has following advantage:
The one, adopt the force feedback technology, have perception to environment, can greatly improve flexibility, the accuracy of operation, increase substantially operating efficiency, finish and repair lead, change complex job projects such as cross-arm, fall insurance;
The 2nd, adopt master slave control mode mechanical arm system flexible and convenient operation, do not need compound movement algorithms such as complicated linear interpolation, circular interpolation;
The 3rd, system adopts modularized design, has opening, readability, extensibility, maintainability, so that continue exploitation;
The 4th, principal and subordinate's control system communication modes adopts radio communication, is convenient to charged repairing robot wiring, can realize High-Voltage Insulation;
The 5th, control system has various standard interfaces, mechanical position limitation, software limit, and is multiple functional, the positional precision height.
The specific embodiment
Below in conjunction with accompanying drawing and embodiment utility model is described further.
Among Fig. 1, a kind of charged repairing robot master-slave mode force feedback hydraulic machinery arm controller comprises handheld terminal, embedded main hand controls and mechanical arm controller, it is characterized in that, described handheld terminal comprises microprocessor I, and it links to each other with embedded main hand controls with the man-machine interface unit respectively; Described embedded main hand controls comprises microprocessor II, and it is connected with microprocessor I, wireless module I respectively; Simultaneously, microprocessor II communicates by letter with data/address bus, address bus, the control bus of A/D converter I by data/address bus, address bus, control bus, communicates by letter with power bus by data/address bus between some potentiometers of A/D converter I and main hand; The torque-motor driver links to each other with several torque-motors (at each articulating shaft place) of main hand; Described mechanical arm controller comprises microprocessor III, it is connected with D/A converter with clock bus by data/address bus, be connected with A/D converter II by address bus, data/address bus and control bus, microprocessor III also is connected with magnetic valve, wireless module II; Simultaneously, some potentiometers at each articulating shaft place are connected on A/D converter II and the mechanical arm; A/D converter II links to each other with some pressure sensors; D/A converter is connected with hydraulic amplifier; Hydraulic amplifier is connected with some servo valves, and each servo valve is connected with corresponding hydraulic cylinder, and the hydraulic cylinder output shaft is connected with mechanical arm.
Stepping motor controller adopts X7083, controls 8 simultaneously, inside have straight line add/deceleration, parabola add/functions such as deceleration, acceleration-deceleration setting, maximum speed setting.
Microprocessor I, microprocessor II and microprocessor III all adopt the TMS320F28335 chip, have the floating-point processing capacity; Described A/D converter I, A/D converter II all adopt the MAX1312 chip; Described D/A converter adopts the DAC7678 chip.
Torque-motor adopts step-by-step movement torque-motor, torque range 0.061-0.123N.m, locked rotor current 0.3A, torque sensitivity 0.028N.m; Described each potentiometer adopts the 360 degree rotational potentiometers of 5K Ω, sensor accuracy 1 ‰, and output signal-10V~+ 10V.
Microprocessor II is as main frame, and it takes on system management, the compiling of mechanical arm language and human interface function, and periodically operation result is delivered to public internal memory as the increment of joint motions, reads it for microprocessor III.
Microprocessor III finishes whole joint positions, power is digital control.It reads set-point from public internal memory, also each joint physical location is sent back in the public internal memory, and microprocessor II uses.
Mechanical arm is 7 degree-of-freedom manipulators, and the corresponding hydraulic actuator that moves through in each joint of mechanical arm is carried out; Each actuator is controlled by a corresponding hydraulic efficiency servo-valve; Oil inlet and oil return mouth at each servo valve is equipped with pressure sensor, measures the differential pressure of oil-in and oil return opening, reflects the size and Orientation of mechanical arm to environmental pressure, except hydraulic efficiency servo-valve, has also increased pressure-reducing valve and magnetic valve; Magnetic valve is used for switch hydraulic source; The oil outer hydraulic coupling can not surpass 3000PSI; Valve plate is provided with control module and is connected with the hydraulic servo driver by control bus, and upper arm is connected with the hydraulic servo driver by the position signalling bus with potentiometer on the forearm, and the hydraulic servo driver is powered by power bus.
Supplied the parallel paw of band force feedback.Because parallel paw unique control method allows the operator to change the speed of paw folding and the size of grasping force.
Mechanical arm is installed on the oil inlet and oil return mouth of servo valve with pressure sensor, precision: ± 2.5%, output signal-10V~+ 10V, pressure sensor is through accurate temperature-compensating, stainless steel seal welding structure and perfect assembly technology, makes it have characteristics such as high accuracy, high anti-interference, overload and shock resistance.
Servo valve is the MOOG aviation with jet tubular type electricity flow quantity servo valve, model: MOD211-135, and pressure 1500psi, drive signal and be-20mA~+ 20mA.
The communication distance 1000m of wireless module, communication frequency 900MHz, antijamming capability is strong, and communication distance is far away.
Main hand is a 6DOF master hand, and each joint rotating shaft place on it all has potentiometer, is with 5 torque motors, comprises waist revolution, big arm pitching, forearm pitching, wrist pitching, wrist nosing force torque motor.
Among Fig. 2, main manual making sheet is made up of microprocessor I, motion-control module, electrical driver, I module, light-coupled isolation module, A/D modular converter, multiplexer, O module, MAX3232 module etc.The input and output of microprocessor I are connected with the input and output of motion-control module, light-coupled isolation module, multiplexer, MAX3232 respectively; The input of motion-control module is connected with motor-driven input, and motor-driven output is connected with splicing ear I, and the output of splicing ear I is connected with the input of I module, and the output of I module is connected with the input of light-coupled isolation module; The input and output of splicing ear II are connected with the input and output of A/D modular converter, O module, and the output of A/D modular converter is connected with the input of multiplexer, and the output of light-coupled isolation module is connected with the input of O module; The output of two MAX3232 is connected with serial ports, wireless module respectively; Power supply offers main hand, main manual making sheet, wireless module respectively.
Among Fig. 3, handheld terminal is made up of microprocessor I, Liquid Crystal Module, logic level translator, keyboard administration module, keyboard, voltage stabilizing chip I, voltage stabilizing chip I I, serial ports receiver transmitter and serial ports.Voltage stabilizing chip I, voltage stabilizing chip I I give microprocessor I power supply.The GIPIOB1 of microprocessor I is connected with 2 pin of logic level translator ADG3308, and GPIOB5 is connected with 5 pin, and XINT2 is connected with 6 pin, GPIOA0-7 is connected with the DB0-7 of Liquid Crystal Module, GPIOB0 is connected with REQ, and GPIOB2 is connected with CS, and Liquid Crystal Module obtains the 5V power supply.16 pin of logic level translator ADG3308 are connected with the DATA pin of keyboard administration module HD7279, and the keyboard administration module is connected with the KEY pin.The GPIOB3 of microprocessor I is connected with the CS pin of keyboard administration module HD7279, and GPIOB4 is connected with the CLK pin.The output of keyboard meets DIG0-7, the DP-SG of keyboard administration module HD7279.The SCITXDA of microprocessor I connects 11 pin of serial ports receiver transmitter I MAX3232, and SCIRXDA connects 12 pin, and 13,14 pin of serial ports receiver transmitter MAX3232 are received serial ports.
Among Fig. 4, the mechanical arm control panel comprises compositions such as D/A modular converter, servo amplifier, light-coupled isolation module, O module, A/D modular converter I, A/D modular converter II, MAX3232, wireless module.The input and output of microprocessor III are connected with the input and output of D/A modular converter, light-coupled isolation module, A/D modular converter I, A/D modular converter II, MAX3232 respectively; The output of D/A modular converter is connected with the input of servo amplifier, and the output of servo amplifier is connected with the input of servo valve 1-7; The output of light-coupled isolation module is connected with the input of O module, and the output of O module is connected with the input of magnetic valve; The output of pressure sensor 1-6 is connected with the input of A/D modular converter I, and the output of potentiometer 1-7 is connected with the input of A/D modular converter II; The input and output of MAX3232 are connected with the input and output of wireless module; Power supply is respectively and connects mechanical arm, mechanical arm control panel, wireless module power supply is provided.
Among Fig. 5,2 pin of servo valve 1-7 are connected with 19 of mechanical arm cable, and 1 pin of servo valve 1-7 is connected with 1,4,7,10,13,16,18 of mechanical arm cable respectively; 1 pin of pressure sensor 1-6 is connected with 21 pin of mechanical arm cable, and 3 pin of pressure sensor 1-6 are connected with 22 pin of mechanical arm cable, and 2 pin of pressure sensor 1-6 are connected with 2,5,811,14,20 of mechanical arm cable respectively; 1 pin of potentiometer 1-7 is connected with 21 pin of mechanical arm cable, and 3 pin of potentiometer 1-7 are connected with 22 pin of mechanical arm cable, and 2 pin of potentiometer 1-7 are connected with 3,6,9,12,15,17,23 pin of mechanical arm cable respectively; 1,2 pin of electromagnetism are connected with 24,24 pin of mechanical arm cable respectively.
Referring to Fig. 6, executive program is the core of robot software's systematic order control, is the starting point of entire machine people software systems.It is operated in microprocessor II, is used to control the work of whole mechanical arm software systems, task such as system initialization, input and output read in, system state monitoring that it is mainly finished.Executive program just brings into operation after microprocessor II powers on automatically, has only when power supply disconnects, and is just out of service.It adopts the mechanism of cycle detection that the timing detection is carried out in each input port, comes sequential control and carries out the corresponding module function according to input control signal.
Referring to Fig. 7, in master-slave mode force feedback manipulator system, open the hydraulic pressure power supply after, main hand and must return to a definite correspondence position from hand just can carry out principal and subordinate's controlled motion.The mechanical arm controller is gathered joint position information, and sending to main hand controls, main hand controls corresponds to the position and attitude of mechanical arm automatically according to the positional information of main hand, from the difference driving moment motor of the positional information of hand, when difference was zero, correspondence was finished.
Concrete steps are as follows:
(1) potentiometer of described main hand is gathered the position signalling of main hand;
(2) potentiometer of described mechanical arm is gathered the position signalling of mechanical arm clamper, and this position signalling is sent to main hand controls by wireless sending module;
(3) main hand controls judges whether to receive the position signalling of mechanical arm, if receive, forwards step (4) to, if do not receive, continues to wait for;
(4) position signalling of the more main hand of main hand controls and the position signalling of mechanical arm if error is non-vanishing, then drive the torque-motor of main hand; If error is zero, then forward step (5) to;
(5) handheld device receives the information that main hand controls sends, and the handheld device end shows.
Referring to Fig. 8, master-slave mode force feedback manipulator control system software is divided into main end and from end two parts.The operator operates main hands movement, and main hand controls is gathered the positional information of main hand potentiometer and in real time positional information sent to the mechanical arm controller, and the mechanical arm controller is by following the tracks of the motion of finishing mechanical arm to the position of main hand; Mechanical arm also feeds back to main hand controls by radio communication by the detected positional information of potentiometer, the detected force information of pressure sensor in motion process on the other hand, main hand controls sends this information Moment Motor Controller driving moment motor again and sends to handheld terminal, for showing.
Concrete steps are as follows:
(1) the main hand controls of main end sends sign on, simultaneously from the pressure sensor and the potentiometer of the mechanical arm controller initialization mechanical arm of end;
(2) described main hand controls is created main hand position and is detected thread and described mechanical arm controller establishment clamper Position Control thread, forwards step (3) to; Thread is set described main hand controls establishment power and described mechanical arm controller establishment pressure is held power detection thread with adding, and forwards step (5) to;
(3) described main hand position detects thread and sends position command to main hand position detection and to the mechanical arm controller from end, and position probing constantly circulates;
(4) the mechanical arm controller from end receives main position signalling instruction of holding, the position of mechanical arm controller control clamper;
(5) pressure sensor of mechanical arm is gathered force signal, and sends to the mechanical arm controller, and described mechanical arm master controller sends to main hand controls by wireless communication module; Described main hand controls passes to torque-motor with force signal, and described torque-motor power output signal is given the operator, and main hand controls sends to handheld terminal with force signal.