CN115493499A - Method and system for assembling cylinder or cylinder-like body - Google Patents
Method and system for assembling cylinder or cylinder-like body Download PDFInfo
- Publication number
- CN115493499A CN115493499A CN202211080351.9A CN202211080351A CN115493499A CN 115493499 A CN115493499 A CN 115493499A CN 202211080351 A CN202211080351 A CN 202211080351A CN 115493499 A CN115493499 A CN 115493499A
- Authority
- CN
- China
- Prior art keywords
- cylinder
- straight lines
- points
- placing cavity
- ellipses
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 230000007246 mechanism Effects 0.000 claims abstract description 58
- 238000003708 edge detection Methods 0.000 claims abstract description 6
- 238000013519 translation Methods 0.000 claims description 45
- 239000000725 suspension Substances 0.000 claims description 12
- 238000010008 shearing Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 abstract description 11
- 238000005259 measurement Methods 0.000 abstract description 8
- 238000000605 extraction Methods 0.000 abstract 1
- 238000003384 imaging method Methods 0.000 abstract 1
- 239000011159 matrix material Substances 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000006872 improvement Effects 0.000 description 3
- 230000009191 jumping Effects 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000009924 canning Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/02—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/24—Measuring arrangements characterised by the use of optical techniques for measuring contours or curvatures
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/26—Measuring arrangements characterised by the use of optical techniques for measuring angles or tapers; for testing the alignment of axes
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
- Y02E30/00—Energy generation of nuclear origin
- Y02E30/30—Nuclear fission reactors
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Image Analysis (AREA)
Abstract
The invention provides a method and a system for assembling a cylinder or a cylinder-like body, belonging to the technical field of assembly operation. According to the method, a monocular camera is used for imaging from the oblique lower side of a cylinder-like target, edge detection and geometric feature extraction are carried out on the image, a positioning model based on multi-geometric feature combination is designed by utilizing the particularity of the projection shapes of the bottom surface and the side surface of the cylinder-like target, the relative pose of the cylinder-like target is solved, and the coaxiality relation between the cylinder-like target and a target placing circular hole is obtained. And according to the measured coaxiality result, the cylindrical target and the target placing cavity are coaxially aligned through adjustment of three degrees of freedom. And then moving the cylinder-like target to the target placing circular cavity to complete assembly. According to the invention, the apparent characteristics of the target are fully utilized to improve the assembly capability, on one hand, the apparent characteristics of the target are utilized to simplify the measurement process, and the accurate measurement of the coaxiality of the cylinder-like target can be completed only by using a monocular camera; on the other hand, the assembling mechanism is simplified, and the alignment adjustment of the coaxiality of the cylinder-like target under any pose deviation condition can be realized only by adjusting three degrees of freedom.
Description
Technical Field
The invention belongs to the technical field of mechanical arm operation, relates to a multi-degree-of-freedom operating system and method for vision measurement, and particularly relates to a cylinder or cylinder-like assembly method and system.
Background
In industrial assembly and various high-precision mechanical arm operations, a cylinder-like geometric combination body needs to be placed in a cylindrical placing cavity, and full-automatic assembly is achieved. With the improvement of industrial level and the improvement of precision requirements, the gap between the cylinder-like geometric combination and the cylindrical placing cavity is small, the cylinder-like geometric combination is required to be strictly aligned with the cylindrical placing cavity in the process of loading operation, and meanwhile, in order to reduce the complexity of a system and enhance the reliability of the system, the mechanism for assembling operation of the cylinder-like geometric combination is simplified as much as possible, and the cylinder-like geometric combination is required to be fixedly connected with the mechanism until the cylinder-like geometric combination is loaded into a sample sealed container.
In addition, in the extraterrestrial planet surface sampling return task, the samples collected on the planet surface are usually first loaded into different cylinder-like geometry sample tanks, and then each sample tank is placed back into the round-mouth sample-sealed container of the return device and brought back to the ground. In order to collect as many samples as possible, the volume of the sample tank is usually increased as much as possible, so that the gap for the sample tank to be filled into the sample sealed container is small, and the sample tank is required to be strictly aligned with the mouth of the sample sealed container during the filling operation; meanwhile, in order to reduce the complexity of the system and enhance the reliability of the system, the mechanism of the sample tank assembly operation is simplified as much as possible, and the sample tank is required to be kept fixedly connected with the mechanism until the sample tank is filled into the sample sealed container.
Meanwhile, considering that the assembly operation of the similar cylindrical geometric combination is finished in the environments such as an industrial field, an extraterrestrial planet surface and the like, the mechanism is easy to deform due to collision or gravity influence and the like in a complex operation or flight process, and the assembly accuracy of the similar cylindrical geometric combination and the round-mouth container is difficult to ensure only by means of the mechanism operation.
Therefore, in the prior art, it is urgently needed to adapt to the application scene to realize the assembly operation of the cylinder-like geometric combination, introduce a measurement system to accurately measure the relative pose relationship between the cylinder-like geometric combination and the round-mouth target placing container, and design a simple mechanism device capable of guiding the completion of the assembly operation.
Disclosure of Invention
Aiming at the problems and requirements in the background technology, the invention aims to provide a column assembling system and method based on coaxiality vision measurement guidance, and aims to solve the technical problem that the coaxiality of a column-like geometric combination body and a cylindrical placing cavity is changed due to vibration, temperature change and air pressure change of a mechanical arm in the operation process, so that the column-like geometric combination body cannot be placed into the cylindrical placing cavity. On one hand, the upper four-degree-of-freedom simple operating mechanism is designed, so that the pose adjustment of the cylinder-like geometric combination body can be realized; on the other hand, aiming at the problem of inaccurate pairing of sealed canning caused by mechanism deformation, the visual measurement method based on the surface geometric characteristics of the cylinder-like geometric combination body is provided, the coaxiality relation of the cylinder-like geometric combination body can be accurately measured, and the mechanism is guided to complete pose adjustment and assembly operation of the cylinder-like geometric combination body.
In order to achieve the purpose, the invention adopts the following technical scheme.
In one aspect, the present invention provides a cylinder or cylinder-like assembly system.
The system comprises: the device comprises an operation platform, a control unit, a mechanical arm, a cylinder-like geometric combination body, a cylindrical placing cavity and a camera;
the control unit is arranged in the operation platform and can control the camera to shoot images, process the images of the camera, generate a mechanical arm control instruction and control the motion of the mechanical arm;
the mechanical arm and the camera are both arranged on the operation platform;
the mechanical arm comprises a vertical moving mechanism, a horizontal suspension beam, a translation mechanism, a rotary joint A, a rotary joint B and a shearing and releasing mechanism
The translation mechanism carries a motor and comprises a slide rail and a slide block, and the translation mechanism can move the slide block under the instruction of the control unit;
the shearing release mechanism can release the cylindrical geometric combination under the instruction of the control unit, and has certain flexibility, so that the cylindrical geometric combination is deformed under the conditions of strong vibration and large temperature difference;
the vertical moving mechanism is provided with a thread and a motor, so that the horizontal suspension beam can translate in the vertical direction to drive the cylinder-like geometric combination to ascend or descend;
the translation mechanism is vertically arranged on the horizontal suspension beam and can drive the rotary joint A to translate; the translation direction of the translation mechanism is mutually perpendicular to the rotation axial direction of the rotary joint A and the rotation axial direction of the rotary joint B which are mutually orthogonal;
the rotary joint A is connected with a translation mechanism, and a plane formed by the translation direction of the translation mechanism and the rotational axial direction of the rotary joint A in an orthogonal mode is parallel to the operation platform, so that the cylinder-like geometric combination body can realize the rotation of a plane with a rotational axis vertical to the intersection of the translation direction of the translation mechanism and the rotational axial direction of the rotary joint B;
the rotary joint B is respectively connected with the rotary joint A and the shearing mechanism, and the rotating axial direction of the rotary joint B is vertical to the operation platform, so that the cylinder-like geometric combination can realize the rotation of the rotating shaft which is vertical to the operation platform;
the shearing structure is used for connecting the rotary joint B with the cylinder-like geometric combination.
Preferably, the camera is a monocular camera.
Another aspect of the invention provides a method of assembling a cylindrical body or cylinder-like body, the method comprising:
s1, measuring the coaxiality of the cylinder-like geometric combination and the cylindrical placing cavity;
the camera shoots the cylinder or the similar cylinder to obtain a two-dimensional picture of the cylinder or the similar cylinder; roughly detecting a two-dimensional curve profile in the picture by adopting a Canny edge detection method; grouping the two-dimensional curve outline according to straight lines and curves, establishing combined implicit equation description according to the number of straight line groups and ellipses contained in the two-dimensional image, and substituting outline points in the two-dimensional image into the implicit equation to solve description parameters of the straight lines and the ellipses; preliminarily classifying contour points in the two-dimensional image according to corresponding straight lines and ellipses, enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations, and fitting the straight lines again by using the points corresponding to the straight lines to form accurate straight line equations; solving an ellipse equation by utilizing the position relation that a straight line is tangent to arc sections at two ends of a long axis and the straight line is parallel to a short axis of the ellipse; classifying the contour points in the two-dimensional image according to the corresponding straight lines and ellipses again according to the solved straight lines and elliptic equations, determining the attribution relationship of the contour points on the ellipses and the straight lines, and fitting the elliptic equations by using the points corresponding to the ellipses; and solving the normal vector and the origin coordinate of the bottom surface of the cylinder or the similar cylinder according to the solved elliptic equation to serve as the basis of subsequent assembly.
S2, adjusting the direction and the position of the cylinder-like geometric combination body according to the relative pose of the cylinder-like geometric combination body and the cylindrical placing cavity;
firstly, the axis of the cylindrical placing cavity is used as an adjusting shaft to adjust the posture of the cylinder-like geometric combination body, so that the axis of the cylinder-like geometric combination body is perpendicular to the horizontal cross beam, then the adjusting shaft perpendicular to the horizontal cross beam is used to adjust the posture of the cylinder-like geometric combination body, so that the axis of the cylinder-like geometric combination body is parallel to the cylindrical placing cavity, and finally a translation mechanism is used to adjust the posture of the cylinder-like geometric combination body, so that the axis of the cylinder-like geometric combination body is superposed with the axis of the cylindrical placing cavity;
s3, judging the coaxiality consistency;
coaxiality refers to the degree of deviation of the axes of two cylindrical objects.
After the attitude of the cylinder-like geometric combination is adjusted, the coaxiality consistency of the cylinder-like geometric combination and the cylindrical placing cavity is measured, and whether the assembly requirements are met or not is judged; if the measured coaxiality is larger and does not meet the assembly requirement, jumping to the step S2, and adjusting the posture of the similar cylindrical geometric combination again until the conditions are met;
s4, performing assembly operation;
the coaxiality of the cylinder-like geometric combination and the cylindrical placing cavity meets the assembly requirement, and a motor on the vertical mechanical arm moves to enable the horizontal mechanical arm to drive the horizontal suspension beam to descend, so that the cylinder-like geometric combination descends to be close to the cylindrical placing cavity; when the proper position is reached, the release switch is switched off, and the cylinder-like geometric combination body is separated from the mechanical arm and falls into the cylindrical placing cavity.
Further, step S1 specifically includes:
s1.1, a camera shoots a cylinder or a similar cylinder to obtain a two-dimensional picture of the cylinder or the similar cylinder;
s1.2, detecting a two-dimensional curve profile in the picture by adopting a Canny edge detection method;
s1.3, grouping two-dimensional curve outlines according to straight lines and curves, establishing combined implicit equation description according to the number of the straight lines and the ellipses contained in the two-dimensional image, and substituting outline points in the two-dimensional image into the implicit equation to solve description parameters of the straight lines and the ellipses;
s1.4, preliminarily classifying contour points in the two-dimensional image according to corresponding straight lines and ellipses, enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations, and fitting the straight lines again by using the points corresponding to the straight lines to form accurate straight line equations;
s1.5, solving an elliptic equation by utilizing the position relation that a straight line is tangent to arc sections at two ends of a long axis and the straight line is parallel to an elliptic short axis;
s1.6, classifying the contour points in the two-dimensional image again according to the corresponding straight lines and ellipses according to the solved straight lines and elliptic equations, determining the attribution relationship of the contour points on the ellipses and the straight lines, and fitting the elliptic equations by using the points corresponding to the ellipses;
and S1.7, solving the normal vector and the origin coordinates of the bottom surface of the cylinder or the cylinder-like body according to the solved elliptic equation to serve as the basis of subsequent assembly.
Further, step S1.3 specifically includes:
s1.3.1, grouping two-dimensional curve outlines according to straight lines and curves, and establishing combined implicit equation description according to the number of the straight lines and the ellipses contained in the two-dimensional image;
and S1.3.2, substituting the outline points in the two-dimensional image into an implicit equation to solve description parameters of a straight line and an ellipse.
Further, step S1.4 specifically includes:
s1.4.1, preliminarily classifying outline points in the two-dimensional image according to corresponding straight lines and ellipses, and enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations;
and S1.4.2, fitting the straight line again by using the points corresponding to the straight line to form an accurate straight line equation.
Further, step S1.6 specifically includes:
s1.6.1, classifying the contour points in the two-dimensional image again according to the corresponding straight lines and ellipses according to the solved straight lines and ellipse equations, and determining the attribution relationship of the contour points on the ellipses and the straight lines;
and S1.6.2, fitting an ellipse equation by using points corresponding to the ellipse.
Further, step S2 specifically includes:
setting a plane alpha and a rotationThe lower surface of the rotary joint B is coplanar, wherein the x axis is parallel to the horizontal cantilever beam of the mechanical arm, the y axis is parallel to the translation mechanism, and the z axis is perpendicular to the plane alpha and is coaxial with the cylindrical placing cavity; from the surface normal (n) x ,n y ,n z ) Obtaining a unit vector of the axial direction of the cylinder-like geometric assembly asThe unit vector of the axial direction of the cylinder-like geometric combination isOn the plane β;
s2.1, adjusting a rotary joint B coaxial with the cylindrical placing cavity;
let the x-axis axial unit vector of plane alpha beThe unit vector of the axial direction of the cylinder-like geometric assembly is obtained asThe adjustment angle a is:
the rotary joint B is adjusted to drive the cylinder-like geometric combination body to be adjusted together, so that the unit vector of the cylinder-like geometric combination body in the axial direction isAxial unit vector of x-axis perpendicular to plane alpha
S2.2, adjusting a rotary joint A coaxial with the horizontal suspension beam;
the z-axis axial unit vector of the known plane α isThe unit vector of the axial direction of the cylinder-like geometric assembly is obtained asThe adjustment angle b is:
the adjusting rotary joint A (2.3) drives the cylinder-like geometric combination body to be adjusted together, so that the axial unit vector of the cylinder-like geometric combination body isPerpendicular to the plane alpha. The axial unit vector of the cylinder geometric combinationParallel to and not coincident with the z-axis of plane alpha.
S2.3, adjusting the mechanical arm translation mechanism to enable the axial unit vector of the cylinder-like geometric combination bodyZ-axis axial unit vector with plane alphaThe coincidence is that the cylinder-like geometric combination body coincides with the axis of the cylindrical placing cavity. The center of the bottom space circle of the cylinder-like geometric combination body at the moment can be measured as (x) 0 ,y 0 ,z 0 ) And z-axis axial unit vector of plane alphaHas XoY coordinates of (0, 0). The translation distance is then:
d=-x 0
compared with the prior art, the invention has the following beneficial effects:
in a special star surface environment, the coaxiality measurement of the cylinder-like geometric combination can be completed by using only limited detection equipment, namely a monocular camera.
The translation direction of the translation joint is perpendicular to the rotation axial directions of the two rotation joints which are orthogonal to each other, and the adjustment of the coaxiality of the cylinder-like geometric combination body at any angle can be realized.
Drawings
FIG. 1 is a schematic view of a seal pot assembly system according to a first embodiment of the present invention;
FIG. 2 is a schematic diagram of a process of dropping a cylindrical geometric combination into a cylindrical placing cavity according to an embodiment of the present invention;
FIG. 3 is a flowchart of a second method of an embodiment of the invention;
FIG. 4 is a schematic diagram of a two-dimensional image of the bottom of a cylinder-like geometric assembly obtained according to a second embodiment of the present invention;
FIG. 5 is a schematic diagram of the positions of the ellipse and the straight line in the two-dimensional bottom picture of the geometric cylinder assembly according to the second embodiment of the present invention;
FIG. 6 is a schematic view of an elliptical projection of a bottom space circle of a second type of cylindrical geometric composite on an image plane according to an embodiment of the present invention;
FIG. 7 is a schematic diagram of the second step of the present invention before the pose adjustment of the S2-type cylindrical geometric combination;
FIG. 8 is a front and rear view of a second adjustment rotary joint B according to the present invention;
FIG. 9 is a schematic front-to-back view of a second embodiment of an adjustment swivel A of the present invention;
FIG. 10 is a front-to-back schematic view of a second embodiment of the invention with an adjustment robot translation mechanism;
fig. 11 is a process diagram of performing an assembly operation according to a second embodiment of the present invention.
Wherein:
1 operation platform, 2 mechanical arms, 3 vertical moving mechanisms, 4 horizontal suspension beams, 5 translation mechanisms, 6 rotary joints A,7 rotary joints B,8 shearing release mechanisms, 9 types of cylindrical geometric assemblies, 10 cylindrical placing holes, 11 monocular cameras, 12 two-dimensional photos shot by the cameras, 13 camera frames, 14 image planes, 15 spatial circles, 16 spatial circular projections, 17 fitting ellipses, 18 top views, 19 motors and 20 straight lines, 1f 1 21 straight line 2f 2 22 straight line 3f 3 23 straight line 4f 4 24 ellipse 1f 5 25 ellipse 2f 6 。
Detailed Description
The present invention will be described in further detail below with reference to the accompanying drawings and examples. It should be understood that the specific embodiments described herein are merely illustrative of the invention and do not limit the invention.
Example one
This example focuses on the description of the present invention of a cylindrical geometry assembly system based on monocular vision measurement, the system components of which are shown in fig. 1.
The invention has the following key parts: the device comprises an operation platform, a control unit, a mechanical arm, a cylinder-like geometric combination body to be assembled, a cylindrical placing cavity and a monocular camera (hereinafter referred to as a camera). In the system, the parameters of the mechanical arm, the cylinder-like geometric combination body and the cylindrical placing cavity are known, and the internal and external parameters of the camera are calibrated. The cylinder-like geometry may be a cylinder or a cylinder-like geometry.
The mechanical arm consists of a vertical moving mechanism, a horizontal suspension beam, a translation mechanism, a rotary joint A, a rotary joint B and a shearing mechanism. The vertical mechanical arm is provided with a thread and a motor, so that the horizontal mechanical arm can translate in the vertical direction to realize the ascending and descending of the cylinder-like geometric combination; the translation mechanism is perpendicular to the horizontal cross beam and can drive the rotary joint A to realize translation; the translation direction of the translation mechanism, the rotation axial direction of the rotary joint A and the rotation axial direction of the rotary joint B are mutually vertical; the rotary joint A is connected with the translation mechanism, a plane formed by the translation direction of the translation mechanism and the rotation axial direction of the rotary joint A in an orthogonal mode is parallel to the operation platform, and the cylindrical geometric combination can rotate with the rotation axis perpendicular to the plane where the translation direction of the translation mechanism and the rotation axial direction of the rotary joint B intersect; the rotating axial direction of the rotating joint B is perpendicular to the operating platform, so that the cylinder-like geometric combination can realize the rotation of the rotating shaft perpendicular to the operating platform; the system is a rigid body except the shearing mechanism, and the shearing mechanism connecting the rotary joint B and the cylinder-like geometric combination is deformed due to the conditions of vibration, temperature difference change, pressure difference change and the like of the operation platform in the operation process, so that the position of the cylinder-like geometric combination is changed.
The external diameter of class cylinder geometric combination is less than cylindrical and places the chamber internal diameter, and when class cylinder geometric combination and cylindrical placing cavity were coaxial, the mechanism of cuting opened, made class cylinder geometric combination fall into cylindrical placing cavity. The cylindrical placing cavity is hollow, the inner diameter of the cylindrical placing cavity is larger than the cylinder-like geometric combination body, and the height of the cylindrical placing cavity is slightly higher than the cylinder-like geometric combination body. The loading process is shown in FIGS. 2 (a), 2 (b), and 2 (c).
The camera is aligned to the bottom of the cylinder-like geometric combination body and is used for observing and judging whether the cylinder-like geometric combination body is adjusted in place or not. Wherein the camera has completed calibration and the parameters are known.
Example two
The present embodiment focuses on the description of the assembling method and process of the cylinder-like geometric combination based on monocular vision measurement guidance. The method flowchart described in this embodiment is shown in fig. 3, and the assembly process is specifically as follows based on the system implementation proposed in the first embodiment.
S1, measuring the coaxiality of the cylinder-like geometric combination body and the cylindrical placing cavity. The camera shoots the cylinder or the similar cylinder to obtain a two-dimensional picture of the cylinder or the similar cylinder; roughly detecting a two-dimensional curve profile in the picture by adopting a Canny edge detection method; grouping two-dimensional curve outlines according to straight lines and curves, establishing a combined implicit equation description according to the number of straight lines and ellipses contained in a two-dimensional image, and substituting outline points in the two-dimensional image into an implicit equation to solve description parameters of the straight lines and the ellipses; preliminarily classifying contour points in the two-dimensional image according to corresponding straight lines and ellipses, enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations, and fitting the straight lines again by using the points corresponding to the straight lines to form accurate straight line equations; solving an ellipse equation by utilizing the position relation that a straight line is tangent to arc sections at two ends of a long axis and the straight line is parallel to a short axis of the ellipse; classifying the contour points in the two-dimensional image according to the corresponding straight lines and ellipses according to the solved straight lines and elliptic equations, determining the attribution relationship of the contour points on the ellipses and the straight lines, and fitting the elliptic equations by using the points corresponding to the ellipses; and solving the normal vector and the origin coordinates of the bottom surface of the cylinder or the similar cylinder according to the solved elliptic equation to serve as the basis of subsequent assembly.
Step S1.1, the monocular camera photographs the cylinder-like geometric combination to obtain a two-dimensional picture of the bottom of the cylinder-like geometric combination as shown in fig. 4.
And S1.2, roughly detecting a two-dimensional curve profile in the picture by adopting a Canny edge detection method.
S1.3, grouping the two-dimensional curve outlines according to straight lines and curves, establishing a combined implicit equation description according to the number of the straight lines and the ellipses contained in the two-dimensional image, and substituting outline points in the two-dimensional image into the implicit equation to solve the description parameters of the straight lines and the ellipses.
S1.3.1, grouping two-dimensional curve outlines according to straight lines and curves, and establishing combined implicit equation description according to the number of the straight lines and the ellipses contained in the two-dimensional image;
the general equation for a straight line is:
Ax+By+1=0 (1)
the general equation for an ellipse is:
Ax 2 +Bxy+Cy 2 +Dx+Ey+1=0
B 2 -AC<0 (2)
wherein the curve is a half contour of an ellipse with a larger bottom surface, and the description of the curve implicit equation is the same as that of an ellipse equation, namely equation (2);
for the case where the cylinder has only one bottom surface visible, a 7-degree implicit equation is used to represent the projected contour curve of the cylinder consisting of 4 straight lines projected by the side contour and 2 ellipses projected by the bottom surface contour, as shown in figure 5,
(q 1 x+q 2 y+1)·(q 3 x+q 4 y+1)·(q 5 x+q 6 y+1)·(q 7 x+q 8 y+1)
·(q 9 x 2 +q 10 xy+q 11 y 2 +q 12 x+q 13 y+1)
·(q 14 x 2 +q 15 xy+q 16 y 2 +q 17 x+q 18 y+1)=0 (3)
according to the formula (2), the parameters corresponding to the ellipse in the formula (3) should satisfy the constraint
The straight line 1, the straight line 2 and the ellipse 1 meet the tangent condition, the straight line 1, the straight line 2 and the ellipse 1 have only one intersection point, and two equality constraints are used:
β 2 -4α i γ i =0,i =1,2 (5) in the formula
In addition, since the ellipses 1 and 2 are projections of two concentric circles, the symmetry axes of the straight lines 1 and 2, which are the cylindrical contours, and the minor axes of the ellipses 1 and 2 are collinear. This condition can be expressed by another constraint equation:
in the formula c 1 ,c 2 = left tangent of the straight-line inclination angle,
c 3 = overcut of minor axis inclination of ellipse 1,
namely:
there are one nonlinear inequality constraint (4) and 3 nonlinear equality constraints (5) (6) for the cylindrical projection profile curve (3) consisting of the straight line group of the side profile projection and the ellipse of the bottom profile projection.
And S1.3.2, substituting contour points in the two-dimensional image into an implicit equation to solve description parameters of a straight line and an ellipse.
Calculating the approximate shortest distance square delta (q, x) from each point x in the initial estimated point set q to the mathematical model using equation (8) 2 Screening out delta (q, x) 2 Data points less than the threshold t are considered interior points and points greater than t are excluded as exterior points;
for any 2-dimensional point in the initial estimated point set q, x = (x) 1 ,x 2 ) And a parameter vector q = (q) 1 ,…,q 18 ) Defining a mapping f: r 2+18 →R,
f(q,x)=(q 1 x 1 +q 2 x 2 +1)·(q 3 x 1 +q 4 x 2 +1)·(q 5 x 1 +q 6 x 2 +1)
·(q 7 x 1 +q 8 x 2 +1)·(q 9 x 1 2 +q 10 x 1 x 2 +q 11 x 2 2 +q 12 x 1 +q 13 x 2 +1)
·(q 14 x 1 2 +q 15 x 1 x 2 +q 16 x 2 2 +q 17 x 1 +q 18 x 2 +1) (7)
When given a set of parameters q, there is a mapping: r 2+18 →R,
Redefining combinationsIs composed ofThe points of the set constitute an implicit equationA defined curve.
For the curve fitting problem, q in equation (8) is the parameter to be fitted, is a variable, and x is the data point used for the fitting, is a known constant; when the data point set to be fitted is D = { p 1 ,···,p s The sum of the squares of the distances of all points to the curve can be expressed as
The curve fitting problem is described as a nonlinear optimization problem with constraints:
minΔ(q)
β 2 -4α i γ i =0,i=1,2;
constructing an auxiliary function F (x, sigma) by using a penalty function method:
wherein the functions in equation (10) are defined as follows:
wherein, if σ in the formula (10) is a large positive number, the original problem is converted into
min F(x,σ)
The objective function delta (q) is the square sum of the distances from each point in the two-dimensional image of the bottom of the shot cylinder or the similar cylinder to the curve;
by this step, q can be obtained 1 ,…,q 18 To obtain a straight line 1f 1 Straight line 2f 2 Straight line 3f 3 Straight line 4f 4 Ellipse 1f 5 Ellipse 2f 6 The equation of (c).
And S1.4, preliminarily classifying the contour points in the two-dimensional image according to corresponding straight lines and ellipses, enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations, and fitting the straight lines again by using the points corresponding to the straight lines to form accurate straight line equations.
And S1.4.1, preliminarily classifying the contour points in the two-dimensional image according to corresponding straight lines and ellipses, and attributing the points to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations.
The approximate shortest distance of any point x to f (x) has a square of
Let f (x) = straight line 1f 1 Straight line 2f 2 Straight line 3f 3 Straight line 4f 4 Ellipse 1f 5 Oval 2f 6 The distances δ (x) = δ from the points to the respective curves are calculated 1 (x),δ 2 (x),…,δ 6 (x)。
If the minimum value of the distances from the points to the curves is less than the threshold value t 1 ,
Namely:
min(δ 1 (x),δ 2 (x),…,δ 6 (x))<t 1 (12)
the point is the point on the curve with the shortest distance, and the point is added into the point set of the curve, wherein the point set of each curve is s 1 ,s 2 ,…,s 6 。
Finding a straight line 1f 1 Corresponding set of points s 1 Straight line 2f 2 Corresponding set of points s 2 Straight line 3f 3 Corresponding set of points s 3 Straight line 4f 4 Corresponding point set s 4 Oval 1f 5 Corresponding point set s 5 Oval 2f 6 Corresponding set of points s 6 。
And S1.4.2, fitting the straight line again by using the points corresponding to the straight line to form an accurate straight line equation.
Fitting straight line 1f by using corresponding point set of each straight line 1 Straight line 2f 2 Straight line 3f 3 Straight line 4f 4 Equation in the form of a straight line 1f 1 For example.
For point set q 1 N two-dimensional points (x) present in 1 ,x 2 ),…,(x n-1 ,x n ) Let a straight line 1 function f 1 Is composed of
f 1 (x 1 ,y 1 )=Ax 1 +By 1 +1 (14)
Let F 1 Is a set of points q 1 The sum of the squares of all points to the distance of line 1,
wherein the point coordinates (x i ,y i ) A and B are variables.
Order:
the values of A and B, i.e. the point set q, can be obtained 1 Straight line 1f obtained by fitting 1 And (4) an equation. In the same way, the straight line 2f can be obtained 2 Straight line 3f 3 Straight line 4f 4 And (4) an equation.
And S1.5, solving an elliptic equation by utilizing the position relation that the straight line is tangent to the arc sections at the two ends of the long axis and the straight line is parallel to the short axis of the ellipse.
Knowing the exact straight line 1f 1 Straight line 2f 2 Straight line 3f 3 Straight line 4f 4 And (4) an equation. Due to straight line 1f 1 And a straight line 3f 3 Straight line 2f 2 And a straight line 4f 4 Respectively intersect at two major axis points of the ellipse 1. Simultaneous straight line 1f 1 And a straight line 3f 3 Straight line 2f 2 And a straight line 4f 4 Two-dimensional coordinates of two major axis points of the ellipse 1 can be obtained.
Wherein, the straight line 1f 1 And a straight line 3f 3 The method comprises the following steps:
straight line 2f 2 And a straight line 4f 4 The method comprises the following steps:
the coordinates (x) of two major axis points of the ellipse 1 can be solved 1 ,y 1 ) And (x) 2 ,y 2 )。
The distance between two points is expressed as:
coordinate (x) of two major axis points of the ellipse 1 1 ,y 1 ) And (x) 2 ,y 2 ) The long axis parameter a of the ellipse 1 is substituted into the equation of the distance between two points.
Using the coordinates (x) of two major axis points of the ellipse 1 1 ,y 1 ) And (x) 2 ,y 2 ) The center point of the ellipse 1 is (x) 0 ,y 0 ). Wherein
Let the straight line where the minor axis of the ellipse 1 is f 0 :y=k 0 x+b 0 . Minor axis f 0 And a straight line 1f 1 :y=k 1 x+b 1 Straight line 2f 2 :y=k 2 x+b 2 And if the short axis is parallel to the short axis, the slope of the straight line where the short axis is located can be obtained by utilizing an angle bisector slope formula.
Angle bisector slope formula:
wherein k is 0 There are two solutions, k 0 Value and k 1 、k 2 Value approximation, rounding off and k 1 、k 2 The larger the difference in value.
The center point (x) of the ellipse 1 0 ,y 0 ) Into a straight line f 0 Can obtain b 0 Then, further find f 0 。
Using the point-to-line distance formula:
will ellipse 1f 5 Corresponding set of points s 5 In turn, theBringing the calculated point into the minor axis line f 0 The point with the shortest distance is obtained, i.e., the minor axis point of the ellipse 1. The short axis parameter b can be obtained by using the distance formula between the two points.
According to the straight line f of the minor axis of the ellipse 1 0 :y=k 0 x+b 0 The rotation angle θ of the ellipse can be obtained.
θ=tan -1 k 0 -90° (22)
By finding the center point (x) of the ellipse 1 0 ,y 0 ) The major axis a, the minor axis b, and the rotation angle θ, the equation of the ellipse 1 can be obtained.
The method is similar to the parameters that solve for ellipse 2.
Since the ellipse 1 and the ellipse 2 correspond to coaxial circles in the three-dimensional space, the rotation angle θ' of the ellipse 2 is equal to the rotation angle θ of the ellipse 1.
Solving ellipses 2f using point-to-line distance formulas 6 Corresponding point set s 6 To a straight line 3f 3 Straight line 4f 4 The point with the shortest distance can be used to obtain the corresponding two major axis points, and further obtain the major axis parameter a' by the formula (18) for the distance between two points to obtain the central point (x) of the ellipse 2 0 ′,y 0 ′)。
According to the straight line 3f 3 Straight line 4f 4 The slope of the straight line where the minor axis of the ellipse 2 is located is obtained by an angular bisector slope formula (20), and the straight line f where the minor axis is located is obtained by the coordinates of the central point 0 ′。
Solving for the ellipse 2f using the Point-to-straight distance equation (21) 6 Corresponding point set s 6 Straight line f to the minor axis 0 The point with the shortest distance is the short axis point, and the short axis parameter b' of the ellipse 2 is obtained by using a formula between the two points.
According to the center point (x) of the ellipse 2 0 ′,y 0 ') major axis a ', minor axis b ', and rotation angle θ, an equation for ellipse 2 can be obtained.
And S1.6, classifying the contour points in the two-dimensional image again according to the corresponding straight lines and ellipses according to the solved straight lines and the solved elliptic equations, determining the attribution relations of the contour points on the ellipses and the straight lines, and fitting the elliptic equations by using the points corresponding to the ellipses.
And S1.6.1, classifying the contour points in the two-dimensional image according to the corresponding straight lines and ellipses again according to the solved straight lines and ellipse equations, and determining the attribution relationship of the contour points on the ellipses and the straight lines. This step is the same as step S1.4.1.
And S1.6.2, fitting an elliptic equation by using the corresponding points of the ellipse. This step is the same as step s 1.3.2.
And S1.7, solving the normal vector and the origin coordinates of the bottom surface of the cylinder or the cylinder-like body according to the solved elliptic equation to serve as the basis of subsequent assembly.
First, the camera model is expressed as:
wherein, f 0 Is focal distance of camera
(x, y, z) are coordinates in the camera frame
Substituting the formula (23) into the formula (2) can obtain a cone equation:
Ax 2 +By 2 +Cxy+Dxz+Eyz+Fz 2 =0 (24)
wherein A = af 0 2 ,B=bf 0 2 ,C=cf 0 2 ,D=df 0 ,E=ef 0 ,F=f.
Equation (24) can be expressed by a symmetric matrix Q:
Secondly, a new reference coordinate system is defined, the origin of which is the same as the camera coordinate system, thereby ensuring that the transformation matrix between the two coordinate systems is a pure rotation matrix. Let P denote the rotation matrix:
bringing formula (26) into formula (25):
to represent the ellipsoid surface in standard form, it is required that P is a diagonalized matrix of Q:
P -1 QP=diag(λ 1 ,λ 2 ,λ 3 ) (27)
thus, the standard elliptic cone equation is:
λ 1 x′ 2 +λ 2 y′ 2 +λ 3 z′ 2 =0 (28)
from the elliptical cone equation, the center of the circle and the surface normal can be found:
the above solution is relative to the rotated x ' y ' z ' coordinate system, where R 0 Is the radius of the target bottom space circle of a cylinder or cylinder-like object, the transformation matrix P will bring the center and surface normal of the circle back to the camera coordinate system, i.e. the center (x) of the bottom space circle of the cylinder-like geometric assembly is obtained 0 ,y 0 ,z 0 ) And surface normal (n) x ,n y ,n z ):
(x 0 ,y 0 ,z 0 )=P(x′ 0 ,y′ 0 ,z′ 0 )
(n x ,n y ,n z )=P(n′ x ,n′ y ,n′ z ) (30)
And S2, adjusting the position of the cylinder-like geometric combination body according to the posture of the cylinder-like geometric combination body and the posture of the cylindrical placing cavity. The attitude of the cylinder-like geometric combination is adjusted by using the axis of the cylindrical placing cavity as an adjusting shaft, so that the axis of the cylinder-like geometric combination is perpendicular to the horizontal beam (namely, the x axis perpendicular to the plane alpha). And then adjusting the posture of the cylinder-like geometric combination body by using an adjusting shaft perpendicular to the horizontal cross beam to enable the axis of the cylinder-like geometric combination body to be parallel to the cylindrical placing cavity. And finally, adjusting the posture of the cylinder-like geometric combination body by using a translation mechanism to ensure that the axis of the cylinder-like geometric combination body is superposed with the axis of the cylindrical placing cavity.
And a plane alpha is coplanar with the lower surface of the rotary joint B, wherein the x axis is parallel to the horizontal cantilever beam of the mechanical arm, the y axis is parallel to the translation mechanism, and the z axis is perpendicular to the plane alpha and is coaxial with the cylindrical placing cavity. From the surface normal (n) x ,n y ,n z ) Obtaining a unit vector of the axial direction of the cylinder-like geometric assembly asThe unit vector of the axial direction of the cylinder-like geometric combination isIn the plane beta.
And S2.1, adjusting a rotary joint B coaxial with the cylindrical placing cavity. Let the x-axis axial unit vector of plane alpha beThe axial unit vector of the cylinder-like geometric combination is obtained asThe adjustment angle a is:
the adjustment rotary joint B drives the cylinder-like geometric combination body to be adjusted together, so that the cylinder-like geometric combination bodyUnit vector of body axis direction isAxial unit vector of x-axis perpendicular to plane alpha
Before adjustment, as shown in fig. 8 (a), and after adjustment, as shown in fig. 8 (b).
And S2.2, adjusting a rotary joint A coaxial with the horizontal suspension beam. The z-axis axial unit vector of the known plane α isThe axial unit vector of the cylinder-like geometric combination is obtained asThe adjustment angle b is:
the adjusting rotary joint A (2.3) drives the cylinder-like geometric combination body to be adjusted together, so that the axial unit vector of the cylinder-like geometric combination body isPerpendicular to the plane alpha. The axial unit vector of the cylinder geometric combinationParallel to and not coincident with the z-axis of plane alpha.
Before adjustment, as shown in fig. 9 (a), and after adjustment, as shown in fig. 9 (b).
S2.3, adjusting the mechanical arm translation mechanism to enable the axial unit vector of the cylindrical geometric combination body to be similar to the axial unit vectorZ-axis axial unit vector with plane alphaThe coincidence is that the cylinder-like geometric combination body coincides with the axis of the cylindrical placing cavity. The center of the bottom space circle of the cylinder-like geometric combination body at the moment can be measured as (x) 0 ,y 0 ,z 0 ) And z-axis axial unit vector of plane alphaHas XoY coordinates of (0, 0). The translation distance is then:
d=-x 0
fig. 10 (a) shows a state before adjustment of the arm translation mechanism and a plan view thereof; fig. 10 (b) shows a state after the adjustment of the arm translation mechanism and a plan view thereof.
And S3, judging the coaxiality consistency. After the posture of the cylinder-like geometric combination body is adjusted, the consistency of the coaxiality of the cylinder-like geometric combination body and the cylindrical placing cavity is judged to judge whether the assembly requirements are met. And if the measured coaxiality is larger and does not meet the assembly requirement, jumping to the step S2, and adjusting the posture of the similar cylindrical geometric combination again until the conditions are met.
And S4, performing assembly operation. The coaxiality of the similar cylindrical geometric combination body and the cylindrical placing cavity meets the assembly requirement, the motor on the vertical mechanical arm moves to enable the horizontal mechanical arm to drive the horizontal suspension beam to descend, and the similar cylindrical geometric combination body descends to be close to the cylindrical placing cavity, as shown in fig. 11 (a). When the proper position is reached, the release switch is opened and the cylinder-like geometry separates from the robotic arm and falls into the cylindrical holding chamber, as shown in fig. 11 (b).
The above description is only an example of the present application and is not intended to limit the present application. Various modifications and changes may occur to those skilled in the art. Any modification, equivalent replacement, improvement or the like made within the spirit and principle of the present application shall be included in the scope of the claims of the present application.
Claims (10)
1. A cylinder or cylinder-like assembly system, comprising:
the device comprises an operation platform, a mechanical arm, a cylindrical placing cavity and a camera;
the mechanical arm and the camera are both arranged on the operation platform;
the mechanical arm comprises a vertical moving mechanism, a horizontal suspension beam, a translation mechanism, a rotary joint A, a rotary joint B and a shearing release mechanism;
the vertical moving mechanism is provided with threads and a motor and is used for driving the horizontal suspension beam to translate in the vertical direction so as to drive the cylinder or the similar cylinder to ascend or descend;
the translation mechanism is vertically arranged on the horizontal suspension beam and can drive the rotary joint A to realize translation;
the rotary joint A is connected with the translation mechanism;
the rotary joint B is respectively connected with the rotary joint A and the shearing release mechanism, and the rotary axial direction of the rotary joint B is vertical to the operation platform, so that the cylinder or the similar cylinder can realize the rotation of the rotary shaft vertical to the operation platform;
the cylindrical placing cavity is used for accommodating the cylinder or the cylinder-like body, the inner diameter of the cylindrical placing cavity is larger than that of the cylinder or the cylinder-like body, and the height of the cylindrical placing cavity is slightly higher than that of the cylinder or the cylinder-like body;
the shearing release mechanism is used for enabling the cylinder or the cylinder-like body to fall into the cylindrical placing cavity when the cylinder or the cylinder-like body is coaxial with the cylindrical placing cavity;
the camera is used for observing the position and the posture of the cylinder or the cylinder-like body;
the cylinder-like body is a cylinder with a chamfer at the bottom, namely a combination of the inverted round table and the cylinder.
2. The system of claim 1, wherein:
the camera is a monocular camera.
3. The system according to any one of claims 1-2, wherein:
the translation direction of the translation mechanism is mutually perpendicular to the rotation axial direction of the rotary joint A and the rotation axial direction of the rotary joint B which are mutually orthogonal.
4. The system according to any one of claims 1-3, wherein:
the plane formed by the translation direction of the translation mechanism and the rotation axial direction of the rotary joint A in an orthogonal mode is parallel to the operation platform, so that the cylinder or the similar cylinder can rotate on the plane which is perpendicular to the translation direction of the translation mechanism and the rotation axial direction of the rotary joint B in an intersecting mode.
5. A method for assembling a cylinder or cylinder-like body, characterized in that it is implemented with an assembly system according to any one of claims 1-4, said method comprising:
s1, measuring the coaxiality of a cylinder or a similar cylinder and a cylindrical placing cavity, wherein the coaxiality refers to the deviation degree of the axes of two cylindrical objects;
s2, adjusting the position of the cylindrical placing cavity according to the posture of the cylindrical placing cavity of the cylinder or the cylinder-like cylindrical placing cavity;
s3, judging whether the coaxiality consistency of the cylinder or the cylinder-like body and the cylindrical placing cavity meets the assembling requirement or not, and executing the step S4 when the coaxiality consistency of the cylinder or the cylinder-like body and the cylindrical placing cavity meets the assembling requirement; when the assembly requirements are not met, the step S1, the step S2 and the step S3 are sequentially executed;
and S4, when the coaxiality consistency of the cylinder or the cylinder-like body and the cylindrical placing cavity meets the assembling requirement, controlling the cylinder or the cylinder-like body to descend to approach the cylindrical placing cavity, and when the cylinder or the cylinder-like body reaches a proper position, releasing the cylinder or the cylinder-like body to enable the cylinder or the cylinder-like body to fall into the cylindrical placing cavity.
6. The method of claim 5, wherein:
the step S1 includes:
s1.1, a camera shoots a cylinder or a similar cylinder to obtain a two-dimensional picture of the cylinder or the similar cylinder;
s1.2, detecting a two-dimensional curve profile in the picture by adopting a Canny edge detection method;
s1.3, grouping two-dimensional curve outlines according to straight lines and curves, establishing combined implicit equation description according to the number of the straight lines and the ellipses contained in the two-dimensional image, and substituting outline points in the two-dimensional image into the implicit equation to solve description parameters of the straight lines and the ellipses;
s1.4, preliminarily classifying contour points in the two-dimensional image according to corresponding straight lines and ellipses, enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations, and fitting the straight lines again by using the points corresponding to the straight lines to form accurate straight line equations;
s1.5, solving an elliptic equation by utilizing the position relation that a straight line is tangent to arc sections at two ends of a long axis and the straight line is parallel to an elliptic short axis;
s1.6, classifying the contour points in the two-dimensional image again according to the corresponding straight lines and ellipses according to the solved straight lines and elliptic equations, determining the attribution relationship of the contour points on the ellipses and the straight lines, and fitting the elliptic equations by using the points corresponding to the ellipses;
and S1.7, solving the normal vector and the origin coordinates of the bottom surface of the cylinder or the cylinder-like body according to the solved elliptic equation, and taking the normal vector and the origin coordinates as the basis of subsequent assembly.
7. The method according to any one of claims 5-6, wherein:
said step S1.3 comprises:
s1.3.1, grouping two-dimensional curve outlines according to straight lines and curves, and establishing a combined implicit equation description according to the number of the straight lines and the ellipses contained in the two-dimensional image;
and S1.3.2, substituting the contour points in the two-dimensional image into an implicit equation to solve the description parameters of the straight line and the ellipse.
8. The method according to any one of claims 5-7, wherein:
said step S1.4 comprises:
s1.4.1, preliminarily classifying outline points in the two-dimensional image according to corresponding straight lines and ellipses, and enabling the points to belong to the corresponding straight lines or ellipses according to the distances from the points to the straight lines and the ellipse equations;
and S1.4.2, fitting the straight line again by using the points corresponding to the straight line to form an accurate straight line equation.
9. The method according to any one of claims 5-8, wherein:
said step S1.6 comprises:
s1.6.1, classifying the contour points in the two-dimensional image again according to the corresponding straight lines and ellipses according to the solved straight line and ellipse equations, and determining the attribution relationship of the contour points on the ellipses and the straight lines;
and S1.6.2, fitting an ellipse equation by using points corresponding to the ellipse.
10. The method according to any one of claims 5-9, wherein:
the step S1.2 specifically includes:
and identifying the image contour in the two-dimensional image by using a Canny edge detector, and establishing an initial estimation point set q of the two-dimensional image contour.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2021116561237 | 2021-12-30 | ||
CN202111656123 | 2021-12-30 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115493499A true CN115493499A (en) | 2022-12-20 |
CN115493499B CN115493499B (en) | 2024-04-19 |
Family
ID=84467944
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211080351.9A Active CN115493499B (en) | 2021-12-30 | 2022-09-05 | Cylinder or cylinder-like assembly method and system |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115493499B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024141034A1 (en) * | 2022-12-29 | 2024-07-04 | 长园视觉科技(珠海)有限公司 | Loading and unloading control method, controller, loading and unloading device, and storage medium |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102128589A (en) * | 2010-01-20 | 2011-07-20 | 中国科学院自动化研究所 | Method for correcting azimuth errors of inner bore of part in process of assembling axle hole |
CN107617876A (en) * | 2017-07-27 | 2018-01-23 | 西北工业大学 | A kind of assembling centering method based on machine vision monitoring |
CN108453727A (en) * | 2018-01-11 | 2018-08-28 | 中国人民解放军63920部队 | Mechanical arm tail end position and attitude error bearing calibration based on oval feature and system |
CN108596980A (en) * | 2018-03-29 | 2018-09-28 | 中国人民解放军63920部队 | Circular target vision positioning precision assessment method, device, storage medium and processing equipment |
CN108765489A (en) * | 2018-05-29 | 2018-11-06 | 中国人民解放军63920部队 | A kind of pose computational methods, system, medium and equipment based on combination target |
JP2019119005A (en) * | 2018-01-05 | 2019-07-22 | 株式会社Fdkエンジニアリング | Calibration method of component assembly device |
CN110146038A (en) * | 2019-06-08 | 2019-08-20 | 西安电子科技大学 | The distributed monocular camera laser measuring device for measuring and method of cylindrical member assembly corner |
CN110987932A (en) * | 2019-12-28 | 2020-04-10 | 成都行必果光电科技有限公司 | Automatic assembly coordinate vision measurement method |
CN111085837A (en) * | 2019-12-28 | 2020-05-01 | 成都行必果光电科技有限公司 | Automatic assembly position attitude measurement method |
CN111121655A (en) * | 2019-12-18 | 2020-05-08 | 浙江大学 | Visual detection method for pose and aperture of coplanar workpiece with equal large hole patterns |
CN112815850A (en) * | 2021-02-26 | 2021-05-18 | 中国工程物理研究院机械制造工艺研究所 | Cylinder pose measuring method and device |
CN113052905A (en) * | 2021-03-31 | 2021-06-29 | 中国人民解放军63920部队 | Round target pose measurement method and device based on binocular inverse projection transformation |
CN113822934A (en) * | 2021-09-13 | 2021-12-21 | 中国人民解放军63920部队 | Multi-feature fusion visual positioning method based on inverse projection |
-
2022
- 2022-09-05 CN CN202211080351.9A patent/CN115493499B/en active Active
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102128589A (en) * | 2010-01-20 | 2011-07-20 | 中国科学院自动化研究所 | Method for correcting azimuth errors of inner bore of part in process of assembling axle hole |
CN107617876A (en) * | 2017-07-27 | 2018-01-23 | 西北工业大学 | A kind of assembling centering method based on machine vision monitoring |
JP2019119005A (en) * | 2018-01-05 | 2019-07-22 | 株式会社Fdkエンジニアリング | Calibration method of component assembly device |
CN108453727A (en) * | 2018-01-11 | 2018-08-28 | 中国人民解放军63920部队 | Mechanical arm tail end position and attitude error bearing calibration based on oval feature and system |
CN108596980A (en) * | 2018-03-29 | 2018-09-28 | 中国人民解放军63920部队 | Circular target vision positioning precision assessment method, device, storage medium and processing equipment |
CN108765489A (en) * | 2018-05-29 | 2018-11-06 | 中国人民解放军63920部队 | A kind of pose computational methods, system, medium and equipment based on combination target |
CN110146038A (en) * | 2019-06-08 | 2019-08-20 | 西安电子科技大学 | The distributed monocular camera laser measuring device for measuring and method of cylindrical member assembly corner |
CN111121655A (en) * | 2019-12-18 | 2020-05-08 | 浙江大学 | Visual detection method for pose and aperture of coplanar workpiece with equal large hole patterns |
CN110987932A (en) * | 2019-12-28 | 2020-04-10 | 成都行必果光电科技有限公司 | Automatic assembly coordinate vision measurement method |
CN111085837A (en) * | 2019-12-28 | 2020-05-01 | 成都行必果光电科技有限公司 | Automatic assembly position attitude measurement method |
CN112815850A (en) * | 2021-02-26 | 2021-05-18 | 中国工程物理研究院机械制造工艺研究所 | Cylinder pose measuring method and device |
CN113052905A (en) * | 2021-03-31 | 2021-06-29 | 中国人民解放军63920部队 | Round target pose measurement method and device based on binocular inverse projection transformation |
CN113822934A (en) * | 2021-09-13 | 2021-12-21 | 中国人民解放军63920部队 | Multi-feature fusion visual positioning method based on inverse projection |
Non-Patent Citations (1)
Title |
---|
金贺荣等: "面向筒类舱段自动装配的两点定位调姿方法", 中国机械工程, vol. 29, no. 12, 26 June 2018 (2018-06-26), pages 1467 - 1474 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024141034A1 (en) * | 2022-12-29 | 2024-07-04 | 长园视觉科技(珠海)有限公司 | Loading and unloading control method, controller, loading and unloading device, and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN115493499B (en) | 2024-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111775146B (en) | Visual alignment method under industrial mechanical arm multi-station operation | |
US9197810B2 (en) | Systems and methods for tracking location of movable target object | |
CN108801142B (en) | Double-movement measuring robot system and method for super-large-size workpiece | |
CN111735479A (en) | Multi-sensor combined calibration device and method | |
CN108844459A (en) | A kind of scaling method and device of leaf digital template detection system | |
CN109940605A (en) | Merge the submissive assembly system and method for 3D vision and contact force analysis | |
CN110987021B (en) | Inertial vision relative attitude calibration method based on rotary table reference | |
CN111515944A (en) | Automatic calibration method for non-fixed path robot | |
CN109373894B (en) | Automatic positioning method for aircraft component connection intersection point hole system based on distributed monocular vision | |
CN106995062A (en) | Method and system for the engagement of wing to main body | |
CN115493499A (en) | Method and system for assembling cylinder or cylinder-like body | |
WO2022000713A1 (en) | Augmented reality self-positioning method based on aviation assembly | |
CN109794963A (en) | A kind of robot method for rapidly positioning towards curved surface member | |
CN114770517B (en) | Method for calibrating robot through point cloud acquisition device and calibration system | |
CN109940606B (en) | Robot guiding system and method based on point cloud data | |
CN111912381A (en) | Airplane control surface angle measuring method based on binocular vision principle | |
CN109514554A (en) | Utilize the tool coordinates system quick calibrating method of robot end's vision system | |
CN114770516A (en) | Method for calibrating robot through point cloud obtaining device and calibration system | |
CN110928311A (en) | Indoor mobile robot navigation method based on linear features under panoramic camera | |
CN114092552A (en) | Method for carrying out butt joint on large rigid body member based on fixed end image | |
Marchand et al. | Visual servoing through mirror reflection | |
CN107806861B (en) | Inclined image relative orientation method based on essential matrix decomposition | |
CN110370272A (en) | It is a kind of based on the robot TCP calibration system vertically reflected | |
CN116619350A (en) | Robot error calibration method based on binocular vision measurement | |
CN113324538A (en) | Cooperative target remote high-precision six-degree-of-freedom pose measurement method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |