The utility model content:
The purpose of the utility model is to solve following problems, provides the special-purpose acoustic control nut of a kind of robot for high-voltage hot-line work to abolish instrument.Controller adopts wireless remote mode; The acoustic control assembly with the ATMEGA128 single-chip microcomputer as master controller; Power module has overvoltage, overcurrent, low pressure, anti-reverse defencive function; Select the big motor drive module of drive current for use, adopt the current feedback guard method, can abolish instrument to the special-purpose acoustic control nut of robot for high-voltage hot-line work and carry out shear rate and Torque Control.This nut is abolished instrument and is carried out Long-distance Control through acoustic control transmitter trigger remote controller, and automaticity is high, operating efficiency is high, handling safety, reliable, is fit to the electrification in high voltage robot to abolishing the requirement of corrosion nut job task.
For realizing above-mentioned purpose, the utility model adopts following technical scheme:
The special-purpose acoustic control nut of a kind of robot for high-voltage hot-line work is abolished instrument, and it is mainly abolished tool body, acoustic control transmitter trigger remote controller and acoustic control assembly by nut and forms; Wherein said nut is abolished instrument and is comprised main casing, in main casing, is provided with electric hydraulic means, and electric hydraulic means is connected with working head; Be provided with the acoustic control assembly at the main casing rear portion, the acoustic control assembly is communicated by letter with acoustic control transmitter trigger remote controller, and after acoustic control transmitter trigger remote controller received sound control signal, through acoustic control assembly control voltage hydraulic means, electric hydraulic means control working head was accomplished the work of abolishing;
Said acoustic control assembly comprises box body; On box body, be provided with indicator lamp, antenna; Antenna is connected with wireless receiver; Wireless receiver is connected with microcontroller, and microcontroller is connected with optically coupled isolation circuit, motor-drive circuit and motor, and motor-drive circuit also constitutes closed loop through current feedback circuit and microcontroller and is connected; Microcontroller is connected with power supply respectively with motor-drive circuit;
Said current feedback circuit comprises current sensor, operational amplifier, comparator, and current sensor is gathered the electric current of motor-drive circuit, sends into operational amplifier, and the signal after the amplification is sent into comparator, and microcontroller is handled back control motor-drive circuit.
Said motor-drive circuit is the pwm power drive unit, and microcontroller is adjusted average voltage through internal register adjustment pulse duty factor is set, and passs speed control signal to the PWM0 oral instructions; Through the output high-low level, pass the direction of motion signal of motor to the DIR oral instructions; The PWM0 signal is isolated U4 through light and is input to triode Q2 basis set, amplifies through one-level to drive high-power MOS tube Q4 gate pole, the running of drive motors; The DIR signal is isolated the power on and off that U5 is input to triode Q3 control relay 7,8 pin through light, controls the rotating of motor.
Said acoustic control transmitter trigger remote controller comprises the sound receiver module, and it is connected with DSP, and DSP is connected with coding chip, carrier oscillation circuit and wireless amplification emissioning circuit successively, and DSP also is connected with state indicating member and power supply.
Said sound receiver module comprises main microphone, with reference to microphone, analog amplify circuit, filter circuit, A/D change-over circuit; Main microphone, link to each other with analog amplify circuit with reference to microphone, analog amplify circuit links to each other with filter circuit, and filter circuit links to each other with the A/D change-over circuit, and the A/D change-over circuit links to each other with DSP.
Said electric hydraulic means comprises motor, fuel tank, oil pump, oil cylinder, manipulator clamping device, working head, pressure relief device, power supply, and motor, oil pump, oil cylinder are installed in the main casing inner chamber, through about main casing two dress is accomplished fixing; Motor is coaxial with oil pump, and oil pump passes through check valve and fuel tank, oil cylinder UNICOM respectively, and oil cylinder is through pressure relief device and fuel tank UNICOM; The plunger of oil cylinder connects through push rod with working head, is detachable connection.
Said nut is abolished tool body and is designed with the manipulator pressure relief device, comprises rocking arm, pull bar, stage clip, box body, lid, briquetting, and the rocking arm end is a cam structure; when rocking arm rotates around the center, and it is big that rocking arm and box body Edge Distance become, pull bar and box body relative motion; pull bar drives briquetting and pushes compression relief cock, and when unclamping rocking arm, under the compression spring action; rocking arm resets, rocking arm pushing drawing rod and briquetting reset simultaneously.
Said main casing top is provided with the manipulator clamping device; It comprises connecting rack and splice holder; Connecting rack and nut are abolished tool body and are fixedly connected, and the gusset piece tow sides of splice holder are respectively arc bump design and groove, be used for manipulator from movingly.
Said box body comprises the high permeability material shell; Be provided with fan and fan air guide hole in the enclosure, fan air guide hole place arranges woven wire, and the line outlet of shell is arranged conductive rubber; Motor-drive circuit links to each other with motor through shielded cable simultaneously, and power ground is abolished tool body with nut and linked to each other.
After manipulator clamping device of the utility model and the Work robot manipulator locating engagement, the acoustic control starter motor, the work of driven by motor oil pump, the hydraulic oil of formation promotes the oil cylinder plunger, and cutter head is accomplished crushing action under plunger promotes.
Said DSP adopts powerful TMS320C5535, and coding chip adopts PT2262, and microcontroller adopts the ATMEGA128 chip.
When voltage boosts in the 0-42KV scope, step-down and keeping; Robot for high-voltage hot-line work acoustic control nut is abolished parts operations such as instrument remote controller, voltage stabilizing chip, wireless receiving module, motor drive module, single-chip microcomputer normally, and each item measuring ability is in proper working order.
Motor adopts permanent magnet direct current motor, meet simple in structure, the requirement that starting current is little, efficient is high; Motor is partly controlled rotating speed and moment of torsion by motor driver, utilizes the locating slot on the plastic casing to be assemblied in the main casing inner chamber.
Fuel tank is soft fuel tank, adopts oil resistant rubber processing, is fit to the designing requirement of small-sized hydraulic instrument.
Oil pump adopts the single action variable Paddle Pump Designing, has made full use of the characteristics that variable vane pump hydraulic radial dynamic balance, flow reduce gradually; Along with working head pressure increases, flow reduces gradually, and working head is abolished speed and reduced gradually, effectively reduces the screw rod damage.
Oil cylinder adopts the plunger-type cylinder design, is single-acting formula hydraulic cylinder, the indoor design recoil press spring, be used for the oil pump pressure release after, plunger return.
The manipulator clamping device comprises connecting rack and splice holder.Connecting rack and nut are abolished tool body and are fixedly connected, and the gusset piece tow sides of splice holder are respectively arc bump design and groove design, be used for manipulator from movingly.
Working head comprises cutter head and knife rest.The blade of cutter head is the obtuse angle, blade design limited post; Tool holder designs chute and connection holes, the cutter head limited post slides in chute, abolishes tool body through bearing pin and nut and connects.
Main casing adopts the PA+PBT synthetic plastic, takes into account toughness and requirement of strength, is universal high intensity engineering plastics in the industry, the indoor design reinforcement, and the big radian in turning is excessive, reduces weight to make things convenient for the work high above the ground characteristics of manipulator.
Pressure relief device comprises rocking arm, pull bar, stage clip, box body, lid, briquetting composition, is the cam linkages structure.Rocking arm connects the stroke of the variation formation briquetting of centre bore and box body Edge Distance with pull bar, but stage clip makes rocking arm at the extreme position self-return.
Power supply is nickel-hydrogen chargeable cell (NI-MH), and is in light weight, the life-span is long, and the dual buckle design of battery case and main casing prevents the high-altitude possibility of falling.
Sound receiver module and state indicating member, it is used for accomplishing the work of man-machine interaction, comprises the control of motor speed, motor drive direction and Motor torque.
The sound receiver module comprises microphone, analog amplify circuit, filter circuit, A/D change-over circuit; Microphone is used for receiving operator's speed, direction instruction; After small-signal is amplified through analog amplify circuit, and, be input to the A/D change-over circuit through the filter circuit processing.
High-speed low-power-consumption conversion chip AD7262 is adopted in the A/D conversion, and the highest sample rate can reach 1MS/s.Has the two paths of differential signals input, 12 of conversion accuracies.
DSP is used for receiving the signal of sound receiver module, and carries out the adaptive voice noise reduction algorithm and handle, and the output useful signal is given wireless driver element.
Wireless driver element is responsible for the emission of radiofrequency signal, and the modulating coding signal circuit output end is through carrier oscillation circuit and wireless amplification emissioning circuit output modulated carrier code signal.
Coding chip is responsible for the modulating coding signal of radio frequency part and is handled, and to the input processing of DSP and the output indication of state.
The state indicating member is accomplished the indication that signal sends state.
Wireless receiver is used to receive the wireless signal from remote controller, and carries out decoding processing, outputs to microcontroller;
Microcontroller is used for receiving from the information of wireless receiver or other parts and judges and handle;
Optically coupled isolation circuit, it is connected to microcontroller and motor-drive circuit, is used to receive the output control signal of microcontroller;
Motor-drive circuit, it is connected to optically coupled isolation circuit, is used for output drive signal under the control that receives optically coupled isolation circuit;
Motor, it is connected to said motor-drive circuit, is used under the control of said driving signal by needed direction, speed and torque rotation;
Current feedback circuit is made up of current sensor, operational amplifier and comparator.Through the electric current of current sensor collection motor-drive circuit, behind amplification of single supply operational amplifier and comparator, receive microcontroller I/O interface, so that the output torque fast and stable is requiring level.
Power circuit, the overvoltage of power circuit band, overcurrent, low pressure, anti-reverse protection provide power supply to each circuit such as microcontroller, wireless receiver, motor-drive circuits.
EMC test; When voltage boosts in the 0-42KV scope, step-down and keeping; The operation of parts such as robot for high-voltage hot-line work acoustic control remote controller, voltage stabilizing chip, wireless receiving module, motor drive module, single-chip microcomputer is normal, and each item measuring ability is in proper working order.
In order to adapt to the requirement that robot for high-voltage hot-line work is used, the utility model adopts the big driver module of output current, and by the ATMEGA128 Single-chip Controlling, band overcurrent, overload, overvoltage protection.This nut is abolished instrument and carried out Long-distance Control through acoustic control transmitter trigger remote controller, and is safer, reliable than hand-operated tools, operates also conveniently, satisfied the requirement of electrification in high voltage robot manipulating task task.
Adopt such scheme, the utlity model has following advantage:
The one, adopted high integration IC chip and advanced SMT surface element attachment process and unique shield technology, make the product have superpower antijamming capability and reliability, can be under very harsh electromagnetic interference environment long-term stable operation.
The 2nd, nut is abolished instrument and carried out Long-distance Control through the acoustic control remote controller, and is more safe and reliable than hand-operated tools, and lets staff's both hands realize liberation, increases processing safety and convenience, satisfied the requirement of electrification in high voltage robot manipulating task task.
The 3rd, the overvoltage of power circuit band, overcurrent, low pressure, anti-reverse protection, reliability is high.
The 4th, remote controller can carry out electrodeless variable-speed, rotating control, and control is flexible, and reliability is high.
The 5th, controller has Current Feedback Control, eliminates the influence of broken nut tool work instability to the control dynamic performance.
The 6th, adopt the adaptive voice noise reduction technology, be fit to the open-air noisy working environment of robot for high-voltage hot-line work.
The 7th, be broken that the control of nut tool controller and other instruments is general, be convenient to instrument seriation from now on.
The specific embodiment
Below in conjunction with accompanying drawing and embodiment the utility model is further specified.
The utility model is abolished tool body, acoustic control transmitter trigger remote controller and acoustic control assembly by nut and is formed;
Acoustic control assembly 10 is fixed on the main casing 7, comprises fan 11, indicator lamp 12, antenna 13.
It is as shown in Figure 1 that wherein said nut is abolished tool body, and it comprises motor 1, fuel tank 2, oil pump 3, oil cylinder 4, manipulator clamping device 5, working head 6, main casing 7, pressure relief device 8, power supply 9.
Motor 1, oil pump 3, oil cylinder 4 are installed in main casing 7 inner chambers, dress are accomplished fixing through about 7 two of main casings; Motor 1 is coaxial with oil pump 3, and oil pump 3 passes through check valve and fuel tank 2, oil cylinder 4 UNICOMs respectively, and oil cylinder 4 is through relief valve and fuel tank 2 UNICOMs; The plunger of oil cylinder 4 connects through push rod with cutter head, is detachable connection;
Pressure relief device 8 is fixed on the main casing 7, and is as shown in Figure 2, comprises rocking arm 8.1, pull bar 8.2, stage clip 8.3, box body 8.4, lid 8.5, briquetting 8.6.Upwards lift rocking arm 8.1 ends, rocking arm 8.1 becomes big, pull bar 8.2 and box body 8.4 relative motions with pull bar 8.2 connection holes and box body 8.4 Edge Distances; Briquetting 8.6 moves to the box body direction, stage clip 8.3 compressions, and briquetting 8.6 is by depressing compression relief cock simultaneously; When unclamping rocking arm 8.1; Under stage clip 8.3 effects, rocking arm 8.1 resets, and rocking arm 8.1 pushing drawing rods 8.2 reset with briquetting 8.6 simultaneously.
When hand clamping device 5 and robot for high-voltage hot-line work manipulator accomplish dock after, after acoustic control transmitter trigger remote controller receives sound control signal, control starter motors 1 through acoustic control assembly 10; Oil pump 3 completion oil suction-formation hydraulic oils-fuel-displaced, hydraulic oil gets into oil cylinder 4 through check valve and oil duct, and plunger promotes the cutter head reach; Carry out along with abolishing action; The cutter head resistance increases gradually, and the cutter head speed of advancement reduces gradually, helps protecting cutter head and workpiece; When nut is cut open, wireless acoustic control control disable motor 1; Pull the rocking arm 8.1 of pressure relief device in the clockwise direction, briquetting 8.6 is depressed compression relief cock, and relief valve is opened, and hydraulic oil flows back to fuel tank 2.So far, abolish nut action and accomplish, can change the angle of knife rest and nut, repeat the work of once abolishing according to actual conditions.
Wherein said acoustic control transmitter trigger remote controller is as shown in Figure 3, and it comprises DSP 14, and it is connected with the man-machine interface unit, and coding chip 17 also is connected with wireless driver element simultaneously; The man-machine interface unit comprises sound receiver module 15 and state indicating member 16, and they are connected with DSP 14 respectively.Wireless driver element comprises carrier oscillation circuit 18, and its input is connected with coding chip 17, and output is connected with wireless amplification emissioning circuit 19 inputs.
Will be when nut be abolished instrument transmission control command when acoustic control transmitter trigger remote controller, DSP 14 obtains the control corresponding instruction, and gives wireless driver element circuit according to the data of gathering sound receiver module 15; Wireless driver element circuit after accomplishing modulation, carrier oscillation, power amplification sends the form of control signal with radio frequency.
Wherein said sound receiver module 15 is as shown in Figure 4; It comprises main microphone 15.1, with reference to microphone 15.5; They are connected with analog amplify circuit 15.2, analog amplify circuit 15.6 respectively; Analog amplify circuit 15.2, analog amplify circuit 15.6 are connected with filter circuit 15.3, filter circuit 15.7 circuit respectively, and filter circuit 15.3, filter circuit 15.7 circuit link to each other with A/D change-over circuit 15.4, A/D change-over circuit 15.8 respectively.
Main microphone 15.1, be used for receiving voice command from the operator with reference to microphone 15.5; Main microphone 15.1 obtain is a useful signal and an incoherent noise signal mixed signal, to obtain with reference to microphone 15.5 be reference noise signal; Through simulation amplification, filtering, A/D conversion, voice signal is outputed to DSP 14.In DSP 14, realize the adaptive noise reduction algorithm, sample rate is 8KHz, utilizes timer to interrupt, and every separated 100us interrupts once, reads in two paths of data and carries out the adaptive noise reduction algorithm process, and the useful signal that obtains is exported to coding chip 17 with this signal.
Among Fig. 5, said acoustic control assembly comprises wireless receiver 20, wireless receiver 20 and microcontroller 21, and microcontroller 21 is connected with motor-drive circuit 23 through optically coupled isolation circuit 22, and motor-drive circuit 23 is connected with motor 1; Simultaneously, DSP 14, microcontroller 21 and motor-drive circuit 23 are connected respectively at power supply 12; Motor-drive circuit 23 constitutes closed loop through current feedback circuit 25 with microcontroller 21 and is connected.
Wireless receiver 20 is used to receive the wireless signal from remote controller, and carries out decoding processing, outputs to microcontroller 21; Microcontroller 21 is used for receiving from the information of wireless receiver or other parts and judges and handle; Optically coupled isolation circuit 22 is connected to microcontroller 21 and motor-drive circuit 23, is used to receive the following output of the control control signal of microcontroller 21; Motor-drive circuit 23 is connected to optically coupled isolation circuit 22, is used to receive output drive signal under the control of optically coupled isolation circuit 22; Motor 1 is connected to said motor-drive circuit 23, is used under the control of said driving signal by needed direction, speed and torque rotation; Current feedback circuit 25 is made up of current sensor 26, operational amplifier 27, comparator 28; It is through gathering the electric current of motor-drive circuit 23; Through single supply operational amplifier 27, comparator 28, receive the I/O interface of microcontroller 21, so that the output torque fast and stable is requiring level; The overvoltages of power supply 12 band, overcurrent, low pressure, anti-reverse protection provide power supply to each circuit that need supply power such as said microcontroller 21, wireless receiver 20, motor-drive circuits 23.
Current feedback circuit 25 comprises current sensor 26, operational amplifier 27, comparator 28; Current sensor 26 is gathered the electric current of motor-drive circuit 23; Send into operational amplifier 27, comparator 28; Signal is relatively sent into microcontroller 21, and microcontroller 21 is handled back control motor-drive circuit 23.
DSP 14 adopts powerful TMS320C5535, and coding chip 17 adopts PT2262 chip and microcontroller 21 to adopt the ATMEGA128 chip.
Among Fig. 6, microcontroller 21 is adjusted average voltage through internal register adjustment pulse duty factor is set, and passs speed control signal to the PWM0 oral instructions; Through the output high-low level, pass the direction of motion signal of motor to the DIR oral instructions.The PWM0 signal is isolated U4 through light and is input to triode Q2 basis set, amplifies through one-level to drive high-power MOS tube Q4 gate pole, the running of drive motors.The DIR signal is isolated the power on and off that U5 is input to triode Q3 control relay 7,8 pin through light, controls the rotating of motor.
Among Fig. 7, circuit overcurrent protection is made up of current sensor 26, operational amplifier 27, comparator 28 etc.Through 26 pairs of metal-oxide-semiconductor current samplings of current sensor, sampling voltage is input to voltage comparator 28 with a 2.5V a reference value after amplifying 10 times through single supply operational amplifier 27 jointly, and relatively whether output current surpasses 25A.
Among Fig. 8; The code signal that coding chip 17 sends by: address code, numeric data code, synchronous code are formed a complete code word, after decoding chip receives signal, after its address code is relatively checked through twice; The VT pin is just exported high level, and meanwhile corresponding data pin is also exported high level.Flow chart adopts the mode of external interrupt to receive transmitter code and decode the acquisition control command.If the external interrupt input is arranged, bidding will, and decode.Receive the voice signal of " order 1 beginning ", low speed just changes, and receives the voice signal of " order 1 stops ", and low speed is just changeing and stopping; Receive the voice signal of " order 2 beginnings ", middling speed is just changeed, and receives the voice signal of " order 2 stops ", and middling speed is just being changeed and stopped; Receive the voice signal of " order 3 beginnings ", just change at a high speed, receive the voice signal of " order 3 stops ", high speed is just being changeed and is being stopped; Receive the voice signal of " order 4 beginning ", low speed and reverse receives the voice signal of " order 4 stops ", and low speed and reverse stops; Receive the voice signal of " order 5 beginnings ", middling speed is reversed, and receives the voice signal of " order 5 stops ", and the middling speed counter-rotating stops; Receive the voice signal of " order 6 beginning ", high speed reverse rotation receives the voice signal of " order 6 stops ", and high speed reverse rotation stops.
Among Fig. 9; Carried out EMC test; When voltage boosts in the 0-42KV scope, step-down and keeping; Robot for high-voltage hot-line work remote control nut is abolished parts operations such as instrument remote controller, voltage stabilizing chip, wireless receiving module, motor drive module, single-chip microcomputer normally, and each item measuring ability is in proper working order.