The utility model content:
The purpose of the utility model is to address the above problem, and provides a kind of robot for high-voltage hot-line work special-purpose acoustic control bolt clipper.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 carry out speed, moment of torsion control bolt clipper.This acoustic control bolt clipper carries out Long-distance Control through acoustic control transmitter trigger remote controller, and is safer, reliable than manual bolt clipper, can satisfy robot for high-voltage hot-line work and accomplish the disconnect request to power cable.
For realizing above-mentioned purpose, the utility model adopts following technical scheme:
The special-purpose acoustic control bolt clipper of a kind of robot for high-voltage hot-line work, it mainly is made up of bolt clipper main body, acoustic control transmitter trigger remote controller and acoustic control assembly; Wherein said bolt clipper main body comprises main casing, is provided with hydraulic power unit in the main casing, and hydraulic power unit is connected with moving cutting tool, and moving cutting tool is hinged with the fixed cutting tool that is fixedly mounted on the main casing; The acoustic control assembly that is provided with power supply at the main casing rear portion and matches with acoustic control transmitter trigger remote controller;
Said acoustic control assembly comprises box body; On box body, be provided with indicator lamp, antenna; Antenna is connected with the interior wireless receiver of box body; 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 hydraulic power unit comprises motor, and motor is by the acoustic control assembly, and motor is connected with oil pump; Oil pump is connected with oil cylinder; The plunger of oil cylinder is connected with moving cutting tool, and moving cutting tool is connected through bearing pin with fixed cutting tool, accomplishes the cut-out to power cable through the rotation of moving cutting tool; Motor is a permanent magnet direct current motor, and motor cooperates with shell inner cavity, adopts reinforcement groove location and fixing.
Said main casing is provided with the manipulator snap fastener; Said main casing is provided with the manipulator snap fastener; The manipulator snap fastener comprises main body framework and engaging support, and main body framework connects with main casing, and the engaging support is used for engaging with manipulator; According to the requirement of manipulator operating attitude, the engagement angles of engaging support and main body framework is carried out 180 ° and is freely changed.
Said box body comprises the high permeability material shell; Also be provided with fan and fan air guide hole in the enclosure; The fan air guide hole is arranged woven wire, line outlet layout conductive rubber, and motor-drive circuit links to each other with motor through shielded cable simultaneously, and power ground links to each other with the bolt clipper tool body.
The anterior design of the cylinder body of said oil cylinder plunger guide cover and distance caging device; Fairlead is used for the double support of plunger guide, and stopping means is used to control overflow valve, when the cut-out task is promptly accomplished in the coincidence of work cutting knife blade; Open overflow valve; Hydraulic oil gets into fuel tank, realizes the oil pump pressure release, and the work cutting knife is able to automatically reset.
The wireless acoustic control bolt clipper of the utility model is made up of bolt clipper body, acoustic control transmitter trigger remote controller and acoustic control assembly.Wherein, Acoustic control transmitter trigger remote controller is made up of following part, comprises DSP, coding chip, wireless driver element, man-machine interface unit;
Power supply is Ni-MH battery (NI-MH), in light weight, life-span length, pollution-free, and the matching value of capacity and voltage is fit to the characteristics that the activity duration is short, the operation frequency is high, operating current is big.
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.
Motor adopts permanent magnet direct current motor, and ferrite magnetic material is used in stator core, meet simple in structure, the characteristics that starting current is little, efficient is high.Motor provides power by the ni-mh power supply, partly controls rotating speed and moment of torsion by motor driver; Motor cooperates with shell inner cavity, adopts reinforcement groove location and fixing, can shock-resistant and vibration.
Oil pump adopts and can reverse the double-acting vane pump design, design use the characteristics of double-acting vane pump high efficiency, hydraulic coupling radial equilibrium; Blade is selected 12 for use, and pulsation rate is little; Adopt two into and out of oil groove with addition of one-way valve designs, the oil pump blade has been realized reversible rotation, the positive and negative rotation of motor all can drive oil pump output hydraulic oil.
Oil cylinder adopts the plunger-type cylinder design, belongs to single-acting formula hydraulic cylinder, the indoor design recoil press spring, be used for the oil pump pressure release after, plunger return; The oil cylinder cylindrical designs soft fuel tank, and oil cylinder and soft fuel tank are through overflow valve UNICOM.
The anterior design of cylinder body plunger guide cover and distance caging device.Fairlead is used for the plunger guide supporting role of holding concurrently, and plunger is sagging when avoiding oil cylinder to be sidelong causes the oil sealing infringement; Stopping means is used to control overflow valve, when the cut-out task is promptly accomplished in the coincidence of work cutting knife blade, opens overflow valve, and hydraulic oil gets into fuel tank, realizes the oil pump pressure release, and the work cutting knife is able to automatically reset.
The work cutting knife comprises moving cutting tool and fixed cutting tool, and the blade of two cutting knifes designs for camber line, to prevent the power cable slippage; Moving cutting tool rotates around fulcrum, and the track that two camber lines overlap is a process of cutting off power cable, when two circular arc line point of contacts overlap, cuts off action and finishes.
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 man-machine interface unit comprises sound receiver module and state indicating member, and it is used for accomplishing the work of man-machine interaction, comprises the control of motor speed, motor drive direction and Motor torque.
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.
The state indicating member is accomplished the indication that signal sends state.
The acoustic control assembly comprises wireless receiver, microcontroller, optical coupling isolation circuit, motor-drive circuit, motor, current feedback circuit, power supply.Wherein:
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.
Said box body comprises the high permeability material shell, arranges woven wire, line outlet layout conductive rubber cover at shell fan air guide hole, and motor-drive circuit links to each other with motor through shielded cable simultaneously, and power ground links to each other with the bolt clipper tool body.
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 bolt clipper carries out Long-distance Control through acoustic control transmitter trigger remote controller, and is safer, reliable than manual bolt clipper, 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 DSP and unique circuit shield technology, make product have superpower antijamming capability and reliability, can be under very harsh electromagnetic interference environment long-term stable operation.
The 2nd, bolt clipper carries 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 through the adjustment pulse duty factor, rotating control, and control is flexible, and reliability is high.
The 5th, controller has Current Feedback Control, eliminates the influence of bolt clipper job insecurity 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, bolt clipper controller and the control of other instruments are general, are convenient to instrument seriation from now on.
The specific embodiment
Below in conjunction with accompanying drawing and embodiment the utility model is further specified.
Among Fig. 1, the utility model is made up of bolt clipper main body, acoustic control transmitter trigger remote controller and acoustic control assembly.
Acoustic control assembly shell 1 is fixed on the main casing 7, comprises antenna 2, fan 3, indicator lamp 4.
Wherein said bolt clipper main body is as shown in Figure 1, and it comprises power supply 5, manipulator snap fastener 6, main casing 7, motor 8, oil pump 9, oil cylinder 10, fixed cutting tool 11, moving cutting tool 12.
Power supply 5 is assembled together through draw-in groove and buckle and main casing 7.Manipulator snap fastener 6 is fixedly connected with main casing 7, freely engages with the manipulator of robot for high-voltage hot-line work and separates.Motor 8 is assemblied in main casing 7 inner chambers, and motor output shaft is coaxial with the blade rotation centerline of oil pump 9.Oil pump 9, oil cylinder 10 are weldingly fixed on through steel bushing with motor 8 shells; Oil pump 9 is communicated with oil cylinder 10 through check valve and oil duct; Oil cylinder 10 is through overflow valve and oil duct and soft fuel tank UNICOM; The plunger of oil cylinder 10 connects with moving cutting tool 12 through push rod, and moving cutting tool 12 centres of gyration and fixed cutting tool 11 are hinged through bearing pin.
After manipulator snap fastener 6 and robot for high-voltage hot-line work manipulator are realized connecting, control actuating motor 8 through wireless acoustic control mode, the rotation of oil pump 9 blades; Completion oil suction-formation hydraulic oil-fuel-displaced, hydraulic oil gets into oil cylinder 10 through check valve and oil duct, and plunger moves ahead in fairlead; Promote push rod; Moving cutting tool 12 rotates around fulcrum under the push rod effect, when fixed cutting tool 11 overlaps with two blade camber lines of moving cutting tool 12, cuts off action and finishes; While plunger activated limit switch, overflow valve is opened, and hydraulic oil gets into soft fuel tank, and plunger is return under the recoil press spring effect, and the blade of two cutting knifes separates, and moving cutting tool 12 is accomplished and is resetted, the next cut-out of preparation operation.
Wherein said acoustic control transmitter trigger remote controller is as shown in Figure 2, and it comprises DSP 13, and it is connected with the man-machine interface unit, and coding chip 16 also is connected with wireless driver element simultaneously; Wherein the man-machine interface unit comprises sound receiver module 14 and state indicating member 15, and they are connected with DSP 13 respectively.Wireless driver element comprises carrier oscillation circuit 17, and its input is connected with coding chip 16, and output is connected with wireless amplification emissioning circuit 18 inputs.
When acoustic control transmitter trigger remote controller will be when bolt clipper sends control command, DSP 13 obtains the control corresponding instruction, and gives wireless driver element circuit according to the data of gathering sound receiver module 14; 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 14 is as shown in Figure 3; It comprises main microphone 14.1, with reference to microphone 14.5; They are connected with analog amplify circuit I14.2, analog amplify circuit II14.6 respectively; Analog amplify circuit I14.2, analog amplify circuit II14.6 are connected with filter circuit I14.3, filter circuit II14.7 circuit respectively, and filter circuit I14.3, filter circuit II14.7 circuit link to each other with A/D change-over circuit I14.4, A/D change-over circuit II14.8 respectively.
Main microphone 14.1, be used for receiving voice command from the operator with reference to microphone 14.5; Main microphone 14.1 obtain is a useful signal and an incoherent noise signal mixed signal, to obtain with reference to microphone 14.5 be reference noise signal; Through simulation amplification, filtering, A/D conversion, voice signal is outputed to DSP 13.In DSP 13, 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 16 with this signal.
Among Fig. 4, said acoustic control assembly comprises wireless receiver 19, wireless receiver 19 and microcontroller 20, and microcontroller 20 is connected with motor-drive circuit 22 through optically coupled isolation circuit 21, and motor-drive circuit 22 is connected with motor 8; Simultaneously, DSP 13, microcontroller 20 and motor-drive circuit 22 are connected with power supply 23 respectively; Motor-drive circuit 22 constitutes closed loop through current feedback circuit 24 with microcontroller 20 and is connected.
Wireless receiver 19 is used to receive the wireless signal from remote controller, and carries out decoding processing, outputs to microcontroller 20; Microcontroller 20 is used for receiving from the information of wireless receiver or other parts and judges and handle; Optically coupled isolation circuit 21 is connected to microcontroller 20 and motor-drive circuit 22, is used to receive the following output of the control control signal of microcontroller 20; Motor-drive circuit 22 is connected to optically coupled isolation circuit 21, is used to receive output drive signal under the control of optically coupled isolation circuit 21; Motor 8 is connected to said motor-drive circuit 22, is used under the control of said driving signal by needed direction, speed and torque rotation; Current feedback circuit 24 is made up of current sensor 25, operational amplifier 26, comparator 27; It is through gathering the electric current of motor-drive circuit 22; Through single supply operational amplifier 26, comparator 27, receive the I/O interface of microcontroller 20, so that the output torque fast and stable is requiring level; Power supply 24 band overvoltages, overcurrent, low pressure, anti-reverse protection provide power supply to each circuit that need supply power such as said two microcontrollers, wireless receiver 19, motor-drive circuits 22.
Current feedback circuit 24 comprises current sensor 25, operational amplifier 26, comparator 27; Current sensor 25 is gathered the electric current of motor-drive circuit 22; Send into operational amplifier 26, comparator 27; Signal is relatively sent into microcontroller 20, and microcontroller 20 is handled back control motor-drive circuit 22.
DSP 13 adopts powerful TMS320C5535, and coding chip 16 adopts PT2262 chip and microcontroller 20 to adopt the ATMEGA128 chip.
Among Fig. 5, microcontroller 20 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. 6, circuit overcurrent protection is made up of current sensor 25, operational amplifier 26, comparator 27 etc.Through 25 pairs of metal-oxide-semiconductor current samplings of current sensor, sampling voltage is input to voltage comparator 27 with a 2.5V a reference value after amplifying 10 times through single supply operational amplifier 26 jointly, and relatively whether output current surpasses 25A.
Among Fig. 7; The code signal that coding chip 16 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. 8; Carried out 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 remote control bolt clipper 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.