CN104007664A - Nuclear power plant wall-climbing robot three-dimensional scene simulation motion method - Google Patents
Nuclear power plant wall-climbing robot three-dimensional scene simulation motion method Download PDFInfo
- Publication number
- CN104007664A CN104007664A CN201410214064.1A CN201410214064A CN104007664A CN 104007664 A CN104007664 A CN 104007664A CN 201410214064 A CN201410214064 A CN 201410214064A CN 104007664 A CN104007664 A CN 104007664A
- Authority
- CN
- China
- Prior art keywords
- climbing robot
- data
- nuclear power
- power station
- motor
- 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.)
- Granted
Links
Landscapes
- Manipulator (AREA)
Abstract
The invention discloses a nuclear power plant wall-climbing robot three-dimensional scene simulation motion method. A wall-climbing robot is adsorbed to the inner wall of a cylinder on the secondary side of a vapor generator of a nuclear power plant. The method includes the steps that firstly, three-dimensional models of the wall of the cylinder, tube boards, heat transfer tube bundles and the wall-climbing robot are established and a three-dimensional scene of the vapor generator is generated; secondly, position coordinates of the wall-climbing robot on the inner wall of the cylinder are established; thirdly, coordinates in the current position on the inner wall of the cylinder, the motion state and pose information of each joint of the wall-climbing robot are obtained in real time; fourthly, according to the coordinates in the current position, the motion state and the pose information of each joint of the wall-climbing robot, the position, the motion state and the pose of each joint of the wall-climbing robot are correspondingly adjusted. According to the method, the position, the motion state and the pose information of each joint of the wall-climbing robot are monitored in real time, accurate detection and control are facilitated, the control difficulty is reduced, and offline training of operators is achieved.
Description
Technical field
The present invention relates to a kind of climbing robot motion simulation, relate in particular to a kind of vision simulation skimulated motion method for the climbing robot of creeping on the cylinder inboard wall at nuclear power station steam generator secondary side.
Background technology
The regular safety inspection of nuclear power station is the important measures that ensure the normal operation of nuclear power station, along with improving constantly of scientific and technological level, robotization, intelligentized climbing robot can replace that testing staff enters danger, narrow space detects, testing staff can operate climbing robot by Remote, thereby the safety that has ensured operating personnel, has improved detection efficiency.
Used in nuclear power station steam generator is the connection hinge in nuclear power unit one, between secondary circuit, is also nuclear power unit one of maximum equipment that breaks down in service; Wherein, steam generator is taken in the heat agent that is cooled that nuclear reactor produces to, gets back to reactor and continue coolingly after steam generator cooling, and this is a loop; Supply water to steam generator, steam generator produces the work of Steam Actuation steam turbine, and cooling condensate water is got back to steam generator and continued to produce steam, and this closed circuit is called secondary circuit, a side loop that enters steam generator taking steam generator as boundary's cooling medium is exactly primary side of steam generator; A side loop that produces steam taking steam generator as boundary is exactly steam generator secondary side.Therefore steam generator is for the visual plant that carries out heat interchange that a circuit cools agent and secondary circuit are fed water in nuclear power station, the propulsion system that produce saturated vapour supply secondary circuit, if steam generator is unclean for a long time, tend to form certain thickness body refuse accumulation horizon, thereby cause the breakage of the various ways of heat-transfer pipe in accumulation horizon.Therefore, by steam generator climbing robot, tube sheet secondary side is carried out comprehensive and real-time cleanliness inspection, is very necessary to maintain the normal operation of steam generator, but steam generator climbing robot of the prior art is taking dolly as carrier, on the inner vertically wall of steam generator, cannot automatically locate when absorption and walking, self-navigation, also cannot make operating personnel understand the state of climbing robot in steam generator, can not detect efficiently, accurately and safeguard at steam generator internal implementation.
Summary of the invention
The object of this invention is to provide one can carry out position tracking automatically to climbing robot, accurately understands the nuclear power station climbing robot three-dimensional vision analogue simulation movement technique of the state of described climbing robot.
There is object on realizing, the invention discloses a kind of nuclear power station climbing robot three-dimensional vision analogue simulation movement technique, described climbing robot is adsorbed on the cylinder inboard wall of nuclear power station steam generator secondary side, and acceleration transducer is installed on it, distance measuring sensor, the motor encoder of gyroscope and driving mechanism, described nuclear power station climbing robot three-dimensional vision analogue simulation movement technique comprises: (1) sets up the bucket wall of the cylindrical shell of described nuclear power station steam generator secondary side, tube sheet, the three-dimensional model of heating surface bank, to generate the three-dimensional scenic of described steam generator, set up the model of described climbing robot, (2) set up the position coordinates of described climbing robot on described cylinder inboard wall, (3) obtain in real time coordinate, motion state and each joint position information of the current location of described climbing robot on described cylinder inboard wall, (4) in the three-dimensional scenic of described steam generator, show in real time described climbing robot according to the coordinate of described current location, according to the corresponding motion state of adjusting described climbing robot of described motion state information, according to the corresponding attitude of adjusting the each joint of described climbing robot of described each joint position information.Described nuclear power station steam generator secondary side is detected, while maintenance, operating personnel are without entering in the cylindrical shell of steam generator secondary side, can be by three-dimensional scenic indirectly, understand intuitively the actual conditions of described climbing robot in the cylindrical shell of described nuclear power station steam generator secondary side, and control described wall-climbing device human action according to inputting relevant order, in the time of described wall-climbing device human action, can show in real time by three-dimensional scenic the concrete situation of described climbing robot, the position of the described climbing robot of monitoring in real time, motion state and each joint position information, be convenient to detect accurately and manipulate, reduce manipulation difficulty, realize operating personnel's off-line training.
Preferably, described step (1) specifically comprises: the bucket wall model of setting up described cylindrical shell, set up the heating surface bank model of described tube sheet model, cylindrical shell, by described bucket wall model, tube sheet model and described heating surface bank model composition, generate the three-dimensional scenic of described steam generator.
Preferably, the method of obtaining the motion state of described climbing robot in described step (3) comprises: the data that record according to described acceleration transducer and gyroscope are calculated the motion state of described climbing robot, described motion state comprises the movement velocity of described climbing robot, and the angle theta of described climbing robot and horizontal direction.
Preferably, the method of obtaining each joint position information of described climbing robot in described step (3) comprises: calculate in described climbing robot each joint with respect to the relative position of the car body of described climbing robot, to obtain described each joint position information according to the data of each joint motor scrambler record in described climbing robot.
Preferably, video camera is also installed on described climbing robot, described step also comprises in (4): show in real time the video data that described camera obtains.Operating personnel understand the situation of the inner barrel of described steam generator secondary side in real time by video data, coordinate three-dimensional scenic to understand after position, running status and each joint attitude of described climbing robot, according to wall-climbing device human action described in the control of actual conditions input related command, control precisely, easy to detect.
Preferably, the method of setting up the position coordinates of described climbing robot on described cylinder inboard wall comprises: taking the center of circle, described cylindrical shell bottom surface as initial point, to be parallel to a certain X-axis that is oriented on described cylindrical shell bottom surface, with a certain Y-axis that is oriented perpendicular to described cylindrical shell bottom surface, set up coordinate system (x, the ω, h) of described climbing robot position, x equals described cylindrical shell radius, ω be described climbing robot to the angle between line and the described X-axis of initial point, h is the coordinate figure of described climbing robot in described Y-axis.This scheme makes the present invention only need calculate the height h of described climbing robot and can determine the three-dimensional position of described climbing robot with respect to the angle ω of X-axis, calculates quick and convenient.
Particularly, video camera is also installed on described climbing robot, the method that obtains in real time the current position coordinates of described climbing robot on described cylinder inboard wall comprises: according to described acceleration transducer, distance measuring sensor, gyroscope and motor encoder obtain the position detection signal of described climbing robot, obtain the video data of described climbing robot according to described video camera, calculate ω value and the h value of described current location according to described position detection signal and video data, thereby obtain the current position coordinates (x of described climbing robot, ω, h), result of calculation is accurate.
More specifically, the method that obtains in real time the current position coordinates of described climbing robot on described cylinder inboard wall specifically comprises: the data that (21) record according to acceleration transducer and gyroscope are calculated the angle theta of described climbing robot and horizontal direction, calculate the mileage of described climbing robot according to motor encoder information, calculate the ω value of described current location according to described angle theta and mileage, to obtain first group of data; (22) data that record according to described distance measuring sensor and θ value are calculated the h value of described current location, to obtain second group of data; (23) video data recording according to described video camera calculates the ω value of described current location, to obtain the 3rd group of data; (24) described first group of data, second group of data, the 3rd group of data are processed to obtain ω value and the h value of described current location, thereby (x, ω, h), the x value of the current location of described climbing robot equals the radius R of described cylindrical shell to obtain the current position coordinates of described climbing robot.On the one hand, the present invention measures angle theta jointly by acceleration transducer and gyroscope, has effectively reduced the error of angle theta; On the other hand, the ω value information (the first data) obtaining by motor encoder, acceleration transducer and gyroscope and the ω value information (the 3rd data) that obtains by video data are processed (comparison is merged) by the present invention, further dwindled the scope of ω value, the ω value calculating is more accurate.
The concrete steps of calculating described ω value in described step (21) are: the data that record according to acceleration transducer and gyroscope are calculated the angle theta of described climbing robot and horizontal direction, to obtain the angle value θ (t) of angle theta, calculate the speed V (t) of described climbing robot according to the data that detect of described the first motor encoder, according to formula
calculate the ω value of described current location.
Calculating described climbing robot in described step (21) with the step of horizontal direction angle theta is: calculate described climbing robot and horizontal direction angle theta according to described acceleration transducer, climbing robot and horizontal direction angle theta described in the Data correction that the described gyroscope of foundation records.Particularly, can calculate described climbing robot and horizontal direction angle theta according to described acceleration transducer, the data that record according to described gyroscope are calculated described climbing robot and horizontal direction angle theta, carry out fusion ratio pair by the angle theta calculating according to described acceleration transducer with according to the angle theta that described gyroscope calculates, obtain climbing robot and horizontal direction angle theta.The present invention both obtained relative θ value by motor encoder and acceleration transducer, obtain relative θ value by gyroscope again, the θ value that both can be obtained merge acquisition θ value (be equivalent to according to one θ value correction another θ value) more accurately, thereby makes the ω value that calculates more accurate.
The concrete steps of described step (22) comprising: obtain the range data T (t) that described distance measuring sensor detects, the h value of calculating described current location by formula h (t)=T (t) cos θ, calculates quick and convenient.
Described step (22) comprising: obtain the range data T (t) that described distance measuring sensor detects; According to formula
calculate critical angle α, l is the distance of the described cylinder inboard wall of described distance measuring sensor distance; According to formula
Calculate the h value of described current location.This scheme has effectively been proofreaied and correct interior barrel of impact that h value is brought of cylindrical shell of steam generator circle, makes result of calculation accurate.
The concrete steps of calculating described ω value in described step (23) are: obtain the video data that described video camera obtains, use edge detection algorithm and Hough transformation calculations to go out the inner barrel pipeline of steam generator secondary side with respect to the position of described climbing robot, contrast the inner barrel pipeline distribution drawing of described steam generator secondary side, the ω value that obtains described current location, result of calculation is accurate.
Described step (24) also comprises before: adopt Kalman filtering algorithm to process described first group of data, second group of data, the 3rd group of data.In this scheme, process described first group of data, second group of data, the 3rd group of data by Kalman filtering algorithm, effectively removed noise effect, make data after treatment more accurate, conveniently carry out subsequent calculations.
Described step (24) comprising: the estimation N of described first group of data fit Gaussian distribution
1(μ, σ
2), the estimation N of described second group of data fit Gaussian distribution
2(μ, σ
2), the estimation N of described the 3rd group of data fit Gaussian distribution
3(μ, σ
2), by formula N (μ, σ
2)=ω
1n
1* ω
2n
2* ω
3n
3be weighted and obtain estimation N (μ, σ that described climbing robot current location is distributed
2), ω
1, ω
2, ω
3for described N
1, N
2, N
3weight, with described N (μ, σ
2) peak value as the coordinate of the current location of described climbing robot (x, ω, h).This scheme is weighted described first group of data, second group of data, the 3rd group of data to obtain the estimation that described climbing robot current location is distributed, and makes the coordinate estimated value of climbing robot current location more accurate, extracts N (μ, σ
2) peak value make the coordinate of current location approach actual value most, result of calculation is accurate.
Preferably, described climbing robot comprises car body, driving mechanism, video camera and distance measuring sensor, and described car body is in flat and its acceleration transducer, gyroscope are installed; Described driving mechanism comprises permanent magnetic drive wheel and the first motor, described the first motor is and is arranged at hermetically in car body, the output shaft of described the first motor is connected with described permanent magnetic drive wheel, and described permanent magnetic drive wheel is positioned at the two bottom sides of described car body, and also protrudes out the bottom of described car body; Described video camera has light compensating lamp, and described video camera is in the left and right sides wall and front side wall that is embedded at hermetically described car body; Described distance measuring sensor is in the left and right sides wall that is embedded at hermetically described car body.Climbing robot of the present invention adsorbs and moves on inwall by permanent magnetic drive wheel, has realized along the wall of climbing of cylinder inboard wall and having moved, and makes its in-plant cylinder inboard wall that approaches of checkout equipment energy carrying, and guarantees to check the accuracy of effect; Separately, climbing robot of the present invention, by real-time car body environment record is around got off of shooting function, is convenient to staff and is understood in time the environment in cylindrical shell and make corresponding processing planning; Separately, the motor (comprising the first motor) of climbing robot of the present invention and video camera are all and are arranged at hermetically in car body, these equipment with electronic component can be effectively isolated from the outside, especially isolate with water, extend greatly the serviceable life of climbing robot of the present invention, and available water is directly cleaned, simple and practical.
Particularly, described climbing robot also comprises front end connector and the front end motor on the front side wall that is rotationally connected with described car body, described in described front end Electric Machine Control, front end connector rotates with respect to described car body, the front end of described front end connector has interface, and described climbing robot comprises with described interface and is and plugs the checkout equipment being connected.
More specifically, described checkout equipment comprises multiple degrees of freedom The Cloud Terrace testing agency, described multiple degrees of freedom The Cloud Terrace testing agency comprises support member, vertically pitch rotation part, horizontally rotate part, the second motor and the 3rd motor, one end of described support member has can plug the inserted terminal being connected in described interface, the other end of described support member is with described vertical pitch rotation part being connected of vertically rotating, described the second motor is and is installed on hermetically in described support member and controls described vertical pitch rotation part and vertically rotate, the described part that horizontally rotates is being connected of along continuous straight runs rotation with described vertical pitch rotation part, described the 3rd motor is to be installed on hermetically and in described vertical pitch rotation part and described in controlling, horizontally rotates part along continuous straight runs and rotate, on the described end that horizontally rotates part, be provided with described video camera.
More specifically, described checkout equipment comprises telescopic arm testing agency, described telescopic arm testing agency comprises supporter, telescopic arm, backrush structure and the 4th motor, described supporter there is the inserted terminal being connected in described interface that plugs protruding out, described telescopic arm is flaky texture, described supporter is hollow structure, described backrush structure and described the 4th motor are all and are installed on hermetically in described supporter, the initiating terminal of described telescopic arm is fixed and is wound in described backrush structure, described backrush structure is connected with described the 4th motor, nationality is realized the flexible of described telescopic arm by the rotation of backrush structure described in described the 4th Electric Machine Control, the end of described telescopic arm is provided with described video camera.
Particularly, described climbing robot also comprises rear end connector, described rear end connector shape triangular in shape and being pivotally connected on the rear wall of described car body.Be connected with rear end connector due to what the rear wall of described car body was also pivotable, effectively strengthen the flexibility of climbing robot of the present invention, ensure when mobile and the matching of inwall arc surface, and the cable that power supply and data transmission are provided can be connected on this rear end connector, can effectively prevent like this winding of cable.
Particularly, described climbing robot also comprises the universal angle sheave of permanent magnetism, and the bottom of the bottom of described car body and described rear end connector is provided with the universal angle sheave of described permanent magnetism.By the universal angle sheave of permanent magnetism, except increasing the adsorptive power of climbing robot of the present invention and cylindrical shell, while can also be effectively climbing robot of the present invention being changed to moving direction, lead and provide make a detour auxiliary.
Particularly, described climbing robot also comprises the cleaning plate that is elastic construction, the both sides of described car body are run through and are offered mounting hole, described permanent magnetic drive wheel is arranged in described mounting hole, described cleaning plate is arranged on the front of described car body and stretches in described mounting hole, and is flexible with described permanent magnetic drive wheel and contacts.Can remove timely dirt, bur and the body refuse etc. that stick on permanent magnetic drive wheel by cleaning plate, guarantee that permanent magnetic drive wheel has reliable and stable adsorptive power.More specifically, described in each mounting hole correspondence arrange two described in cleaning plate, described in corresponding with described mounting hole two, cleaning plate is symmetrical being obliquely installed.
Brief description of the drawings
Fig. 1 a is the process flow diagram of nuclear power station climbing robot three-dimensional vision analogue simulation movement technique of the present invention.
Fig. 1 b is the process flow diagram of setting up the position coordinates system of described climbing robot on described cylinder inboard wall.
Fig. 2 is the schematic diagram that the present invention sets up the position coordinates of described climbing robot on described cylinder inboard wall.
Fig. 3 is the process flow diagram that the present invention obtains the current location of described climbing robot on described cylinder inboard wall.
Fig. 4 is the structural representation of described steam generator.
Fig. 5 is the creep schematic diagram of climbing robot of the present invention on described cylinder inboard wall.
Fig. 6 is the bottom surface stereo schematic diagram of climbing robot of the present invention.
Fig. 7 is the front schematic perspective view of climbing robot of the present invention.
Fig. 8 is the connection diagram of climbing robot of the present invention and multiple degrees of freedom The Cloud Terrace testing agency.
Fig. 9 is the connection diagram of climbing robot of the present invention and telescopic arm testing agency.
Embodiment
By describing technology contents of the present invention, structural attitude in detail, being realized object and effect, below in conjunction with embodiment and coordinate accompanying drawing to be explained in detail.
A kind of climbing robot is disclosed in Fig. 6-Fig. 7, with reference to figure 4 to Fig. 5, described climbing robot 200 is adsorbed on cylindrical shell 10 inwalls of nuclear power station steam generator secondary side, and motor encoder is installed on it, acceleration transducer, distance measuring sensor and gyroscope, with reference to figure 1a, the invention discloses a kind of nuclear power station climbing robot three-dimensional vision analogue simulation movement technique 100, it comprises the following steps: the bucket wall of (S1) setting up the cylindrical shell of described nuclear power station steam generator secondary side, tube sheet, the three-dimensional model of heating surface bank, to generate the three-dimensional scenic of described steam generator, set up the model of described climbing robot, this step is specially: the bucket wall model of setting up described cylindrical shell, set up described cylindrical shell tube sheet model, set up the heating surface bank model of described cylindrical shell, by described bucket wall model, tube sheet model and described heating surface bank model composition, generate the three-dimensional scenic of described steam generator.(S2) set up the position coordinates of described climbing robot on described cylinder inboard wall; (S3) obtain in real time coordinate, motion state and each joint position information of the current location of described climbing robot on described cylinder inboard wall; (S4) in the three-dimensional scenic of described steam generator, show in real time described climbing robot according to the coordinate of described current location, according to the corresponding motion state of adjusting described climbing robot of described motion state information, according to the corresponding attitude of adjusting the each joint of described climbing robot of described each joint position information.Cylindrical shell 10 to described nuclear power station steam generator secondary side detects, while maintenance, operating personnel can understand the actual conditions of described climbing robot in the cylindrical shell of described nuclear power station steam generator secondary side intuitively by three-dimensional scenic, and control described climbing robot 200 and move according to inputting relevant order, in the time that described climbing robot 200 moves, can show in real time by three-dimensional scenic the concrete situation of described climbing robot 200, the position of the described climbing robot of monitoring in real time, motion state and each joint position information, be convenient to detect accurately and manipulate.
Preferably, the method of obtaining the motion state of described climbing robot in described step (S3) comprises: the data that record according to described acceleration transducer and gyroscope are calculated the motion state of described climbing robot, described motion state comprises the movement velocity of described climbing robot, and the angle theta of described climbing robot and horizontal direction.
Preferably, the method of obtaining each joint position information of described climbing robot in described step (S3) comprises: calculate in described climbing robot each joint with respect to the relative position of the car body of described climbing robot, to obtain described each joint position information according to the data of each joint motor scrambler record in described climbing robot.
Preferably, is also provided with video camera on described climbing robot, in described step (S4), also comprise: show in real time the video data that described camera obtains.Operating personnel understand the situation of the inner barrel of described steam generator secondary side in real time by video data, coordinate three-dimensional scenic to understand after position, running status and each joint attitude of described climbing robot, according to wall-climbing device human action described in the control of actual conditions input related command, control precisely, easy to detect.
With reference to figure 1b and Fig. 2, set up the position coordinates system of described climbing robot on described cylinder inboard wall, specifically comprise: (S11) taking the center of circle, described cylindrical shell bottom surface as initial point, (S12) to be parallel to a certain X-axis that is oriented on described cylindrical shell bottom surface, (S13) with a certain Y-axis that is oriented perpendicular to described cylindrical shell bottom surface, (S14) set up the coordinate system (x of described climbing robot position, ω, h), x equals described cylindrical shell radius R, ω is that described climbing robot is to the angle between line and the described X-axis of initial point, h is the coordinate figure of described climbing robot in described Y-axis.
Video camera is also installed on described climbing robot, the method that obtains in real time the current position coordinates of described climbing robot on described cylinder inboard wall comprises: the position detection signal that obtains described climbing robot according to described acceleration transducer, distance measuring sensor, gyroscope and motor encoder, obtain the video data of described climbing robot according to described video camera, calculate ω value and the h value of described current location according to described position detection signal and video data, thereby (x, ω, h), result of calculation is accurate to obtain the current position coordinates of described climbing robot.Describe the method that obtains described current position coordinates value in detail as an example of Fig. 3 example:
With reference to figure 3, the method that obtains described current location specifically comprises: the data that (S21) record according to acceleration transducer and gyroscope are calculated the angle theta of described climbing robot and horizontal direction, (S22) calculate the mileage of described climbing robot according to motor encoder information, (S23) the described angle theta of foundation and mileage are calculated the ω coordinate figure of described current location, to obtain first group of data; (S24) data that record according to described distance measuring sensor and θ value are calculated the h coordinate figure of described current location, and to obtain second group of data, preferably, also comprises the step of proofreading and correct the impact of steam generator circular cylinder body inwall on described h value.; (S25) video data recording according to described video camera calculates the ω coordinate figure of described current location, to obtain the 3rd group of data; (S26) described first group of data, second group of data, the 3rd group of data are processed to obtain ω coordinate figure and the h coordinate figure of described current location, thereby the current location (x (t), ω (t), h (t)) that obtains described climbing robot, the x coordinate figure x (t) of described current location equals the radius R of described cylindrical shell.This scheme makes climbing robot accurate positioning of the present invention, can detect efficiently, accurately and safeguard at steam generator internal implementation.The following specifically describes the method that obtains described current location:
The concrete steps of calculating described θ value in described step (S21) are: obtain the component g of described climbing robot in longitudinal and side direction according to described acceleration transducer
x(t), g
y(t), according to formula
calculate described acceleration transducer and calculate described climbing robot and horizontal direction angle theta, the data that record according to described gyroscope are calculated described climbing robot and horizontal direction angle theta; Carry out fusion ratio pair by the angle theta calculating according to described acceleration transducer with according to the angle theta that described gyroscope calculates, obtain the angle theta for subsequent calculations.
The concrete steps of the described ω value of described step (S22)-(S23) obtain are: reading this moment motor encoder reading is L (t), climbing robot 200 speed are V (t), consider climbing robot 200 car body inclination angle effects, can obtain climbing robot 200 is S (t)=∫ V (t) cos θ (t) dt along circular motion distance, and ω coordinate figure is
wherein R is steam generator radius, thereby has obtained the ω value estimation range of current location described in current time, i.e. first group of data, the estimation N of described first group of data fit Gaussian distribution
1(μ, σ
2).
In described step (S24), read distance measuring sensor reading T (t), consider the effect of car body inclination angle, the coordinate figure of the distance to the ground h of climbing robot 200 is: H (t)=T (t) cos θ (t), thereby the h value estimation range of current location described in acquisition current time, i.e. second group of data, the estimation N of described second group of data fit Gaussian distribution
2(μ, σ
2).
The concrete steps of calculating described ω value in described step (S25) are: obtain the video data that described video camera obtains, use edge detection algorithm and Hough transformation calculations to go out the inner barrel pipeline of steam generator secondary side with respect to the position of described climbing robot, contrast the inner barrel pipeline distribution drawing of described steam generator secondary side, obtain the coordinate figure value of described climbing robot current location ω, thereby obtain the ω value estimation range of current time current location, i.e. the 3rd group of data, the estimation N of described the 3rd group of data fit Gaussian distribution
1(μ, σ
2).
Described step (S26) also comprises before: adopt Kalman filtering algorithm to process described first group of data, second group of data, the 3rd group of data, for follow-up computing.
The estimation N of described first group of data fit Gaussian distribution
1(μ, σ
2), the estimation N of described second group of data fit Gaussian distribution
2(μ, σ
2), the estimation N of described the 3rd group of data fit Gaussian distribution
3(μ, σ
2), described step (26) specifically comprises: described first group of data, second group of data, the 3rd group of data are passed through to formula N (μ, σ
2)=ω
1n
1* ω
2n
2* ω
3n
3be weighted and obtain estimation N (μ, σ that described climbing robot current location is distributed
2), ω
1, ω
2, ω
3for described N
1, N
2, N
3weight (can be preset value), with N (μ, σ
2) peak value as the current location (x (t), ω (t), h (t)) of described climbing robot.
With reference to figure 6 and Fig. 7, described climbing robot 200 comprises car body 201, driving mechanism, video camera 21 and distance measuring sensor 22, and described car body 201 is flat and it is provided with acceleration transducer (not shown), gyroscope (not shown) sealedly, described driving mechanism comprises permanent magnetic drive wheel 23a, 23b and the first motor, described the first motor is and is arranged at hermetically in car body 201, the output shaft of described the first motor and described permanent magnetic drive wheel 23a, 23b connects, described permanent magnetic drive wheel 23a, 23b is positioned at the two bottom sides of described car body, and also protrude out the bottom of described car body 201, wherein permanent magnetic drive wheel 23a is positioned at the left-half of described car body 201 bottoms, permanent magnetic drive wheel 23b is positioned at the right half part of described car body 201 bottoms, and described permanent magnetic drive wheel 23a and permanent magnetic drive wheel 23b are staggeredly located, make the movement of described car body 201 more steady, described video camera 21 has light compensating lamp, and described video camera 21 is in the left and right sides wall and front side wall that is embedded at hermetically described car body, described distance measuring sensor 22 is installed on the left and right sides wall of described car body 201.Wherein, on the front side wall of described car body 201, be rotatably connected to front end connector 202, the front end of described front end connector 202 has with checkout equipment and is the interface 26 that is connected of plug, in wherein said car body, be also provided with and control the front end motor that rotates of described front end connector 202, front end connector 202 rotates with respect to described car body 201 described in described front end Electric Machine Control.On the rear wall of described car body 201, be pivotally connected to rear end connector 203, described rear end connector 203 shapes triangular in shape.Certainly, described rear end connector 203 also can be trapezoidal or have the block of arc-shaped side, for the flexibility that strengthens climbing robot 200 when ensureing motion and the matching of the arc surface of cylindrical shell 10 inwalls.
With reference to figure 6, described climbing robot 200 also comprises the universal angle sheave 25 of permanent magnetism, the bottom of the bottom of described car body 201 and described rear end connector 203 is provided with the universal angle sheave 25 of described permanent magnetism, except increasing the adsorptive power of climbing robot of the present invention 200 and cylindrical shell 10, can also effectively change moving direction to climbing robot 200 of the present invention time, lead and provide make a detour auxiliary.With reference to figure 7, described climbing robot 200 also comprises the cleaning plate 24a, the 24b that are elastic construction, the both sides of described car body 201 are run through and are offered mounting hole 28, described permanent magnetic drive wheel 23a, 23b are arranged in described mounting hole 28, described cleaning plate 24a, 24b are arranged on the front of described car body 201 and stretch in described mounting hole 28, and are flexibly and contact with described permanent magnetic drive wheel 23a, 23b respectively.Can remove timely dirt, bur and the body refuse etc. that stick on permanent magnetic drive wheel 23a, 23b by cleaning plate 24a, 24b, guarantee that permanent magnetic drive wheel 23a, 23b have reliable and stable adsorptive power.Particularly, described in each mounting hole 28 correspondences arrange two described in cleaning plate 23a, 23b, described in corresponding with described mounting hole 28 two, cleaning plate 23a, 23b are symmetrical being obliquely installed.Wherein, car body 201 of the present invention adopts based on entirety, is adapted to again continuously the seal ring structure 27 of car body profile, thereby guarantees the waterproof sealing of described car body 201, and the hydraulic giant can be used for after robot body 20 uses rinses decontamination.
With reference to figure 8, in one embodiment, described checkout equipment comprises multiple degrees of freedom The Cloud Terrace testing agency 70, described multiple degrees of freedom The Cloud Terrace testing agency 70 comprises support member 71, vertically pitch rotation part 72, horizontally rotate part 73, the second motor and the 3rd motor, one end of described support member 71 has can plug the inserted terminal being connected in described interface 26, the other end of described support member 71 is with described vertical pitch rotation part 72 being connected of vertically rotating, described the second motor is and is installed on hermetically in described support member 71 and controls described vertical pitch rotation part 72 and vertically rotate, the described part 73 that horizontally rotates is being connected of along continuous straight runs rotation with described vertical pitch rotation part 72, described the 3rd motor is to be installed on hermetically and in described vertical pitch rotation part 72 and described in controlling, horizontally rotates part 73 along continuous straight runs and rotate, on the described end that horizontally rotates part 73, be provided with described video camera 21.While obtaining each joint position information of described climbing robot in described step (3): can calculate the angle of described front end connector 202 with respect to described car body 201 according to the data of the motor encoder record of front end connector control motor, can calculate the angle of described vertical pitch rotation part 72 with respect to described front end connector 202 according to the data of the motor encoder record of the second motor, described in can calculating according to the data of the motor encoder record of the 3rd motor, horizontally rotate the angle of part 73 with respect to described vertical pitch rotation part 72, thereby determine each joint position information of described climbing robot 200.
Continue with reference to figure 8, one end of described support member 71 has can plug the inserted terminal being connected in described interface 26, multiple degrees of freedom The Cloud Terrace testing agency 70 nationalitys are inserted in the interface 100 corresponding with it by inserted terminal, multiple degrees of freedom The Cloud Terrace testing agency 70 is firmly fixed on front end connector 202, also make to realize and being electrically connected between the electronic component in multiple degrees of freedom The Cloud Terrace testing agency 70 and car body 201 simultaneously, the other end of described support member 71 is with described vertical pitch rotation part 72 being connected of vertically rotating, described the second motor is and is installed on hermetically in described support member 71 and controls described vertical pitch rotation part 72 and vertically rotate, the described part 73 that horizontally rotates is being connected of along continuous straight runs rotation with described vertical pitch rotation part 72, described the 3rd motor is to be installed on hermetically and in described vertical pitch rotation part 72 and described in controlling, horizontally rotates part 73 along continuous straight runs and rotate, described video camera 21 has light compensating lamp, described video camera 21 is described in being embedded at hermetically and horizontally rotates in part 73, when work, this multiple degrees of freedom The Cloud Terrace testing agency 70 is with car body 201 synchronizing movings, and this multiple degrees of freedom The Cloud Terrace testing agency is also according to concrete testing environment, drive vertical pitch rotation part 72 vertically to rotate and the 3rd motor drives and horizontally rotates part 73 along continuous straight runs and rotate to make by the second motor, horizontally rotate video camera 21 on part 73 in rational position and detect, the light compensating lamp that horizontally rotates the video camera 21 on part 73 can guarantee that the position that video camera 21 detects has enough brightness, thereby can high-level efficiency and accurately the cylinder inboard wall of nuclear power station steam generator secondary side is detected.Below continue climbing robot 200 of the present invention to be described in further detail:
As shown in Figure 8, described support member 71 is the bending structure away from the bottom of described car body 201, the rotation space that the support member 71 that is bending structure makes to be rotationally connected vertical pitch rotation part 72 is thereon larger, also make to be rotationally connected with the rotation space that horizontally rotates part 73 on vertical pitch rotation part 72 larger, and then the activity space that makes to horizontally rotate the video camera 21 of installing on part 73 is larger, the efficiency and the accuracy that detect are further improved.Particularly, described support member 71 comprises support portion 711 and kink 712, one end of described support portion 711 forms described inserted terminal, the other end of described support portion 711 extends to form described kink 712 towards the direction bending of the bottom away from described car body 201, described vertical pitch rotation part 72 is being connected on described kink 712 of vertically rotating, because kink 712 is towards the direction of the bottom away from described car body 201, make kink 712 with respect to the bottom of car body 201 for being upwards perk shape, while making work, between kink 712 and cylinder inboard wall, maintain a certain distance, effectively avoid kink 712 and cylinder inboard wall to bump, the vertical pitch rotation part 72 of further having guaranteed to be rotationally connected with on kink 712 has enough large rotation space, also the part 73 that horizontally rotates that makes to be rotationally connected with on vertical pitch rotation part 72 has enough large rotation space, the high accuracy and the high-level efficiency that use climbing robot 200 of the present invention to detect are guaranteed, more specifically, the free end of described vertical pitch rotation part 72 has recess 731, the described part 73 that horizontally rotates is arranged in described recess 731 and is being connected of along continuous straight runs rotation with described vertical pitch rotation part 72, by being arranged in the recess 731 of vertical pitch rotation part 72 horizontally rotating part 73, make to be located at the video camera 21 horizontally rotating on part 73 and be also arranged in recess 731, make in the time detecting, the video camera 21 horizontally rotating on part 73 can directly not contact with cylinder inboard wall, avoid video camera 21 and cylinder inboard wall to bump, also make to have remained certain distance between video camera 21 and cylinder inboard wall simultaneously, thereby for gathering cylinder inboard wall information, video camera 21 provides effective acquisition zone, and the region that the directive video camera 21 that recess 731 is concentrated the light compensating lamp emitted light of video camera 21 more detects, improve the brightness of video camera 21 surveyed areas, the validity and the accuracy that detect are guaranteed, if while thering is no distance (that is: video camera is affixed on cylinder inboard wall) between video camera 21 and cylindrical shell 10 inwalls, the camera lens of video camera 21 is blocked completely and cannot focuses, cannot effectively detect.
With reference to figure 9, in another embodiment, described checkout equipment comprises telescopic arm testing agency 80, described telescopic arm testing agency 80 comprises supporter 81, telescopic arm 82, backrush structure and the 4th motor, described supporter 84 there is the inserted terminal being connected in described interface that plugs protruding out, described telescopic arm 82 is flaky texture, described supporter 81 is hollow structure, described backrush structure and described the 4th motor are all and are installed on hermetically in described supporter 81, the initiating terminal of described telescopic arm 82 is fixed and is wound in described backrush structure, described backrush structure is connected with described the 4th motor, nationality is realized the flexible of described telescopic arm 82 by the rotation of backrush structure described in described the 4th Electric Machine Control, the end of described telescopic arm 82 is provided with described video camera 21.While obtaining each joint position information of described climbing robot in described step (3): can calculate the angle of described front end connector 202 with respect to described car body 201 according to the data of the motor encoder record of front end connector control motor, can calculate collapsing length and the angle of described telescopic arm 82 with respect to front end connector 202 according to the data of the motor encoder record of the 4th motor, thereby determine each joint position information of described climbing robot 200.
Work Shi Gai telescopic arm testing agency 80 is with car body 201 synchronizing movings, and this telescopic arm testing agency 80 is also according to concrete testing environment, drive backrush structure to rotate by the 4th motor, make to be wound in the structural telescopic arm 82 of backrush protruding (that is: reduce gradually telescopic arm and be wound in the structural length of backrush) or shrink (that is: increase gradually telescopic arm and be wound in the structural length of backrush), while clockwise rotating as the 4th motor, make backrush structure shrink telescopic arm 82, be that telescopic arm 82 shrinks, in the time that the 4th motor rotates counterclockwise, backrush structure discharges telescopic arm 82, be that telescopic arm 82 stretches out, antisense is as the same, because telescopic arm 82 can stretch, therefore the video camera 21 on telescopic arm 82 can be adjusted to rational position cylinder inboard wall is detected, the same flaky texture due to telescopic arm 82, telescopic arm 82 can be stretched between the tube bank of heat-transfer pipe smoothly, video camera 21 can directly be detected the region between tube bank, and video camera 21 also can shrink back smoothly between the tube bank of heat-transfer pipe, the light compensating lamp of video camera 21 can guarantee that the position that video camera 21 detects has enough brightness, thereby between energy high-level efficiency and the accurately cylinder inboard wall to nuclear power station steam generator secondary side and the tube bank of heat-transfer pipe, region is detected.Below continue in conjunction with Fig. 9, climbing robot of the present invention to be described in further detail:
As shown in Figure 9, described backrush structure comprises backrush wheel and flexible member, the output shaft of described the 4th motor is connected in the center of described backrush wheel, one end of described flexible member is connected with described backrush wheel, the other end of described flexible member is connected with described supporter 81, the rotation of described backrush wheel causes the elastic deformation of described flexible member, the rotation of backrush wheel will make telescopic arm 82 protruding (that is: reduce gradually telescopic arm and be wound in the length on backrush wheel) or shrink (that is: increase gradually telescopic arm and be wound in the length on backrush wheel), while turning clockwise as backrush wheel, telescopic arm 82 is shunk, when backrush wheel turns counterclockwise, make telescopic arm 82 stretch out (, backrush wheel discharges telescopic arm), antisense is as the same, the rotation of backrush wheel will make flexible member that flexible deformation occurs, thereby make flexible member produce restoring force, therefore when the 4th driven by motor backrush wheel rotates and telescopic arm 82 is yearned for gradually while stretching out, now flexible member produces and makes elastic restoring force that backrush wheel resets (, the restoring force that telescopic arm is shunk), in the time that telescopic arm 82 extend out to the length needing, just video camera 21 can be fed through to the rational position that needs detection, thereby the accuracy and the reliability that detect are guaranteed, while needing to shrink back telescopic arm 82 after detecting, take turns by allowing the 4th motor quit work or allowing the rotating force of the 4th motor be less than backrush the elastic restoring force having, now backrush wheel will rotate backward under the elastic restoring force effect at flexible member, thereby the telescopic arm stretching out 82 is shunk on backrush wheel, and then can carry out the accurate detection of the next position, the same flaky texture due to telescopic arm 82, telescopic arm 82 can be stretched between the tube bank of heat-transfer pipe smoothly, video camera 21 can directly be detected the region between tube bank, and video camera 21 also can shrink back smoothly between the tube bank of heat-transfer pipe.
As shown in Figure 9, described supporter 81 is the bending structure away from the bottom of described car body 201; The supporter 81 that is bending structure makes length of the present invention shorter, more being beneficial to car body 201 moves at cylinder inboard wall, strengthen mobile dirigibility and the mobile space of car body 201 at cylinder inboard wall, and then make the activity space of the video camera 21 of installing on telescopic arm 82 larger, further improve the efficiency and the accuracy that detect; Particularly, described supporter 81 comprises support portion 811 and kink 812, one end of described support portion 811 forms described inserted terminal 210, the other end of described support portion 811 extends to form described kink 812 towards the direction bending of the bottom away from described car body 201, described kink 812 is hollow structure, and described backrush structure and described the 4th motor are all installed in described kink 812; Because kink 812 is towards the direction of the bottom away from described car body 201, make kink 812 with respect to the bottom of car body 201 for being upwards perk shape, effectively avoid kink 812 and cylinder inboard wall to bump, further and strengthened mobile dirigibility and the mobile space of car body 201 at cylinder inboard wall, the high accuracy and the high-level efficiency that use the present invention to detect have been guaranteed.
In above-mentioned several embodiment; because motor and the video camera 21 of climbing robot 200 of the present invention are all setting hermetically; these equipment with electronic component can be effectively isolated from the outside; especially isolate with water; extend greatly the serviceable life of climbing robot 200 of the present invention; and available water is directly cleaned, simple and practical; It should be noted that the first motor of the present invention, the second motor, the 3rd motor and the 4th motor are common motor, its structure and principle of work, be well known to those of ordinary skill in the art, is no longer described in detail at this; And the first motor, the second motor, the 3rd motor and the 4th motor can be the motor of same model.
Above disclosed is only the preferred embodiments of the present invention, certainly can not limit with this interest field of the present invention, and the equivalent variations of therefore doing according to the present patent application the scope of the claims, still belongs to the scope that the present invention is contained.
Claims (20)
1. a nuclear power station climbing robot three-dimensional vision analogue simulation movement technique, it is characterized in that, described climbing robot is adsorbed on the cylinder inboard wall of nuclear power station steam generator secondary side, and the motor encoder of acceleration transducer, distance measuring sensor, gyroscope and driving mechanism is installed on it, and described nuclear power station climbing robot three-dimensional vision analogue simulation movement technique comprises:
(1) set up bucket wall, the tube sheet of the cylindrical shell of described nuclear power station steam generator secondary side, the three-dimensional model of heating surface bank, to generate the three-dimensional scenic of described steam generator, set up the model of described climbing robot;
(2) set up the position coordinates of described climbing robot on described cylinder inboard wall;
(3) obtain in real time coordinate, motion state and each joint position information of the current location of described climbing robot on described cylinder inboard wall;
(4) in the three-dimensional scenic of described steam generator, show in real time described climbing robot according to the coordinate of described current location, according to the corresponding motion state of adjusting described climbing robot of described motion state information, according to the corresponding attitude of adjusting the each joint of described climbing robot of described each joint position information.
2. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 1, it is characterized in that, the method of obtaining the motion state of described climbing robot in described step (3) comprises: the data that record according to described acceleration transducer and gyroscope are calculated the motion state of described climbing robot, described motion state comprises the movement velocity of described climbing robot, and the angle theta of described climbing robot and horizontal direction.
3. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 1, it is characterized in that, the method of obtaining each joint position information of described climbing robot in described step (3) comprises: calculate in described climbing robot each joint with respect to the relative position of the car body of described climbing robot, to obtain described each joint position information according to the data of each joint motor scrambler record in described climbing robot.
4. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 1, is characterized in that, video camera is also installed on described climbing robot, and described step also comprises in (4): show in real time the video data that described camera obtains.
5. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 1, it is characterized in that, the method of setting up the position coordinates of described climbing robot on described cylinder inboard wall comprises: taking the center of circle, described cylindrical shell bottom surface as initial point, to be parallel to a certain X-axis that is oriented on described cylindrical shell bottom surface, with a certain Y-axis that is oriented perpendicular to described cylindrical shell bottom surface, set up the coordinate system (x of described climbing robot position, ω, h), x equals described cylindrical shell radius, ω is that described climbing robot is to the angle between line and the described X-axis of initial point, h is the coordinate figure of described climbing robot in described Y-axis.
6. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 5, it is characterized in that, video camera is also installed on described climbing robot, the method that obtains in real time the current position coordinates of described climbing robot on described cylinder inboard wall comprises: according to described acceleration transducer, distance measuring sensor, gyroscope and motor encoder obtain the position detection signal of described climbing robot, obtain the video data of described climbing robot according to described video camera, calculate ω value and the h value of described current location according to described position detection signal and video data, thereby obtain the current position coordinates (x of described climbing robot, ω, h).
7. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 6, it is characterized in that, the method that obtains described current position coordinates specifically comprises: the data that (21) record according to acceleration transducer and gyroscope are calculated the angle theta of described climbing robot and horizontal direction, calculate the mileage of described climbing robot according to motor encoder information, calculate the ω value of described current location according to described angle theta and mileage, to obtain first group of data; (22) data that record according to described distance measuring sensor and θ value are calculated the h value of described current location, to obtain second group of data; (23) video data recording according to described video camera calculates the ω value of described current location, to obtain the 3rd group of data; (24) described first group of data, second group of data, the 3rd group of data are processed to obtain ω value and the h value of described current location, thereby obtain current position coordinates (x, the ω, h) of described climbing robot.
8. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 7, it is characterized in that, calculating described climbing robot in described step (21) with the step of horizontal direction angle theta is: calculate described climbing robot and horizontal direction angle theta according to described acceleration transducer, climbing robot and horizontal direction angle theta described in the Data correction that the described gyroscope of foundation records.
9. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 7, it is characterized in that, the concrete steps of calculating described ω value in described step (21) are: the data that record according to acceleration transducer and gyroscope are calculated the angle theta of described climbing robot and horizontal direction, to obtain the angle value θ (t) of angle theta, calculate the speed V (t) of described climbing robot according to the data that detect of described the first motor encoder, according to formula
calculate the ω value of described current location.
10. nuclear power station climbing robot three-dimensional vision analogue simulation movement technique as claimed in claim 7, it is characterized in that, the concrete steps of described step (22) comprising: obtain the range data T (t) that described distance measuring sensor detects, calculate the h value of described current location by formula h (t)=T (t) cos θ.
11. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 7, is characterized in that, described step (22) comprising:
Obtain the range data T (t) that described distance measuring sensor detects;
According to formula
calculate critical angle α, l is the distance of the described cylinder inboard wall of described distance measuring sensor distance; According to formula
Calculate the h value of described current location.
12. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 7, it is characterized in that, the concrete steps of calculating described ω value in described step (23) are: obtain the video data that described video camera obtains, use edge detection algorithm and Hough transformation calculations to go out the inner barrel pipeline of steam generator secondary side with respect to the position of described climbing robot, contrast the inner barrel pipeline distribution drawing of described steam generator secondary side, obtain the ω value of described current location.
13. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 7, it is characterized in that, described step (24) also comprises before: adopt Kalman filtering algorithm to process described first group of data, second group of data, the 3rd group of data.
14. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 7, is characterized in that, described step (24) comprising: the estimation N of described first group of data fit Gaussian distribution
1(μ, σ
2), the estimation N of described second group of data fit Gaussian distribution
2(μ, σ
2), the estimation N of described the 3rd group of data fit Gaussian distribution
3(μ, σ
2), by formula N (μ, σ
2)=ω
1n
1* ω
2n
2* ω
3n
3be weighted and obtain estimation N (μ, σ that described climbing robot current location is distributed
2), ω
1, ω
2, ω
3for described N
1, N
2, N
3weight, with described N (μ, σ
2) peak value as the coordinate of the current location of described climbing robot (x, ω, h).
15. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 1, is characterized in that, described climbing robot comprises:
Car body, described car body is in flat and its acceleration transducer, gyroscope is installed;
Driving mechanism, comprise permanent magnetic drive wheel and the first motor, described the first motor is and is arranged at hermetically in car body, and the output shaft of described the first motor is taken turns and is connected with described permanent magnetic drive, described permanent magnetic drive wheel is positioned at the two bottom sides of described car body, and also protrudes out the bottom of described car body; And
Video camera, described video camera has light compensating lamp, and described video camera is in the left and right sides wall and front side wall that is embedded at hermetically described car body;
Distance measuring sensor, is in the left and right sides wall that is embedded at hermetically described car body.
16. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 15, it is characterized in that, described climbing robot also comprises front end connector and the front end motor on the front side wall that is rotationally connected with described car body, described in described front end Electric Machine Control, front end connector rotates with respect to described car body, the front end of described front end connector has interface, and described climbing robot comprises with described interface and is and plugs the checkout equipment being connected.
17. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 16, it is characterized in that, described checkout equipment comprises multiple degrees of freedom The Cloud Terrace testing agency, described multiple degrees of freedom The Cloud Terrace testing agency comprises support member, vertically pitch rotation part, horizontally rotate part, the second motor and the 3rd motor, one end of described support member has can plug the inserted terminal being connected in described interface, the other end of described support member is with described vertical pitch rotation part being connected of vertically rotating, described the second motor is and is installed on hermetically in described support member and controls described vertical pitch rotation part and vertically rotate, the described part that horizontally rotates is being connected of along continuous straight runs rotation with described vertical pitch rotation part, described the 3rd motor is to be installed on hermetically and in described vertical pitch rotation part and described in controlling, horizontally rotates part along continuous straight runs and rotate, on the described end that horizontally rotates part, be provided with described video camera.
18. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 16, it is characterized in that, described checkout equipment comprises telescopic arm testing agency, described telescopic arm testing agency comprises supporter, telescopic arm, backrush structure and the 4th motor, described supporter there is the inserted terminal being connected in described interface that plugs protruding out, described telescopic arm is flaky texture, described supporter is hollow structure, described backrush structure and described the 4th motor are all and are installed on hermetically in described supporter, the initiating terminal of described telescopic arm is fixed and is wound in described backrush structure, described backrush structure is connected with described the 4th motor, nationality is realized the flexible of described telescopic arm by the rotation of backrush structure described in described the 4th Electric Machine Control, the end of described telescopic arm is provided with described video camera.
19. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 15, it is characterized in that, described climbing robot also comprises rear end connector, described rear end connector shape triangular in shape and being pivotally connected on the rear wall of described car body.
20. nuclear power station climbing robot three-dimensional vision analogue simulation movement techniques as claimed in claim 15, it is characterized in that, described climbing robot also comprises the universal angle sheave of permanent magnetism, and the bottom of the bottom of described car body and described rear end connector is provided with the universal angle sheave of described permanent magnetism.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410214064.1A CN104007664B (en) | 2014-05-20 | 2014-05-20 | A kind of nuclear power station climbing robot three dimensional visual simulation skimulated motion method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410214064.1A CN104007664B (en) | 2014-05-20 | 2014-05-20 | A kind of nuclear power station climbing robot three dimensional visual simulation skimulated motion method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104007664A true CN104007664A (en) | 2014-08-27 |
| CN104007664B CN104007664B (en) | 2017-08-29 |
Family
ID=51368374
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410214064.1A Active CN104007664B (en) | 2014-05-20 | 2014-05-20 | A kind of nuclear power station climbing robot three dimensional visual simulation skimulated motion method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104007664B (en) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105182792A (en) * | 2015-08-10 | 2015-12-23 | 西南科技大学 | Robot working simulation system under nuclear radiation environment and method thereof |
| CN106094575A (en) * | 2016-08-26 | 2016-11-09 | 中南大学 | A kind of robotic conveyance's virtual visualization control method and system |
| CN107908841A (en) * | 2017-11-03 | 2018-04-13 | 南京邮电大学 | Three-dimensional wall can crawl position distinguished number |
| CN109732593A (en) * | 2018-12-28 | 2019-05-10 | 深圳市越疆科技有限公司 | A kind of far-end control method of robot, device and terminal device |
| CN111341168A (en) * | 2020-02-28 | 2020-06-26 | 西安交通大学 | Collaborative loading training teaching system and method |
| CN114545789A (en) * | 2020-11-24 | 2022-05-27 | 国核电站运行服务技术有限公司 | Simulation system of steam generator heat transfer tube detection robot |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2586565Y (en) * | 2002-11-12 | 2003-11-19 | 上海大学 | Retractable flexible arm equipment |
| CN102672704A (en) * | 2012-06-07 | 2012-09-19 | 中国东方电气集团有限公司 | Differential motion driving magnetic adsorption type multifunctional wall climbing robot with small-folding-size mechanical arms |
| KR20120118723A (en) * | 2011-04-19 | 2012-10-29 | 주식회사 신호시스템 | Simulation method of climbing hydraulic robot and construction factory |
| CN103111837A (en) * | 2013-01-23 | 2013-05-22 | 北京理工大学 | Vapor generator primary side baffle operation robot |
| CN103486402A (en) * | 2013-09-18 | 2014-01-01 | 国核电站运行服务技术有限公司 | Mechanical foot of heat transmission pipe detecting robot for vapor generators |
| CN103586870A (en) * | 2013-11-05 | 2014-02-19 | 中国科学院深圳先进技术研究院 | Steam generator wall-climbing robot |
-
2014
- 2014-05-20 CN CN201410214064.1A patent/CN104007664B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2586565Y (en) * | 2002-11-12 | 2003-11-19 | 上海大学 | Retractable flexible arm equipment |
| KR20120118723A (en) * | 2011-04-19 | 2012-10-29 | 주식회사 신호시스템 | Simulation method of climbing hydraulic robot and construction factory |
| CN102672704A (en) * | 2012-06-07 | 2012-09-19 | 中国东方电气集团有限公司 | Differential motion driving magnetic adsorption type multifunctional wall climbing robot with small-folding-size mechanical arms |
| CN103111837A (en) * | 2013-01-23 | 2013-05-22 | 北京理工大学 | Vapor generator primary side baffle operation robot |
| CN103486402A (en) * | 2013-09-18 | 2014-01-01 | 国核电站运行服务技术有限公司 | Mechanical foot of heat transmission pipe detecting robot for vapor generators |
| CN103586870A (en) * | 2013-11-05 | 2014-02-19 | 中国科学院深圳先进技术研究院 | Steam generator wall-climbing robot |
Non-Patent Citations (4)
| Title |
|---|
| 刘青松 等: ""A novel nuclear station inspection robot"", 《IEEE INTERNATIONAL CONFERENCE ON INFORMATION SCIENCE AND TECHNOLOGY (ICIST)》 * |
| 李恒: ""爬壁机器人动力特性研究及仿真分析"", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
| 纪莲清，等: "《全国普通高等学校机械类"十二五"规划系列教材 机械原理》", 31 August 2013 * |
| 马培荪 等: ""油罐容积检测爬壁机器人的动态路径规划"", 《上海交通大学学报》 * |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105182792A (en) * | 2015-08-10 | 2015-12-23 | 西南科技大学 | Robot working simulation system under nuclear radiation environment and method thereof |
| CN105182792B (en) * | 2015-08-10 | 2017-10-03 | 西南科技大学 | Robot manipulating task analogue system and method under a kind of nuclear radiation environment |
| CN106094575A (en) * | 2016-08-26 | 2016-11-09 | 中南大学 | A kind of robotic conveyance's virtual visualization control method and system |
| CN106094575B (en) * | 2016-08-26 | 2017-05-17 | 中南大学 | Virtual visual control method and virtual visual control system for robot transportation |
| CN107908841A (en) * | 2017-11-03 | 2018-04-13 | 南京邮电大学 | Three-dimensional wall can crawl position distinguished number |
| CN107908841B (en) * | 2017-11-03 | 2020-10-20 | 南京邮电大学 | Three-dimensional wall surface graspable position discrimination algorithm |
| CN109732593A (en) * | 2018-12-28 | 2019-05-10 | 深圳市越疆科技有限公司 | A kind of far-end control method of robot, device and terminal device |
| CN111341168A (en) * | 2020-02-28 | 2020-06-26 | 西安交通大学 | Collaborative loading training teaching system and method |
| CN114545789A (en) * | 2020-11-24 | 2022-05-27 | 国核电站运行服务技术有限公司 | Simulation system of steam generator heat transfer tube detection robot |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104007664B (en) | 2017-08-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104078088A (en) | Nuclear power station climbing robot system and method for detecting secondary side of steam generator | |
| CN104007664A (en) | Nuclear power plant wall-climbing robot three-dimensional scene simulation motion method | |
| CN105652872B (en) | The automatic method for tracking and positioning of substation's laser navigation crusing robot intelligent console | |
| CN108423141B (en) | Underwater operation robot and control method thereof | |
| CN109066861A (en) | Intelligent inspection robot charging controller method based on machine vision | |
| CN103984344B (en) | For the climbing robot paths planning method of nuclear power station steam generator secondary side | |
| CN105563450B (en) | A kind of ship facade operation Multifunctional creeping robot | |
| CN104750115B (en) | A kind of laser active type navigation system of mobile device and air navigation aid | |
| CN112728293A (en) | Intelligent pipeline detection robot and control method thereof | |
| CN105728904A (en) | System and method for tracking weaving arc space weld based on MEMS (micro-electromechanical systems) sensor | |
| CN111360818A (en) | Mechanical arm control system through visual positioning | |
| CN103586870B (en) | Steam generator climbing robot | |
| CN103762522A (en) | Line searching device and self line searching control method of high-voltage circuit patrol robot | |
| CN111036863A (en) | Device for positioning ladle drainage port by adopting machine vision and using method thereof | |
| CN103962352B (en) | Tube cleaning arrangement and automatically-adaptive control method thereof | |
| CN112212122B (en) | Soft micro robot for pipeline detection and cleaning | |
| CN107584501A (en) | A kind of substation equipment electrification cleaner device people and its control method | |
| CN109202852A (en) | A kind of intelligent inspection robot | |
| Zheng et al. | A design of endoscopic imaging system for hyper long pipeline based on wheeled pipe robot | |
| CN107962589A (en) | A kind of substation equipment living water washing robot insulating protection system based on Multi-sensor Fusion | |
| CN108648234A (en) | A kind of mechanical arm Relative Navigation arrested for target | |
| CN103984345A (en) | Wall-climbing robot position trailing method for secondary side of nuclear power plant steam generator | |
| CN107962015A (en) | A kind of overall process auto-flushing substation equipment living water washing robot and method | |
| Galassi et al. | DORIS—A mobile robot for inspection and monitoring of offshore facilities | |
| CN110977926B (en) | Partial discharge positioning method, system and medium for cable tunnel inspection robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| CB02 | Change of applicant information |
Address after: 518000 Guangdong province Futian District Shangbu Road West of the city of Shenzhen Shenzhen science and technology building 15 layer (1502-1504, 1506) Applicant after: CHINA NUCLEAR POWER TECHNOLOGY RESEARCH INSTITUTE Applicant after: Shenzhen Institutes of Advanced Technology, Chinese Academy of Science Applicant after: China General Nuclear Power Corporation Address before: 518000 Guangdong province Futian District Shangbu Road West of the city of Shenzhen Shenzhen science and technology building 15 layer (1502-1504, 1506) Applicant before: Zhongkehua Nuclear Power Technology Institute Co., Ltd. Applicant before: Shenzhen Institutes of Advanced Technology, Chinese Academy of Science Applicant before: China General Nuclear Power Corporation |
|
| CB02 | Change of applicant information | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |