CN105013734B - Washing control method for transformer substation washing robot based on ultrasonic distance measurement - Google Patents
Washing control method for transformer substation washing robot based on ultrasonic distance measurement Download PDFInfo
- Publication number
- CN105013734B CN105013734B CN201410459384.3A CN201410459384A CN105013734B CN 105013734 B CN105013734 B CN 105013734B CN 201410459384 A CN201410459384 A CN 201410459384A CN 105013734 B CN105013734 B CN 105013734B
- Authority
- CN
- China
- Prior art keywords
- point
- water
- interpolation
- washing
- control method
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 238000005406 washing Methods 0.000 title claims abstract description 13
- 238000005259 measurement Methods 0.000 title abstract 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 82
- 239000012212 insulator Substances 0.000 claims abstract description 67
- 238000012544 monitoring process Methods 0.000 claims abstract description 8
- 238000011010 flushing procedure Methods 0.000 claims description 58
- 230000033001 locomotion Effects 0.000 claims description 22
- 239000012530 fluid Substances 0.000 claims description 11
- 230000001133 acceleration Effects 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 9
- 239000007921 spray Substances 0.000 claims description 8
- 230000008859 change Effects 0.000 claims description 5
- 230000033228 biological regulation Effects 0.000 claims description 4
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 238000004140 cleaning Methods 0.000 description 8
- 230000005540 biological transmission Effects 0.000 description 3
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 2
- FAPWRFPIFSIZLT-UHFFFAOYSA-M Sodium chloride Chemical compound [Na+].[Cl-] FAPWRFPIFSIZLT-UHFFFAOYSA-M 0.000 description 1
- 239000002253 acid Substances 0.000 description 1
- 238000012271 agricultural production Methods 0.000 description 1
- 238000011001 backwashing Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 239000003792 electrolyte Substances 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000007789 gas Substances 0.000 description 1
- 230000008676 import Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 239000002440 industrial waste Substances 0.000 description 1
- 210000003205 muscle Anatomy 0.000 description 1
- 238000004080 punching Methods 0.000 description 1
- 238000010926 purge Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 150000003839 salts Chemical class 0.000 description 1
- 239000013535 sea water Substances 0.000 description 1
- 239000011780 sodium chloride Substances 0.000 description 1
- 239000002689 soil Substances 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Landscapes
- Cleaning By Liquid Or Steam (AREA)
Abstract
The invention discloses a washing control method for a transformer substation washing robot based on ultrasonic distance measurement. According to the distance acquired through an ultrasonic distance measurement instrument and an image monitored through a monitoring camera, the relative distance between the current robot and insulators is acquired, whether the relative distance is a safe distance or not is judged, if yes, the next step is executed, and if not, the position is adjusted till the relative distance is the safe distance, wherein the ultrasonic distance measurement instrument and the monitoring camera are installed on a washing platform; the path planning initial state is determined; a linear interpolation manner is adopted for automatically washing an insulator string vertically through a washing mechanical arm; a circular interpolation manner of a point-to-point comparison method is adopted so that the insulator string facing the side of the robot can be washed through a nozzle; in the washing process, the water outflow caliber and the water outflow speed of a water gun are adjusted, so that a Karman vortex street is formed, and the vibration frequency of the insulator string is adjusted. The robot works in the safe distance, the start point and the stop point of a washing track are accurately located, and washing quality and efficiency are improved.
Description
Technical field
The present invention relates to robot field, the water of more particularly, to a kind of transformer station water flushing device people based on laser ranging
Purging method.
Background technology
With developing rapidly of industrial economy and urban construction, the seriality that transformer station is powered and quality propose more next
Higher requirement.It is chronically exposed in the Nature yet with transmission line equipment, particularly industrialized regions, coastal and salt-soda soil
Region, by industrial waste gas, sea water with nature is saline and alkaline, dust is affected it will usually be formed to a certain degree in its insulator surface
Filth.These contain the filth of salt, acid, alkaline components, in general water soluble, and filth becomes electrolyte after being dissolved in water,
There is very strong electric conductivity.The insulator being contaminated, conductance increases, and insulating properties reduce, and leakage current sharply increases, its sudden strain of a muscle
Network voltage substantially reduces, and is now easy for dirt flashover.Especially when insulator design is revealed than away from inadequate or employing
When insulator can not meet filth and requires, pollution flashover probably occurs.Pollution flashover accident, once occurring, can directly result in the big face of user
Long-pending, long-time have a power failure, cause power supply reliability to decline, thus bring serious negative to industrial and agricultural production and resident living power utility
Impact.Prevent transmission line of electricity pollution flashover, prevent the generation of electrical network massive blackout accident it is ensured that power network safety operation and electric power
Reliable supply is just particularly important.
At present, Substation Insulator water rinse there is problems that：
1st, the cleaning works of Substation Insulator mainly adopts power failure hand sweeping or living water washing.Artificial using having a power failure
Cleaning quality is low, equipment cleaning works is in passive state it is impossible to obtain in good time cleaning, and these all can be to transformer station's power transmission line
The safe and stable operation on road causes certain hidden danger.
2nd, the cleaning works of part Substation Insulator relies on machine to carry out, but automatization level is low, controls not essence
Really, thus leading to the cleaning to Substation Insulator not thoroughly it is impossible to meet safety requirements.
Livewire work is capable of based on the transformer station water flushing device people that this invents, stability and high efficiency water rinses, and is conducive to
The stable operation of electrical network.Now, the research and development of water flushing device people are like a raging fire, and carry out water with regard to water flushing device people and rinse work
Path planning problem during industry also imperfection.
Content of the invention
For solving the deficiency that prior art exists, the invention discloses a kind of transformer station's water flushing based on supersonic sounding
The water flush control method of device people, this flushing control mode is used for planning the road that water flushing device people is rinsed to insulator
Footpath, distance between adjustment spray gun and insulator, adjust in flushing process and flush out water speed formation Karman vortex street etc..Can be effectively
Ensure robot smoothness run in flushing process, realize error and acceleration is controlled, and there is good developing result.
For achieving the above object, the concrete scheme of the present invention is as follows：
The water flush control method of the transformer station water flushing device people based on supersonic sounding, including：
Step one：Gathered apart from according to the ultrasonic range finder being arranged on flushing platform and monitoring camera and monitor
Image obtains the relative dimensional coordinate figure between current robot and insulator, judge both relative distances be whether safety away from
From, if so, carry out next step, if it is not, the position of adjustment flushing platform, until this relative distance is safe distance；Determine road
The initial state of footpath planning；
Step 2：By controlling the auto-flushing of the above-below direction to insulator chain for the water flushing tool arm；Sprayed by controlling
Head is realized shower nozzle and the insulator chain towards robot side can be carried out；
Step 3：When carrying out water flushing, by adjusting hydraulic giant water outlet bore and going out water speed, form Karman vortex street reality
The now regulation to insulator chain frequency of vibration.
In described step 2, auto-flushing to the above-below direction of insulator chain, detailed process is：
(2-1) in flushing process, the angular displacement sensor being arranged in the rotary shaft of each joint collects initial time
And each joint angles of end time motion arm；
(2-2) for the easy motion of single joint, lopcus function θ (t) meet the constraint condition, corresponded to according to constraints
Constraint equation uniquely determine a cubic polynomial；
(2-3) joint velocity and the acceleration of movement locus are obtained according to this cubic polynomial, by the joint of movement locus
Velocity and acceleration substitutes into the coefficient that constraint equation obtains cubic polynomial, and this coefficient determines washing time and rinses angle
Relation；
(2-4) length according to insulator chain and cubic polynomial obtain the length of insulator chain in flushing process in time
Variation relation, to (l, d, θ0,θf) enter row interpolation, generate the flushing rail of the above-below direction to insulator chain for the water flushing tool arm
Mark.
Described constraints, two of which is the corresponding joint angles of starting point and ending point：
θ (0)=θ0；
θ(tf)=θf；
Wherein, θ0,θfJoint angles for starting point and ending point；
When joint velocity in path point is not zero, velocity restraint condition is changed into：
θ ' (0)=θ0'
θ'(tf)=θf'.
By four equations that velocity restraint condition determines cubic polynomial it is：
θ0=a0
θf=a0+a1tf+a2tf 2+a3tf 3
θ0'=a1
θf'=a1+2a2tf+3a3tf 2
θ0,θf,θ′0,θ′fIt is respectively starting point and time parameter tfThe angle in moment and angular velocity, a0,a1,a2,a3For
Undetermined coefficient.
Solving equation group, can get the coefficient of cubic polynomial：
a0=θ0
a1=θ0'
θ0,θf,θ′0,θ′fIt is respectively starting point and time parameter tfThe angle in moment and angular velocity, a0,a1,a2,a3For
Undetermined coefficient.
If the joint angles at paths traversed point are θv, adjacent with this point before and after 2 points of joint velocity be respectively
θ0And θg.From θ0To θvInterpolation cubic polynomial be：
θ (t)=a10+a11t+a12t2+a13t3
From θvTo θgInterpolation cubic polynomial be：
θ (t)=a20+a21t+a22t2+a23t3
The time interval of above-mentioned two cubic polynomial is respectivelyWithTo this two polynomial constraints
It is：
θ0=a10
θv=a10+a11tf1+a12tf1 2+a13tf1 3
θv=a20
θg=a20+a21tf2+a22tf2 2+a23tf2 3
0=a11
0=a21+2a22tf2+3a23tf2 2
a11+2a12tf1+3a13tf1 2=a21
2a21+6a13tf1=2a22
aij, i=1,2, j=0,1,2,3, it is undetermined coefficient, tf1,tf2For time parameter.
Constraints above condition constitutes 8 linear equation containing 8 unknown numbers, for tf1=tf2=tfSituation, this
Individual non trivial solution is：
a10=θ0
a11=0
a20=θv
aij, i=1,2, j=0,1,2,3, it is undetermined coefficient, tf,tf1,tf2For time parameter.
Thus we bring the coefficient obtaining into θ (t)=a10+a11t+a12t2+a13t3It is possible to obtain joint angles with
The relation of time change.
In described step 2, the insulator chain towards robot side is carried out, the circular arc using point-to-point comparison method is inserted
Benefit mode；When carrying out circular interpolation, generally with the center of circle as initial point, coordinate figure according to circular arc Origin And Destination is carrying out interpolation.
Coordinate figure according to circular arc Origin And Destination is specially carrying out interpolation：If the circular arc starting point coordinate of circular interpolation is
(X0,Y0), terminal point coordinate is (Xe,Ye), for any point (X on circular arci,Yi), have：Xi 2+Yi 2=R2, make F=Xi 2+Yi 2-R2For
Departure function.As F ＞ 0, this point is outer in circle, moves a step to -X direction fortune；As F ＜ 0, this point in circular arc, to +Y direction
Fortune moves a step；For making motion continue, F=0 is included into the situation of F ＞ 0, moving interpolation is all the time along circular arc and to terminal fortune
Dynamic.
The differentiation of circular interpolation calculates can be using following superposition computing：
If current point (Xi,Yi) corresponding departure function is
Fi=Xi 2+Yi 2-R2
After spray gun makes a move along -X direction
Fi+1=(Xi-1)2+Yi 2-R2=Fi-2Xi+1
After spray gun makes a move along +Y direction
Fi+1=Xi 2+(Yi+1)2-R2=Fi+2Yi+1
End point judging can be by n=| Xe-X0|+|Ye-Y0| differentiate, often making a move makes n=n+1, till n=0.
To (Xi,Yi,θ0,θf) enter row interpolation, generate water flushing device people is entered to the insulator chain towards robot side
The movement locus of row cleaning.
In described step 2, the condition that Karman vortex street is formed：Cylinder in a fluid, its Reynolds number meets 47<Re<
105, Reynolds number is used for characterizing flow of fluid situation, with ReRepresent, Re=ρ vl/ η, wherein v, ρ, η are respectively the flow velocity, close of fluid
Degree and viscosity coefficient, l is a characteristic length；
Insulator chain frequency of vibration is directly proportional to fluid (water) speed, is inversely proportional to the frontal width of bluff body, karman vortex
Street frequency is that swirl generating body width has following relation with fluid velocity and bluff body：F=SrV/d, wherein f are Karman vortex street frequency
Rate；SrFor Strouhal number；V is fluid velocity；L is a characteristic length, and d heads on width for bluff body；
By adjusting hydraulic giant water outlet bore and going out water speed, form Karman vortex street and realize to insulator chain frequency of vibration
Adjust, to produce good developing result.
It is interpolation, the interpolation principle of suitable inverse circular arc of other quadrants and first quartile phase against circular arc for the first quartile above
Seemingly.
Path point is also regarded as " starting point " and " terminating point ", inverse kinematics is solved to these path point, obtain corresponding
Joint vector value, it is then determined that required cubic algebraic curves function, coupling together that path point smooths, but this
The joint motions speed of " starting point " and " terminating point " is no longer zero a bit.
When carrying out water flushing, adjusting water outlet speed, make Reynolds number meet 47<Re<105, form Karman vortex street.Frequency of vibration
It is directly proportional to fluid velocity, is inversely proportional to the frontal width of bluff body, adjust hydraulic giant water outlet bore, realize insulator chain is vibrated
The regulation of frequency, to produce good developing result.
When rinsing insulator, current are peeled off from insulator both sides, form alternate vortex, this alternate vortex, make absolutely
The spot speed of edge both sides current is different, and water velocity is different, and the instantaneous pressure that insulator both sides are subject to is also different, therefore makes
Insulator vibrates, and reaches, by this vibrations of insulator, the effect taking out stains.By adjust hydraulic giant water outlet bore and
Go out water speed, form Karman vortex street and change frequency of vibration, to strengthen the water developing result of water flushing device people.
Beneficial effects of the present invention：
1) gained track can guarantee that in above-below direction straightway and towards the flush position between the arc section of shower nozzle side
Continuous with speed.The execution time that robot can be made minimizes, thus improving the flush efficiency of water flushing device people, makes robot
Actuator be easier follow the tracks of.
2) adopt photographic head and ultrasonic range finder, the current position of real-time monitoring, make robot be operated in safe distance,
Ensure to rinse the beginning and end accurate positioning of track, thus improving quality and the efficiency of flushing.
3) used the principle of Karman vortex street, flushing level can have been improved it is ensured that insulator under minimal motion
Dirt on string is cleared up to greatest extent.
Brief description
The flow chart that Fig. 1 water rinses control mode；
The schematic diagram of Fig. 2 water backwashing manner；
The track schematic diagram of Fig. 3 circular interpolation.
Specific embodiment：
The present invention is described in detail below in conjunction with the accompanying drawings：
As Figure 1-3, the water flush control method of the transformer station water flushing device people based on supersonic sounding, including following
Step：
Step one：Set up robot path planning's model；Ultrasonic range finder according to being arranged on flushing platform can obtain
Obtain the depth distance between robot and insulator, then image recognition is carried out to the picture being obtained by monitoring camera, thus can
Obtain the D coordinates value between robot and insulator, also can determine whether simultaneously between current robot and insulator relative away from
From it is ensured that with a distance from operation within safety range and judge robot location, determining the initial state of path planning；
Step 2：Realize the automatic punching of the above-below direction to insulator chain for the water flushing tool arm using linear interpolation mode
Wash；Realize shower nozzle using the circular interpolation mode of point-to-point comparison method the insulator chain towards robot side can be carried out clearly
Wash；
Step 3：When carrying out water flushing, by adjusting hydraulic giant water outlet bore and going out water speed, form Karman vortex street reality
The now flushing to position on rear side of insulator chain.
Judged between current robot and insulator according to the ultrasonic range finder rinsing on platform and monitoring camera
Relative distance it is ensured that operation distance and judges robot location within safety range, with determine path planning rise
Beginning state.
Before rinsing, by the constraint distance of spray gun and insulator chain when rinsing, the mode rinsed, system kinetics about
Bundle condition, including joint peak acceleration, maximal rate etc. imports to water flushing device people's path planning control system.
4 steps that Fig. 2 rinses for insulator：1. start to rinse upwards from insulator bottom, be flushed to four points of insulator
One of place, be flushed to bottom still further below；2. start to rinse upwards from insulator bottom, be flushed at insulator 1/2nd, then
It is flushed to downwards bottom；3. start to rinse upwards from insulator bottom, be flushed at insulator 3/4ths, be flushed to still further below
Bottom；4. start to rinse upwards from insulator bottom, be flushed to insulator top, be flushed to bottom still further below.Water flushing device
People realize Fig. 2 to insulator chain 1. -4. step above-below direction rinse when, start to collect initial time and end in flushing
The only joint angles of moment motion arm.For the easy motion of single joint, lopcus function at least meets four constraintss.Its
In two be the corresponding joint angles of starting point and ending point：
θ (0)=θ0
θ(tf)=θf
Seriality in order to meet joint motions speed requires, in addition also two constraints, i.e. starting point and termination
Point joint velocity require, in current situations, that is, start rinse when it is stipulated that：
θ ' (0)=0
θ'(tf)=0
The constraints on aforementioned four border uniquely determines a cubic polynomial：
θ (t)=a0+a1t+a2t2+a3t3
The joint velocity of movement locus and acceleration are：
θ ' (t)=a1+2a2t+3a3t2
θ " (t)=2a2+6a3t
Substitute into corresponding constraint equation, obtain relevant coefficient a0, a1, a2, a3, can obtain：
a0=θ0
a1=0
Thereby determine that the relation of time and angle, when a flush, car body is specifically certain with respect to insulator
, it is set to, the length l=d/sin θ of insulator chain can be obtained, bring formula θ (t)=a into0+a1t+a2t2+a3t3, can be rinsed
During relation over time：
To (l, d, θ0,θf) enter row interpolation, generate the flushing track of the above-below direction to insulator chain for the water flushing tool arm.
Joint velocity in path point can set as needed, thus, determines the method for cubic polynomial just and straight line
Identical described in interpolation, simply velocity restraint condition is changed into：
θ ' (0)=θ0'
θ'(tf)=θf'
Four equations determining cubic polynomial are：
θ0=a0
θf=a0+a1tf+a2tf 2+a3tf 3
θ0'=a1
θf'=a1+2a2tf+3a3tf 2
θ0,θf,θ′0,θ′fIt is respectively starting point and time parameter tfThe angle in moment and angular velocity, a0,a1,a2,a3For
Undetermined coefficient.Solving equation group, can get the coefficient of cubic polynomial：
a0=θ0
a1=θ0'
θ0,θf,θ′0,θ′fIt is respectively starting point and time parameter tfThe angle in moment and angular velocity, a0,a1,a2,a3For
Undetermined coefficient.
The cubic polynomial thereby determining that describes starting point and terminating point has the motion of any given position and speed
Track, remaining issues is how to determine the joint velocity in path point, in systems in order to ensure in each path point
Acceleration is continuous, and control system can automatically select the speed of path point as requested.Acceleration in order to ensure path point is continuous,
Can manage to be coupled together according to certain rule at path point with two cubic curves and scrabble up required track, its constraint
Condition is：Not only speed is continuous for junction, and acceleration is also continuous.
If the joint angles at paths traversed point are θv, adjacent with this point before and after 2 points of joint velocity be respectively
θ0And θg.From θ0To θvInterpolation cubic polynomial be：
θ (t)=a10+a11t+a12t2+a13t3
From θvTo θgInterpolation cubic polynomial be：
θ (t)=a20+a21t+a22t2+a23t3
The time interval of above-mentioned two cubic polynomial is respectivelyWithTo this two polynomial constraints
It is：
θ0=a10
θv=a10+a11tf1+a12tf1 2+a13tf1 3
θv=a20
θg=a20+a21tf2+a22tf2 2+a23tf2 3
0=a11
0=a21+2a22tf2+3a23tf2 2
a11+2a12tf1+3a13tf1 2=a21
2a21+6a13tf1=2a22
aij, i=1,2, j=0,1,2,3, it is undetermined coefficient, tf1,tf2For time parameter.
Constraints above condition constitutes 8 linear equation containing 8 unknown numbers, for tf1=tf2=tfSituation, this
Individual non trivial solution is：
a10=θ0
a11=0
a20=θv
aij, i=1,2, j=0,1,2,3, it is undetermined coefficient, tf,tf1,tf2For time parameter.
Thus we bring the coefficient obtaining into θ (t)=a10+a11t+a12t2+a13t3It is possible to obtain joint angles with
The relation of time change.
To (Xi,Yi,θ0,θf) enter row interpolation, generate water flushing device people is entered to the insulator chain towards robot side
The movement locus of row cleaning.
For guaranteeing that shower nozzle can be carried out to the insulator chain towards robot side, that is, in Fig. 2 1. -2., 2. -3.,
3.-middle transition process 4., using the circular interpolation mode of point-to-point comparison method.When carrying out circular interpolation, with the center of circle it is generally
Initial point, the coordinate figure according to circular arc Origin And Destination is carrying out interpolation.
If the circular arc starting point coordinate of circular interpolation is (X0,Y0), terminal point coordinate is (Xe,Ye), for any point on circular arc
(Xi,Yi), have：Xi 2+Yi 2=R2, make F=Xi 2+Yi 2-R2For departure function.As F ＞ 0, this point is outer in circle, moves to -X direction
One step；As F ＜ 0, this point, in circular arc, moves a step to +Y direction fortune；For making motion continue, F=0 is included into F ＞'s 0
Situation, moving interpolation moves along circular arc and to terminal all the time.The differentiation of circular interpolation calculates can be using following superposition computing：
If current point (Xi,Yi) corresponding departure function is
Fi=Xi 2+Yi 2-R2
After spray gun makes a move along -X direction
Fi+1=(Xi-1)2+Yi 2-R2=Fi-2Xi+1
After spray gun makes a move along +Y direction
Fi+1=Xi 2+(Yi+1)2-R2=Fi+2Yi+1
End point judging can be by n=| Xe-X0|+|Ye-Y0| differentiate, often making a move makes n=n+1, till n=0.
It is interpolation, the interpolation principle of suitable inverse circular arc of other quadrants and first quartile phase against circular arc for the first quartile above
Seemingly.
Path point is also regarded as " starting point " and " terminating point ", inverse kinematics is solved to these path point, obtain corresponding
Joint vector value, it is then determined that required cubic algebraic curves function, coupling together that path point smooths, but this
The joint motions speed of " starting point " and " terminating point " is no longer zero a bit.
When carrying out water flushing, adjusting water outlet speed, make Reynolds number meet 47<Re<105, form Karman vortex street.Frequency of vibration
It is directly proportional to fluid velocity, is inversely proportional to the frontal width of bluff body, adjust hydraulic giant water outlet bore, realize insulator chain is vibrated
The regulation of frequency, to produce good developing result.
By above step, there is provided a kind of water of transformer station water flushing device people rinses control mode, and the method can
Realizing the quality it is ensured that rinsing that is precisely controlled that water flushing device people rinses operation, reducing the potential safety hazard of livewire work, improve
Working performance.
Claims (9)
1. the water flush control method of the transformer station water flushing device people based on supersonic sounding, is characterized in that, including：
Step one：According to the image being arranged on the ultrasonic range finder and monitoring camera collection distance and monitoring rinsing on platform
Obtain the relative dimensional coordinate figure between current robot and insulator, judge whether both relative distances are safe distances, if
It is to carry out next step, if it is not, the position of platform is rinsed in adjustment, until this relative distance is safe distance；Determine path planning
Initial state；
Step 2：By controlling water flushing tool arm, auto-flushing is carried out to the above-below direction of insulator chain；By controlling shower nozzle
Realize shower nozzle the insulator chain towards robot side can be carried out；
Step 3：When carrying out water and rinsing, by adjusting hydraulic giant water outlet bore and go out water speed, formed Karman vortex street and realize right
The regulation of insulator chain frequency of vibration；
In described step 2, auto-flushing to the above-below direction of insulator chain, detailed process is：
(2-1) in flushing process, the angular displacement sensor being arranged in the rotary shaft of each joint collects initial time and end
Only each joint angles of moment motion arm；
(2-2) for the easy motion of single joint, lopcus function θ (t) meet the constraint condition, corresponding about according to constraints
Shu Fangcheng uniquely determines a cubic polynomial；
(2-3) joint velocity and the acceleration of movement locus are obtained according to this cubic polynomial, by the joint velocity of movement locus
Substitute into the coefficient that constraint equation obtains cubic polynomial with acceleration, this coefficient determines washing time and rinses the pass of angle
System；
(2-4) length according to insulator chain and cubic polynomial obtain the change in time of the length of insulator chain in flushing process
Change relation, to (l, d, θ0,θf) enter row interpolation, generate the flushing track of the above-below direction to insulator chain for the water flushing tool arm, l
For a characteristic length, d heads on width for bluff body, θ0,θfJoint angles for starting point and ending point.
2. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 1, it is special
Levying is, described constraints, and two of which is the corresponding joint angles of starting point and ending point：
θ (0)=θ0；
θ(tf)=θf.
3. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 2, it is special
Levying is, when the joint velocity in path point is not zero, in addition velocity restraint condition is changed into：
θ ' (0)=θ0'
θ'(tf)=θf'.
4. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 3, it is special
Levying is, by four equations that velocity restraint condition determines cubic polynomial is：
θ0=a0
θf=a0+a1tf+a2tf 2+a3tf 3
θ0'=a1
θf'=a1+2a2tf+3a3tf 2
θ0,θf,θ`0,θ`fIt is respectively starting point and time parameter tfThe angle in moment and angular velocity, a0,a1,a2,a3For undetermined
Coefficient.
5. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 1, it is special
Levying is, if the joint angles at paths traversed point are θv, adjacent with this point before and after 2 points of joint velocity be respectively θ0With
θg, from θ0To θvInterpolation cubic polynomial be：
θ (t)=a10+a11t+a12t2+a13t3
From θvTo θgInterpolation cubic polynomial be：
θ (t)=a20+a21t+a22t2+a23t3
The time interval of above-mentioned two cubic polynomial is respectivelyWithaij, i=1,2, j=0,1,2,3, be
Undetermined coefficient, tf1,tf2For time parameter.
6. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 1, it is special
Levying is, in described step 2, the insulator chain towards robot side is carried out, using the circular interpolation of point-to-point comparison method
Mode；When carrying out circular interpolation, with the center of circle as initial point, coordinate figure according to circular arc Origin And Destination is carrying out interpolation.
7. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 6, it is special
Levying is, the coordinate figure according to circular arc Origin And Destination is specially carrying out interpolation：If the circular arc starting point coordinate of circular interpolation is
(X0,Y0), terminal point coordinate is (Xe,Ye), for any point (X on circular arci,Yi), have：Xi 2+Yi 2=R2, make F=Xi 2+Yi 2-R2For
Departure function, as F ＞ 0, this point is outer in circle, moves a step to -X direction fortune；As F ＜ 0, this point in circular arc, to +Y direction
Fortune moves a step；For making motion continue, F=0 is included into the situation of F ＞ 0, moving interpolation is all the time along circular arc and to terminal fortune
Dynamic.
8. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 7, it is special
Levying is, differentiating of circular interpolation calculates using following superposition computing：
If current point (Xi,Yi) corresponding departure function is
Fi=Xi 2+Yi 2-R2
After spray gun makes a move along -X direction
Fi+1=(Xi-1)2+Yi 2-R2=Fi-2Xi+1
After spray gun makes a move along +Y direction
Fi+1=Xi 2+(Yi+1)2-R2=Fi+2Yi+1
End point judging can be by n=| Xe-X0|+|Ye-Y0| differentiate, often making a move makes n=n+1, till n=0；
To (Xi,Yi,θ0,θf) enter row interpolation, generate and water flushing device people is carried out clearly to the insulator chain towards robot side
The movement locus washed.
9. the water flush control method of the transformer station water flushing device people based on supersonic sounding as claimed in claim 1, it is special
Levying is, in described step 3, the condition that Karman vortex street is formed：Cylinder in a fluid, its Reynolds number meets 47<Re<105,
Reynolds number is used for characterizing flow of fluid situation, with ReRepresent, Re=ρ vl/ η, wherein v, ρ, η be respectively the flow velocity of fluid, density with
Viscosity coefficient, l is a characteristic length.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410459384.3A CN105013734B (en) | 2014-09-10 | 2014-09-10 | Washing control method for transformer substation washing robot based on ultrasonic distance measurement |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410459384.3A CN105013734B (en) | 2014-09-10 | 2014-09-10 | Washing control method for transformer substation washing robot based on ultrasonic distance measurement |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN105013734A CN105013734A (en) | 2015-11-04 |
| CN105013734B true CN105013734B (en) | 2017-02-15 |
Family
ID=54404239
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410459384.3A Active CN105013734B (en) | 2014-09-10 | 2014-09-10 | Washing control method for transformer substation washing robot based on ultrasonic distance measurement |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN105013734B (en) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107962589B (en) * | 2017-06-09 | 2020-07-28 | 国网山东省电力公司电力科学研究院 | Insulating protection system of electrified water washing robot of substation equipment based on multisensor fuses |
| CN108176152B (en) * | 2018-01-25 | 2021-11-05 | 武汉纺织大学 | Single-row double-spraying cleaning device for high-temperature-resistant filter bag |
| CN108159800B (en) * | 2018-01-25 | 2021-11-05 | 武汉纺织大学 | Double-row single-spraying cleaning device for high-temperature-resistant filter bag |
| CN109499959A (en) * | 2018-10-22 | 2019-03-22 | 广东电网有限责任公司 | A kind of Electrified water washing system |
| CN110794861A (en) * | 2019-11-14 | 2020-02-14 | 国网山东省电力公司电力科学研究院 | Autonomous string falling method and system for flying on-line and off-line insulator string detection robot |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0384925A1 (en) * | 1989-02-28 | 1990-09-05 | Siemens Aktiengesellschaft | Control method for a digital machine tool or a robot |
| CN201941656U (en) * | 2010-12-21 | 2011-08-24 | 徐州海伦哲专用车辆股份有限公司 | Distance measurement device for electrified water washing vehicle |
| CN102298391A (en) * | 2011-04-27 | 2011-12-28 | 哈尔滨工业大学 | Motion trail planning method for heavy-duty industrial robot in operating space |
| CN103147577A (en) * | 2013-02-27 | 2013-06-12 | 中联重科股份有限公司 | Control method, equipment, system and construction machinery for multi-joint mechanical arm support |
| CN103280062A (en) * | 2013-04-28 | 2013-09-04 | 广东电网公司佛山供电局 | Safe protection method and device for electrified water washing for power transmission line |
| CN103317507A (en) * | 2013-06-07 | 2013-09-25 | 浙江工业大学 | Chinese teaching method of manipulator motion controller |
| CN103770111A (en) * | 2012-10-24 | 2014-05-07 | 中国人民解放军第二炮兵工程大学 | Gait planning and synthetic method for humanoid robot |
| CN103970139A (en) * | 2014-05-09 | 2014-08-06 | 上海交通大学 | Robot continuous point position motion planning method and motion controller thereof |
-
2014
- 2014-09-10 CN CN201410459384.3A patent/CN105013734B/en active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0384925A1 (en) * | 1989-02-28 | 1990-09-05 | Siemens Aktiengesellschaft | Control method for a digital machine tool or a robot |
| CN201941656U (en) * | 2010-12-21 | 2011-08-24 | 徐州海伦哲专用车辆股份有限公司 | Distance measurement device for electrified water washing vehicle |
| CN102298391A (en) * | 2011-04-27 | 2011-12-28 | 哈尔滨工业大学 | Motion trail planning method for heavy-duty industrial robot in operating space |
| CN103770111A (en) * | 2012-10-24 | 2014-05-07 | 中国人民解放军第二炮兵工程大学 | Gait planning and synthetic method for humanoid robot |
| CN103147577A (en) * | 2013-02-27 | 2013-06-12 | 中联重科股份有限公司 | Control method, equipment, system and construction machinery for multi-joint mechanical arm support |
| CN103280062A (en) * | 2013-04-28 | 2013-09-04 | 广东电网公司佛山供电局 | Safe protection method and device for electrified water washing for power transmission line |
| CN103317507A (en) * | 2013-06-07 | 2013-09-25 | 浙江工业大学 | Chinese teaching method of manipulator motion controller |
| CN103970139A (en) * | 2014-05-09 | 2014-08-06 | 上海交通大学 | Robot continuous point position motion planning method and motion controller thereof |
Also Published As
| Publication number | Publication date |
|---|---|
| CN105013734A (en) | 2015-11-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105013734B (en) | Washing control method for transformer substation washing robot based on ultrasonic distance measurement | |
| CN204171001U (en) | Based on the transformer station water flushing device people of laser ranging | |
| CN105013735B (en) | The water flush control method of the transformer station water flushing device people based on laser ranging | |
| CN106054900B (en) | The interim barrier-avoiding method of robot based on depth camera | |
| CN105415372B (en) | Multi-joint robot track planning method under constraint of safety space | |
| CN110906934B (en) | Unmanned ship obstacle avoidance method and system based on collision risk coefficient | |
| CN204035106U (en) | Living water washing Fu Chong robot of transformer station | |
| CN107971266A (en) | A kind of substation equipment living water washing robot system and method based on double computer cooperation control | |
| CN106786938B (en) | Positioning method and automatic charging method for inspection robot | |
| CN107962589A (en) | A kind of substation equipment living water washing robot insulating protection system based on Multi-sensor Fusion | |
| CN115167465B (en) | Unmanned submersible vehicle three-dimensional path planning method based on artificial potential field grid method | |
| CN105013733A (en) | Transformer substation live washing auxiliary washing robot and method | |
| CN104765368A (en) | Unmanned ship heading and speed cooperative control method based on fuzzy adaptive algorithm | |
| CN107983570A (en) | A kind of steel member paint finishing based on 3D vision technology | |
| CN103984344A (en) | Wall-climbing robot path planning method for secondary side of nuclear power plant steam generator | |
| CN104090279A (en) | Excavation working face detection device based on laser radar | |
| CN112306076A (en) | Hybrid drive underwater robot dynamics model establishment method | |
| CN105005264B (en) | Transformer station's living water washing is auxiliary to rush robot water flush control method | |
| CN108805143A (en) | A kind of data characteristics extracting method based on slice point cloud | |
| CN204194341U (en) | Based on the transformer station water flushing device people of supersonic sounding | |
| CN116734856A (en) | Underwater robot path planning method considering ocean current influence | |
| CN109406096B (en) | Floating type offshore wind turbine generator measuring device and method thereof | |
| CN104007664A (en) | Nuclear power plant wall-climbing robot three-dimensional scene simulation motion method | |
| CN107962015A (en) | A kind of overall process auto-flushing substation equipment living water washing robot and method | |
| CN105643058B (en) | A kind of Double Wire Welding welding seam tracking method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CP03 | Change of name, title or address |
Address after: 100031 Xicheng District West Chang'an Avenue, No. 86, Beijing Co-patentee after: Electric Power Research Institute of State Grid Shandong Electric Power Company Patentee after: State Grid Corporation of China Co-patentee after: National Network Intelligent Technology Co., Ltd. Address before: Wang Yue Central Road Ji'nan City, Shandong province 250002 City No. 2000 Co-patentee before: Electric Power Research Institute of State Grid Shandong Electric Power Company Patentee before: State Grid Corporation of China Co-patentee before: Shandong Luneng Intelligent Technology Co., Ltd. |
|
| CP03 | Change of name, title or address | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20201028 Address after: 250101 Electric Power Intelligent Robot Production Project 101 in Jinan City, Shandong Province, South of Feiyue Avenue and East of No. 26 Road (ICT Industrial Park) Patentee after: National Network Intelligent Technology Co.,Ltd. Address before: 100031 Xicheng District West Chang'an Avenue, No. 86, Beijing Patentee before: STATE GRID CORPORATION OF CHINA Patentee before: ELECTRIC POWER RESEARCH INSTITUTE OF STATE GRID SHANDONG ELECTRIC POWER Co. Patentee before: National Network Intelligent Technology Co.,Ltd. |
|
| TR01 | Transfer of patent right |