Robot trajectory control system
The application is application number: the 201610649424.X applying date: " postwelding impacts robot rail for 2016-08-09, title
The divisional application of mark tracking telemetering and control system ".
Technical field
The present invention relates to a kind of postweldings to impact manipulator trajectory tracking TT&C system.
Background technique
The development of automatic welding technique is the production of large shipbuilding industry, aviation, the steel machineries equipment such as make vehicle industry
Provide safe and efficient technical guarantee.However weld after weldment using quality not only with welding involved in welding process
The parameters such as material, bonding power and speed of welding are related, and the stress for welding generation also plays considerable effect.Welding
If the corresponding processing work such as impact after not butt welding afterwards, not only the size of welding workpiece and outer shape will be difficult to meet anticipation
Standard, and the structural bearing effect of welding workpiece interface can also weaken significantly.Especially in hull construction, to reach anticipation
Flatness, considerable proportion is occupied to the flat work of beating of the deck of boat.It is impacted with the raising of Automation of Welding degree, postwelding
Work is gradually substituted by intelligent robot.Currently, the postwelding impact robot using ultrasonic impact technology is in the ascendant, stress disappears
Except significant effect, gradually grow up.
Domestic related patents only have patent, and " constant scanning positions formula postwelding weld joint tracking and residual stress eliminates system
(CN201210401736) ", " tracking system for movable welding line stress eliminating robot (CN201310341420) ", " postwelding weld seam
High precision tracking and residual stress eliminate system (CN201310341500) " etc..What China developed moves with weldering and weldering
There are no the tracks such as the long weld seam realized after can carrying out observing and controlling tracking welding automatically and non straight line weld for impact robot afterwards
Function.Allow and further realize automatic implementation operation with weldering and postwelding impact robot, then the equipment need to realize weldering
The function of weld joint tracking observing and controlling afterwards.
Summary of the invention
The purpose of the present invention is to provide a kind of efficiency of raising postwelding impact, enhance the postwelding impact machine of welding quality
People's track following TT&C system.
The technical solution of the invention is as follows:
A kind of postwelding impact manipulator trajectory tracking TT&C system, it is characterized in that: including that postwelding impacts robot, movable type
Welding equipment, postwelding impact robot at the rear of Mobile welding equipment, are located at Mobile welding equipment institute's welding line track
On, it is impacted for postwelding weld joint tracking and postwelding;Synchronous motor is as a reference point, and synchronous motor is located at seam track side,
Every a distance;There is a constant speed synchronous shaft on the synchronous motor;The first, second two reflective infrared or laser sensings
Device is individually fixed in the constant speed synchronous shaft above synchronous motor, identical as motor rotational shaft speed, and it is mobile to be respectively used to detection
The angle between initial position line that welding equipment and postwelding impact robot are formed relative to synchronous motor and mark post line, point
It is not denoted as ∠ DFE, ∠ ACB;Two reflective infrared or laser sensor is not in the same horizontal line;Mark post is placed on welding just
At initial point, the first, second two reflecting pieces are affixed on mark post respectively, and two reflecting pieces are not in the same horizontal line;First is reflective
On piece and synchronous motor shaft first is reflective infrared or laser sensor in the same horizontal line, the second reflecting piece and synchronous electricity
On arbor second is reflective infrared or laser sensor in the same horizontal line;Mobile welding equipment and postwelding impact machine
Respectively there is a vertical shaft on people, third reflecting piece is affixed on the axis above Mobile welding equipment, anti-with first on synchronous motor
The first reflecting piece on infrared formula or laser sensor and mark post is penetrated in same level, three's group in same level
At triangle, it is labeled as Δ ABC;4th reflecting piece is affixed on the axis above postwelding impact robot, with the on synchronous motor
The second reflecting piece on two reflective infrared or laser sensors and mark post is in same level, and three is in same level
Upper composition triangle is labeled as Δ DEF;First distance measuring sensor is fixed on the axis above Mobile welding equipment, with mark post
On the first reflecting piece in the same horizontal line, for detect Mobile welding equipment and weld initial point at horizontal distance,
First in third reflecting piece and mark post on the axis of mobile welding robot in the horizontal distance same horizontal line is reflective
The distance between piece indicates, is denoted as line segment AB;Second distance measuring sensor is fixed on the axis above postwelding impact robot, with mark
On bar second it is reflective in the same horizontal line, for detect postwelding impact robot and weld initial point at horizontal distance,
Second in the 4th reflecting piece and mark post on the axis of postwelding impact robot in the horizontal distance same horizontal line is reflective
The distance between piece indicates, is denoted as line segment DE;Due to being bending weld seam, it is likely that two distance measuring sensors and welding initial point mark
Bar cannot be just opposite, can not ranging, two distance measuring sensors load onto the first, second small synchronous motor respectively, constantly rotate, turn
One circle is surveyed primary;Reflecting piece avoids interfering with each other by being mounted on different height, and using different modulating frequency laser or
Infrared light avoids interfering.Weld seam is planar-two-dimensional weld seam mixing in figure, and filled black line is welding line, remaining is non-welding line.
First distance measuring sensor and the second distance measuring sensor use Infrared High-Power distance measuring sensor.
Postwelding impacts robot by controller, double DC servo motors and driving, mobile robot ontology, double ultrasonic waves electricity
Machine and driving, crosshead shoe, postwelding impact robot manipulating task end composition;Biography in controller and observing and controlling track following TT&C system
Sensor and interface circuit are connected;Double DC servo motors and driving, double supersonic motors and driving are connected with controller 21, double straight
Flow servo motor and driving are connected with mobile robot ontology, and double supersonic motors and driving are connected with crosshead shoe, and cross is sliding
Block is connected with postwelding impact robot manipulating task end;Positioning drive mechanisms of the crosshead shoe as postwelding impact robot manipulating task end,
Realize the precision positioning at postwelding impact robot manipulating task end 26;Postwelding impact robot manipulating task end is fixedly connected with crosshead shoe,
Double supersonic motors and driving are so that crosshead shoe drives postwelding impact robot manipulating task end to reach precision positioning.
The postwelding impact robot manipulating task end uses electromagnetic hammer or ultrasonic impact head.
The mobile robot ontology is wheeled mobile robot, slightly fixed by the differential realization robot location of two-wheel
Position.
The present invention provides a kind of record Mobile welding equipment in real time and the sides of postwelding impact robot motion track
Formula, and be applied in postwelding impact manipulator trajectory tracking TT&C system, so that postwelding impact robot is accurately tracked
Welding tip track implements to impact, improves the efficiency of postwelding impact, enhances welding quality along welding line.
Detailed description of the invention
Present invention will be further explained below with reference to the attached drawings and examples.
Fig. 1 is postwelding impact manipulator trajectory tracking TT&C system structure chart.In figure, 1,2,3,4 be four reflecting pieces (four
The position of a reflecting piece is respectively labeled as point A, B, D, E), 5 and 6 be (two reflections of two reflective infrared or laser sensor
Formula is infrared or the position of laser sensor is respectively labeled as point C and F), 7 and 8 be two distance measuring sensors, and 9, which are one, synchronizes electricity
Machine, 10 be Mobile welding equipment (containing welding tip), and 11 be that (containing electronic compass, postwelding impacts machine for postwelding impact robot
Electromagnetic hammer or ultrasonic impact head etc. can be used in people's operation end), 12 be mark post, and 13 and 14 are two small synchronous motors.
Fig. 2 is postwelding impact robot control system architecture figure.
Fig. 3 is that postwelding seam tracking system angle measurement top view (is measured as with reflective infrared or laser sensor 5
Example).In figure, 5 be reflective infrared or laser sensor (reflective infrared or laser sensor 5 position mark is C).1(A)
0,1 (A) 1,1 (A) 2,1 (A) 3 represents four point (referred to as tracks in Mobile welding equipment (welding tip) motion track
Point, position mark A0、A1、A2、A3).L0, L1, L2, L3 are synchronous motors to be asked at a distance from pad.2 (B) are welding
Starting point.α 0, α 1, α 2, the variation that α 3 is the angle that initial position, synchronous motor and pad are formed.
Fig. 4 is that postwelding seam tracking system angle measurement timing diagram (is measured as with reflective infrared or laser sensor 5
Example).
Fig. 5 is postwelding seam tracking system range measurement top view (by taking the measurement of distance measuring sensor 1 as an example).In figure, position C
It is reflective infrared or laser sensor 5 the corresponding position on 9 axis of synchronous motor, A is the mobile position of distance measuring sensor 1,
Position B is the corresponding position of the reflecting piece 2 on mark post 12.
Specific embodiment
A kind of postwelding impacts manipulator trajectory tracking TT&C system, using constant speed rotary motor as reference position, using away from
The method combined from measurement and angle measurement records welding tip motion track (relative to synchronous motor reference point) in real time, leads to
It crosses and is compared two tracks, postwelding impact robot manipulating task end can be obtained and deviate the distance of welding line and direction, thus
Postwelding is adjusted by control system and impacts robot pose, realizes correction, guarantees that postwelding impact robot manipulating task end is right always
Quasi- weld seam operation.
The present invention will be further described with reference to the accompanying drawing:
Referring to Fig.1, postwelding of the invention impacts manipulator trajectory tracking TT&C system, by four reflecting pieces 1,2,3,4 (four
The position of a reflecting piece is respectively labeled as point A, B, D, E), (two reflective for two reflective infrared or laser sensor 5 and 6
Infrared or laser sensor position is respectively labeled as point C and F), it is two distance measuring sensors 7 and 8, a synchronous motor 9, mobile
Formula welding equipment 10 (contain welding tip), postwelding impact robot 11 (can containing electronic compass, postwelding impact robot manipulating task end
Using electromagnetic hammer or ultrasonic impact head etc.), 12, two small synchronous motors 13 and 14 of mark post form.
The postwelding impact robot 11 is located at 10 institute of Mobile welding equipment at the rear of Mobile welding equipment 10
On welding line track, impacted for postwelding weld joint tracking and postwelding.Synchronous motor 9 (synchronous motor is as a reference point) is located at weld seam
Track side, is spaced a distance, and has a constant speed synchronous shaft on the synchronous motor 9.Two reflective infrared or laser
Sensor 5 and 6 is individually fixed on the synchronous rotating shaft of 9 top of synchronous motor, identical as motor rotational shaft speed, is respectively used to detection and is moved
The initial position line that dynamic formula welding equipment 10 and postwelding impact robot 11 are formed relative to synchronous motor 9 and 12 line of mark post it
Between angle, be denoted as ∠ DFE, ∠ ACB respectively.Two reflective infrared or laser sensor is not in the same horizontal line.Mark post
12 are placed at welding initial point, and two reflecting pieces 2 and 4 are affixed on mark post respectively, and two reflecting pieces are not in the same horizontal line.
Reflective infrared or laser sensor 5 on reflecting piece 2 and 9 axis of synchronous motor in the same horizontal line, reflecting piece 4 and synchronous electricity
Reflective infrared or laser sensor 6 on 9 axis of machine is in the same horizontal line.Mobile welding equipment 10 and postwelding impact machine
Respectively there is a vertical shaft on people 11, reflecting piece 1 is affixed on the axis of 10 top of Mobile welding equipment, with the reflection on synchronous motor 9
Formula is infrared or laser sensor 5 and mark post 12 on reflecting piece 2 in same level, three can in same level group
At triangle, it is labeled as Δ ABC.Reflecting piece 3 is affixed on the axis of postwelding impact robot 11 top, and anti-on synchronous motor 9
The reflecting piece 4 on infrared formula or laser sensor 6 and mark post 12 is penetrated in same level, three can be in same level
Triangle is formed, Δ DEF is labeled as.Distance measuring sensor 7 is fixed on the axis of 10 top of Mobile welding equipment, on mark post 12
Reflecting piece 2 in the same horizontal line, for detect Mobile welding equipment 10 and weld initial point at horizontal distance, the water
Flat distance can use the reflecting piece 2 in the reflecting piece 1 and mark post 12 on the axis of the mobile welding robot 10 in same horizontal line
The distance between indicate, be denoted as line segment AB.Distance measuring sensor 8 is fixed on the axis of 11 top of postwelding impact robot, with mark post
On 12 reflective 4 in the same horizontal line, should for detecting postwelding impact robot 11 and welding the horizontal distance at initial point
Horizontal distance can impact the reflecting piece in reflecting piece 3 and mark post 12 on the axis of robot 11 with the postwelding in same horizontal line
The distance between 4 indicate, are denoted as line segment DE.Distance measuring sensor 7 and distance measuring sensor 8 use Infrared High-Power distance measuring sensor,
Due to being bending weld seam, it is likely that two distance measuring sensors and welding initial point mark post cannot be just opposite, can not ranging.Therefore two
A distance measuring sensor will load onto small synchronous motor 13 and 14, constantly rotate, and turning around, it is primary to survey.Reflecting piece is by being mounted on
Different height avoids interfering to avoid interfering with each other using the laser of different modulating frequency or infrared light.Weld seam is in figure
Planar-two-dimensional weld seam mixing, filled black line are welding line, remaining is non-welding line.
Referring to Fig. 2, the postwelding impact robot in postwelding impact manipulator trajectory tracking TT&C system of the invention is by controlling
Device 21 processed, double DC servo motors and driving 22, mobile robot ontology 23, double supersonic motors and driving 24, crosshead shoe
25, postwelding impact robot manipulating task end 26 forms.Postwelding impacts in robot controller and observing and controlling track following TT&C system
Sensor and interface circuit 27 are connected, including two distance measuring sensors 7 and 8, two reflective infrared or laser sensing
Device 5 and 6, synchronous motor 9 and small synchronous motor 13 and 14 etc..Electricity can be used in the postwelding impact robot manipulating task end 26
Magnetic hammer, the first-class composition of ultrasonic impact.Double DC servo motors and driving 22, double supersonic motors and driving 24 and controller 21
It is connected, double DC servo motors and driving 22 are connected with mobile robot ontology, and double supersonic motors and driving 24 are slided with cross
Block 25 is connected, and crosshead shoe 25 is connected with postwelding impact robot manipulating task end 26.The mobile robot ontology 23 is wheeled
Mobile robot, by the differential realization robot location's coarse positioning of two-wheel, crosshead shoe 25 impacts robot manipulating task as postwelding
The positioning drive mechanisms at end 26 realize the precision positioning at postwelding impact robot manipulating task end 26.Postwelding impacts robot manipulating task end
26 are fixedly connected with crosshead shoe 25, and double supersonic motors and driving 24 make crosshead shoe 25 that postwelding impact robot be driven to make
Industry end 26 reaches precision positioning.
Illustrate postwelding weld seam in the present invention by taking reflective infrared or laser sensor 5 measurement as an example referring to Fig. 3
Tracking system angle measurement principle.Reflective infrared or laser sensor 5 position mark is C.1(A)0,1(A)1,1(A)2,1
(A) 3 four points (referred to as pad, the position mark A in Mobile welding equipment (welding tip) mobile welding are represented0、
A1、A2、A3).L0, L1, L2, L3 are synchronous motors to be asked at a distance from pad.2 (B) are welding initial position.α0,α1,α
2, α 3 is the angle that initial position, synchronous motor and pad are constituted.
It, according to timing diagram, is further illustrated by taking reflective infrared or laser sensor 5 measurement as an example referring to Fig. 4
Postwelding seam tracking system angle measurement principle in the present invention.Reflective infrared or laser sensor 5 is synchronous with synchronous motor 9
Shaft is fixed, constant speed rotary.Motor every revolution, reflective infrared or laser sensor 5 and reflecting piece 2 are relatively primary, at this time
Controller exports a high level pulse.Since reflective infrared or 5 revolving speed of laser sensor is uniform, high level pulse frequency
Rate is constant.Using high-frequency impulse interpolation method, high-frequency impulse, frequency-invariant, the umber of pulse of filling are filled between exporting pulse
Amount is denoted as N.Reflective infrared or laser sensor 5 and 1 (A of reflecting piece0、A1、A2、A3) it is opposite when, can also can be defeated by controller
A high level pulse out.As welding tip constantly moves, distance AC and angle [alpha] are constantly changing, and pass through high-frequency impulse
Number N (N0、N1、N2) characterize the variation of angle [alpha].
If synchronous motor 9 drives reflective infrared or laser sensor 5 to rotate clockwise, transfer point A is in the counterclockwise direction
Movement.The transfer point initial position is A0, welding equipment is during weld movement, reflective infrared or laser sensor 5
Continuous high-speed rotating scanning.The light passing point A that reflective infrared or laser sensor 5 emits0When with point B, interface electricity can be passed through
Road exports two high level pulses.If when initial, welding tip is still in A0Place, starting phase angle ∠ BCA0It is denoted as α0.Light warp
Starting high-frequency impulse counts when crossing A, stops counting when reaching B.If motor speed is constant, and rotates the fillable high frequency arteries and veins of a circle
Rushing number is N.Controller can read high-frequency impulse number N representated by angle between A0 and B by interface circuit0, then it can be calculated:
∠ BCA can similarly be measured1、∠BCA2…….Therefore welding tip can be recorded in real time relative to reference position
Angle change track (∠ BCA0、∠BCA1、∠BCA2……)。
Referring to Fig. 5, illustrate that postwelding seam tracking system distance is surveyed in the present invention so that the distance measuring sensor 1 measures as an example
Measure principle.Reflective infrared or laser sensor 5 (position C), distance measuring sensor 1 (transfer point A), mark on 9 axis of synchronous motor
Reflecting piece 2 (position B) on bar 12 can form triangle in same level, be denoted as A0BC.The length of line segment BC can be straight
It connects and is measured with scale, line segment A0B can be measured in real time by distance measuring sensor 1, then it is opposite to can be calculated welding tip according to formula (2)
Distance in reference position:
A0B2=BC2+A0C2-2BC*A0C*cosα0 (2)
Formula (2) can arrange as formula (3):
A0C2-2BC*cosα0*A0C+BC2-A0B2=0 (3)
When meeting BC2(cos2α0-1)+A0B2When >=0,
Take A0C≥0。L0=A0C.L can similarly be acquired1、L2、L3......
Therefore distance change track (L of the welding tip relative to reference position can be recorded in real time0、L1、L2、
L3...) and angle change track (∠ BCA0、∠BCA1、∠BCA2...), the track of Weld pipe mill is obtained by fitting
(on condition that welding tip weld joint tracking precision with higher).
The present invention is made using reflective infrared or laser sensor and distance measuring sensor real-time detection postwelding impact robot
The position at industry end, available postwelding impact robot manipulating task end is relative to the distance change track of reference position and angle change
Track.Postwelding impact robot manipulating task end track is compared with the track of Mobile welding equipment, available postwelding punching
Hit the angle and distance that Weld pipe mill is deviateed at robot manipulating task end (on the basis of the synchronous motor of reference position).
Other than technical characteristic described in the specification, remaining all is technically known to those skilled in the art theory.