Summary of the invention
Multichannel micro-vision system operating space is little can only measure the shortcoming of two-dimensional position coordinate usually with monocular vision in order to solve, and the object of the present invention is to provide the lower microtubule of a kind of monocular micro-vision guiding to insert control device and the method for micropore.
For achieving the above object, according to an aspect of the present invention, the control device that the lower microtubule of a kind of monocular micro-vision guiding inserts micropore is proposed, this device comprises: vibration-isolating platform 1, micro-vision system 7, translate stage 8, microtubule 6, operator 2, clamper 5, attitude adjustment platform 3, position adjust platform 9, with the part of micropore 4, wherein:
Described micro-vision system 7 is installed on described translate stage 8, and described micro-vision system 7 points to described microtubule 6 and micropores 4;
Described translate stage 8 is arranged on described position and adjusts on platform 9;
Described clamper 5 is arranged on the end of described operator 2;
Described microtubule 6 is installed on the end of described clamper 5, along with operator 2 moves together;
Platform 9 is adjusted in described position, operator 2 is arranged on described vibration-isolating platform 1;
Described attitude adjustment platform 3 is used for placing the part with micropore 4, and described operator 2 and described micro-vision system 7 are positioned at the both sides of described attitude adjustment platform 3.
According to a further aspect in the invention, propose the control method that the lower microtubule of a kind of monocular micro-vision guiding inserts micropore, the method comprises the following steps:
Step S1: adjust platform 9 and drive 7 motions of micro-vision system by adjusting the position, change the position of micro-vision system 7, make the micropore 4 can be in the visual field of micro-vision system 7;
Step S2: adjustment operation device 2 drives the visual field that microtubules 6 enter micro-vision system 7, and the coordinate of adjusting operation device 2 makes micro-vision system 7 can collect the image of microtubule 6 ends;
Step S3: determine the image-region of micropore 4 and the image-region of microtubule 6 by image segmentation, then according to autofocus evaluation function, drive micro-vision system 7 and seesaw to realize focusing to micropore 4 along its optical axis by controlling translate stage 8, afterwards, fixedly the position of micro-vision system 7 is no longer adjusted, and adjustment operation device 2 drives microtubules 6 and seesaws along the micro-vision systematic optical axis and realize the focusing of microtubule 6 ends;
Step S4: micropore 4 is carried out the extraction of image characteristic point;
Step S5: microtubule 6 is carried out the extraction of image characteristic point;
Step S6: calculate the image characteristic point of microtubule 6 to the image distance of the image characteristic point of micropore 4, according to the demarcation information calculating three dimensions relative position both of micro-vision system 7, and the end of microtubule 6 is registered to the top of micropore 4;
Step S7: again the end of microtubule 6 carried out automatic focus and reorientate, equally according to the demarcation information of micro-vision system 7, determining three dimensions relative position both, control operation device 2 inserts micropores 4 with microtubule 6.
Characteristics of the present invention are to control microtubule at x under the guiding of monocular micro-vision, y, and the z axle is aimed at micropore simultaneously, thereby has greatly simplified assembling process.
The specific embodiment
For making the purpose, technical solutions and advantages of the present invention clearer, below in conjunction with specific embodiment, and with reference to accompanying drawing, the present invention is described in more detail.
Fig. 1 is the control device structural representation that the lower microtubule of monocular micro-vision guiding of the present invention inserts micropore, as shown in Figure 1, the control device that the lower microtubule of described monocular micro-vision guiding inserts micropore comprises: vibration-isolating platform 1, micro-vision system 7, translate stage 8, microtubule 6, operator 2, clamper 5, attitude adjustment platform 3, position adjust platform 9, with the part of micropore 4, wherein:
Described micro-vision system 7 is installed on described translate stage 8, and described micro-vision system 7 points to described microtubule 6 and micropores 4;
Described translate stage 8 is arranged on described position and adjusts on platform 9, and in an embodiment of the present invention, the upper surface that platform 9 is adjusted in described position tilts, so that have the inclination angle between the plane of described micro-vision system 7 and described vibration-isolating platform 1;
Described clamper 5 is arranged on the end of described operator 2;
Described microtubule 6 is installed on the end of described clamper 5, along with operator 2 moves together;
Platform 9 is adjusted in described position, operator 2 is arranged on described vibration-isolating platform 1;
Described attitude adjustment platform 3 is used for placing the part with micropore 4, and described operator 2 and described micro-vision system 7 are positioned at the both sides of described attitude adjustment platform 3;
Described device also comprises computer 10, is used for controlling the motion of described translate stage 8 and described operator 2, and described micro-vision system 7 is connected to computer 10 by vision connecting line 11; Described translate stage 8 is connected to computer 10 by control connection line 12; Described operator 2 is connected to computer 10 by control line 13.
During described device work, adjust platform 9 by the position and drive 7 motions of micro-vision system, change the position of micro-vision system 7, make the image of micropore 4 appear in the visual field of micro-vision system 7.Along with the motion of operator 2, operator 2 drives the visual field that microtubules 6 enter micro-vision system 7.The image that contains simultaneously micropore 4 and microtubule 6 is carried out image segmentation determine both zone, and it is carried out automatic focus and accurate location separately.According to the feature extraction of microtubule 6 and micropore 4 (in an embodiment of the present invention, described feature refers to the central point of microtubule 6 ends and the central point of micropore 4) and the demarcation information of micro-vision system, according to PI (PI, proportional-integral, ratio-integration) control strategy control operation device 2 drives microtubules 6 and moves on the blur-free imaging plane, is registered to the top of micropore 4.Again the end of microtubule 6 focused on and locate, calculate the three-dimensional relative distance of itself and micropore 4, the control operation device 2 drives microtubules 6 and inserts micropores 4.
In an embodiment of the present invention, described operator 2 adopts motion platform, has three translation freedoms, can vertically laterally, vertically carry out translational motion with horizontal plane respectively; Described translate stage 8 adopts the single shaft motion platform, can move along the axis direction of described translate stage 8; Micro-vision system 7 is made of PointGrey video camera and Navitar camera lens; Computer 10 adopts Dell Inspiron545S; Microtubule 6 forms for the hollow glass cylinder stretches, and the end outside diameter is 10 μ m.
Fig. 2 is the control method flow chart that the lower microtubule of monocular micro-vision guiding of the present invention inserts micropore, and as shown in Figure 2, the method comprises the following steps:
Step S1: adjust platform 9 and drive 7 motions of micro-vision system by adjusting the position, change the position of micro-vision system 7, make the micropore 4 can be in the visual field of micro-vision system 7;
Step S2: adjustment operation device 2 drives the visual field that microtubules 6 enter micro-vision system 7, and the coordinate of adjusting operation device 2 makes micro-vision system 7 can collect the image of microtubule 6 ends;
Step S3: determine the image-region of micropore 4 and the image-region of microtubule 6 by image segmentation, then according to certain autofocus evaluation function (in an embodiment of the present invention, described autofocus evaluation function is the quadratic sum accumulated value of pixel sobel value), drive micro-vision system 7 and seesaw to realize focusing to micropore 4 along its optical axis by controlling translate stage 8, afterwards, fixedly the position of micro-vision system 7 is no longer adjusted, and adjustment operation device 2 drives microtubules 6 and seesaws along the micro-vision systematic optical axis and realize the focusing of microtubule 6 ends;
Step S4: micropore 4 is carried out the extraction of image characteristic point;
The extraction of in this step, micropore 4 being carried out image characteristic point comprises the following steps:
Step S41: to ROI (the region of interest of micropore 4, area-of-interest) carry out binary conversion treatment, in an embodiment of the present invention, adopt OTSU (large Tianjin method, a kind of automatic threshold binarization method of Japanese's name) to carry out described binary conversion treatment;
Step S42: scanning obtains marginal point;
Step S43: described marginal point is carried out ellipse fitting ask its center as the image characteristic point of micropore 4;
Step S5: microtubule 6 is carried out the extraction of image characteristic point;
The extraction of in this step, microtubule 6 being carried out image characteristic point comprises the following steps:
Step S51: the ROI to microtubule 6 carries out binary conversion treatment;
Described binary conversion treatment can be expressed as:
Wherein, g (i, j) is the image pixel gray value, ghBe background gray levels, be the corresponding gray scale of grey level histogram maximum of the ROI of microtubule 6, gtBe selected threshold value, be used for distinguishing image and the background image of microtubule 6;
Step S52: scanning obtains the left and right edges point;
Step S53: described left and right edges point is carried out respectively fitting a straight line (in an embodiment of the present invention, utilize RANSAC (Random Sample Concensus, the random sampling consistency algorithm) carry out fitting a straight line), the lower limb intersection point of the angular bisector of the both sides straight line that obtains and the ROI of microtubule 6 is taken as the end central point of microtubule 6 as the image characteristic point of microtubule 6;
Step S6: the image characteristic point that calculates microtubule 6, be that microtubule 6 end central points are to the image characteristic point of micropore 4, be that (described image distance refers to pixel increment for the image distance at micropore 4 centers, namely, the number of pixels at interval), calculate both three dimensions relative shift according to the demarcation information of micro-vision system 7, and the end that uses the PI control strategy to move microtubule 6 based on described relative shift makes it be registered to the top of micropore 4;
The end that described use PI control strategy moves microtubule 6 makes the step of its top that is registered to micropore 4 further comprising the steps:
Step S61: utilize following formula to calculate the image characteristic point (being microtubule 6 end central points) of microtubule 6 and the initial relative shift of image characteristic point (being micropore 4 central points) on three dimensions of micropore 4:
Wherein, (Δ x
m, Δ y
m, Δ z
m) be microtubule 6 end central points and the relative shift of micropore 4 central points on three dimensions, (Δ u, Δ v) is the increment of coordinate (being image distance) of the picture rich in detail of microtubule 6 end central points and micropore 4 central points, n
x, n
y, n
zAnd o
x, o
y, o
zIt is the spin matrix of the micro-vision system of demarcating
Element, be given value, k
x, k
yBeing the image coordinate of demarcation and the proportionality coefficient of micro-vision system coordinates, is also given value.
Step S62: mobile microtubule 6 one initial step lengths, and then utilize following formula to calculate microtubule 6 end central points and the current relative shift of micropore 4 central points on three dimensions;
Described initial step length can rule of thumb come to determine.
Step S63: calculate the step-length that next step moves according to the first two steps relative shift that obtains;
In this step, utilize following formula to calculate the step-length that next step moves:
Wherein, Kp, KiProportionality coefficient and integral coefficient for the PI control strategy are given value, Δ xt(n), Δ yt(n), Δ zt(n) be respectively microtubule 6 n and go on foot step-length mobile on x, y, z axle, Δ xm(n), Δ ym(n), Δ zm(n) be respectively microtubule 6 end central points and the micropore 4 central point n relative shifts of step on x, y, z axle, Δ xm(n-1), Δ ym(n-1), Δ zm(n-1) be respectively microtubule 6 end central points and the micropore 4 central point n-1 relative shifts of step on x, y, z axle.
Step S64: move microtubule 6 according to the step-length that calculates;
Step S65: repeating said steps S63 and step S64 are until the end of microtubule 6 is registered to the top of micropore 4.
Step S7: again the end of microtubule 6 carried out automatic focus and reorientated, similar to described step 6, according to the demarcation information of micro-vision system 7, determine three dimensions relative shift both, based on described relative shift control operation device 2, microtubule 6 is inserted in micropores 4.
In practical operation, at first, adjust the visual field and the microtubule position of micro-vision system 1 according to step S1 and S2; Then, according to step S3, microtubule and micropore are carried out automatic focus, make the blur-free imaging plane that both is in simultaneously the micro-vision system; Then step S4 and S5 have realized the extraction to both image characteristic point; Control microtubule by visual servo in step S6 and be registered to micropore top; Step S7 focuses on and the location microtubule again, eliminates error, and then open loop is controlled it and inserted micropore.In an embodiment of the present invention, step S6 has carried out 7 step servo motions, and the microtubule image coordinate in the visual servo motion of acquisition and the operator coordinate of whole insertion process are as follows:
Wherein, microtubule and micropore aim at and the track of insertion process as shown in Figure 2, the image of whole process is as shown in Figure 3.
Control device and method that microtubule under a kind of monocular vision guiding that the present invention proposes inserts micropore have realized the three-dimensional little assembling process under the guiding of monocular micro-vision.Microtubule under a kind of monocular vision guiding of the present invention inserts control device and the method for micropore, and movement locus is simple, and it is convenient to use, and can realize adaptability and the availability of the lower three-dimensional microoperation of monocular micro-vision guiding.
Above-described specific embodiment; purpose of the present invention, technical scheme and beneficial effect are further described; institute is understood that; the above is only specific embodiments of the invention; be not limited to the present invention; within the spirit and principles in the present invention all, any modification of making, be equal to replacement, improvement etc., within all should being included in protection scope of the present invention.