Method for the pose for measuring the columnar object with round cambered surface
Technical field
The present invention relates to object fields of measurement, more particularly, to a kind of for measuring the column with round cambered surface
The method of the pose of body.
Background technology
Columnar object (such as cylindrical object) with round cambered surface is that the most basic, frequency of occurrences is most in industrial production
One of high parts are widely applied in production and living.Set and Positioning when traditionally cylindrical object produces and processes is equal
By the way of fixture clamping or mold positioning, the precision of pose can ensure.But it is poor for certain cylindricities and straightness
Cylindrical object, do not ensure that the pose accuracy in its each section by way of fixture clamping or mold positioning;Due to
The shape particularity of cylindrical object elongate is also also easy to produce when bearing the processing technologys such as unilateral welding, unilateral punching
The thermal deformations such as warpage are difficult to merely ensure the positioning accuracy of cylindrical object at this time by the positioning of fixture, give production and processing band
Come difficult.Thus, traditionally for the processing technology of the high-precision requirement of elongated cylindrical object and yielding processing technology
It is had been manually done by worker.For example, the arc stud welding processing of Technique in Boiler Membrane Water Cooled Wall pipe row, the process of production is extremely cumbersome, effect
Rate is low, and the working environment of workers is severe, and labor intensity is big, and personal safety cannot ensure.
In recent years, with the progress of Chinese science and technology and economic fast development, robot technology is constantly progressive, industrial machine
The application field of people is more and more extensive so that applied robot replaces worker in the dimensional instability processing of elongated cylindrical object
Become possible, and the pose that robot can obtain cylindrical object in real time is given birth to instead of worker using industrial robot
The prerequisite of production.Currently, robot, which measures object, mostly uses visual sensor, although this mode can ensure the essence measured
Degree, can cost it is higher, the time complexity of recognizer is higher, and for cylindrical object, utilizes complicated vision
Sensor identifies that pose is not necessarily to.The production that cylindrical object correctly can be reliably carried out for guarantee robot adds
How work works out simple and quick, practical reliable cylindrical object pose measurement under conditions of reducing cost to greatest extent
Method also just becomes particularly important.
Invention content
The present invention proposes a kind of method of the spatial pose of columnar object of the rapidly and accurately identification with round cambered surface,
And the cost of implementation of this method is low, it is only necessary to which linear laser two-dimensional measurement sensor can be realized.
According to an aspect of the invention, it is proposed that a kind of side for measuring the pose of the columnar object with circle cambered surface
Method, this method include:
Step 101, multiple number of contours strong points are obtained using linear laser two-dimensional measurement sensor measurement, wherein with laser
The section of beam transmitting is xoy planes, and the axis of the circle cambered surface is not parallel to the xoy planes;
Step 102, it is based on the multiple outline data point and carries out ellipse fitting, identify at least one elliptic arc;
Step 103, for each elliptic arc identified, the outline data point in the middle part of the elliptic arc is carried out oval
Fitting, based on the absolute Euclidean distance between the ellipse week that the number of contours strong point of the elliptic arc front and rear and fitting obtain
To screen out the error dot in the number of contours strong point of the elliptic arc front and rear;
Step 104, for each elliptic arc identified, ellipse is carried out to remaining outline data point after screening out error dot
Fitting, to determine corresponding elliptical characteristic parameter, the characteristic parameter include position of the elliptical center in the xoy planes,
Elliptical major semiaxis length a, elliptical semi-minor axis length b, elliptical inclined direction;
Step 105, it is based on the characteristic parameter, obtains the position of columnar object section corresponding with each elliptic arc identified
Appearance.
Optionally, the step 102 includes:
If measuring obtain number number of contours strong point in a step 101, it is followed successively by p (x1,y1)、p(x2,y2)、…、p
(xnumber,ynumber);
Step A1, enables i=1, vertex=1, flag=0, enters step B1;
Step B1, num outline data point total to i to i+num-1 carry out ellipse fitting, enter step C1;
Step C1 was obtained in currently num number of contours strong point of participation ellipse fitting between each and corresponding oval week
Absolute Euclidean distance errorj, j=i, i+1 ..., i+num-1 enter step D1;
Step D1, if currently participated in absolute European between num number of contours strong point of ellipse fitting and corresponding oval week
Distance errorj, j=i, i+1 ..., i+num-1 are no more than measurement error threshold value error_measure, then E1 is entered step, it is no
Then enter step F1;
Step E1, it is believed that the num number of contours strong point is respectively positioned on same elliptic arc, and if flag=0, into one
Step record p (xi,yi) be starting point, that is, start (vertex)=i of the elliptic arc and flag=1 is set, enter step G1;
Step F1, it is believed that the num number of contours strong point is not located on same elliptic arc, and if flag=1, into one
Step record p (xi+num-2,yi+num-2) be terminal, that is, finish (vertex)=i+num-2 of the elliptic arc and vertex is set
=vertex+1 and flag=0, enters step G1;
Step G1 terminates if i+num-1=number;Otherwise i=i+1 is set, step B1 is returned to, to next group
Num outline data point is identified, until i+num-1=number.
Optionally,R is the corresponding radius in the arc of circle face,
Line_width is the line width of every Shu Jiguang, and width is overall measurement width, and distance is that the laser source point of the sensor arrives
The xoy planes between the intersection point of the axis of round cambered surface at a distance from, Slope is the laser beam most foreign steamer of the sensor emission
Wide slope.
Optionally, carrying out ellipse fitting to arbitrary n outline data point includes:
Using least square method (such as non-linear least square), based on making following objective functions J minimums obtain oval exist
Central coordinate of circle (x in the xoy planes0_n, y0_n), major semiaxis length an, semi-minor axis length bn, long axis and x-axis angle thetan:
WhereinBy x0_n
Initial value be assigned to the x coordinate value in n number of contours strong point with the data point of maximum y-coordinate value, by y0_nInitial value be assigned to n
There is the y-coordinate value of the data point of maximum y-coordinate value to subtract the corresponding radius r in the arc of circle face, by a in number of contours strong pointn
And bnInitial value be assigned to r, by θnInitial value be assigned to 0.
Optionally, arbitrary number of contours strong point p (x are obtained based on following formulak,yk) absolute Euclidean distance between corresponding oval week
errork:
Wherein,(x0_n,
y0_n) it is the oval central coordinate of circle in the xoy planes, anFor major semiaxis length, bnFor semi-minor axis length, θnFor long axis and x
The angle of axis.
Optionally, elliptic arc front is the elliptic arc rear portion from the elliptic arc starting point to from the 15%~25% of the elliptic arc
For the terminal to the elliptic arc from the 75%~85% of the elliptic arc.
Optionally, at step 104, first remaining outline data point after screening out error dot is smoothed and is homogenized
Processing, then ellipse fitting is carried out to the data point of smoothedization and Homogenization Treatments, to determine corresponding elliptical characteristic parameter.
Optionally, described smooth includes:The 30% of the remaining number of contours strong point that filtering window width is the elliptic arc is chosen,
According to local regression method, the data point of the roomy small data quantity of spectral window is chosen successively, and line (such as is weighted using least square method
Property least square) obtain making the second-order polynomial curve of number of contours strong point point set optimal solution in filtering window width.
Optionally, the homogenization includes:Calculate the maximum value of the x coordinate value at the number of contours strong point after smoothing techniques
xmaxWith minimum value xmin, in xmaxWith minimum value xminBetween be uniformly arranged new x coordinate value at a predetermined interval, obtained using spline interpolation
To the new corresponding y-coordinate value of x coordinate value.
Optionally, this method further includes:The sensor is moved along the z-axis direction vertical with the xoy planes to hold again
Row step 101~105, until completing the measurement to the entire columnar object with round cambered surface.
The advantage of the invention is that:The simple linear laser two-dimensional measurement sensor using low cost passes through two-dimensional survey
Measure data, can quickly recognize measure section cylindrical object (such as cylindrical parts) round cambered surface profile, and according to
The oval feature parameter of the profile obtains the spatial pose of corresponding columnar object section.Using the measurable arbitrary dimension of the present invention
The spatial pose of columnar object with round cambered surface, for example, the spatial pose mostly with cylindrical object can be measured simultaneously.This hair
It is bright also to have the advantages that reproducible, strong interference immunity, the missing of measurement data, saltus step can be excluded caused by measurement result
It influences, and other shapes object in measurement range can be discharged to influence caused by measurement.
Description of the drawings
Exemplary embodiment of the invention is described in more detail in conjunction with the accompanying drawings, it is of the invention above-mentioned and its
Its purpose, feature and advantage will be apparent, wherein in exemplary embodiment of the invention, identical reference label
Typically represent same parts.
Fig. 1 show property embodiment according to an example of the present invention for measuring the columnar object with circle cambered surface
Pose method flow diagram.
Fig. 2 shows the rough screening schematic diagrames of data point of property embodiment according to an example of the present invention.
Fig. 3 shows the pose schematic diagram of the axis of the round cambered surface of property embodiment according to an example of the present invention.
Specific implementation mode
The preferred embodiment of the present invention is more fully described below with reference to accompanying drawings.Although showing the present invention in attached drawing
Preferred embodiment, however, it is to be appreciated that may be realized in various forms the present invention without the embodiment party that should be illustrated here
Formula is limited.On the contrary, these embodiments are provided so that the present invention is more thorough and complete, and can be by the present invention's
Range is completely communicated to those skilled in the art.
The invention discloses a kind of method for measuring the pose of the columnar object with round cambered surface, this method packets
It includes:
Step 101, multiple number of contours strong points are obtained using linear laser two-dimensional measurement sensor measurement, wherein with laser
The section of beam transmitting is xoy planes, and the axis of the circle cambered surface is not parallel to the xoy planes;
Step 102, it is based on the multiple outline data point and carries out ellipse fitting, identify at least one elliptic arc;
Step 103, for each elliptic arc identified, the outline data point in the middle part of the elliptic arc is carried out oval
Fitting, based on the absolute Euclidean distance between the ellipse week that the number of contours strong point of the elliptic arc front and rear and fitting obtain
To screen out the error dot in the number of contours strong point of the elliptic arc front and rear;
Step 104, for each elliptic arc identified, ellipse is carried out to remaining outline data point after screening out error dot
Fitting, to determine corresponding elliptical characteristic parameter, the characteristic parameter include position of the elliptical center in the xoy planes,
Elliptical major semiaxis length a, elliptical semi-minor axis length b, elliptical inclined direction;
Step 105, it is based on the characteristic parameter, obtains the position of columnar object section corresponding with each elliptic arc identified
Appearance.
Fig. 1 show property embodiment according to an example of the present invention for measuring the columnar object with circle cambered surface
Pose method flow chart.
Step 1:Establish two-dimensional coordinate system
It can be with the section of radiating laser beams for xoy planes, wherein can be with the lasing light emitter of linear laser dimension sensor
Point is coordinate origin, can establish left hand rectangular coordinate system using the direction of laser beam centre ray emission as negative direction of the y-axis.
Xoy planes are shown in Fig. 2.
Step 2:It is measured in real time using linear laser two-dimensional measurement sensor
It can be by sending refreshing and measuring command to sensor, to obtain real-time measuring data.In addition, can also input circle
The size and measurement distance of shape cambered surface, and calculate laser linewidth and identify data volume with single.
Input data may include columnar object the corresponding radius r in arc of circle face and sensor laser source point to institute
State xoy planes distance distance between the intersection point of the axis of round cambered surface.
The total quantity for currently measuring obtained number of contours strong point can be set as number, the coordinate in xoy planes according to
Secondary is p (x1,y1)、p(x2,y2)、…、p(xnumber,ynumber).The line that sensor projects on object can be obtained according to the following formula
The range of property laser, i.e. overall measurement width width:
Wherein Slope is the slope of the outermost profile of laser beam of the sensor emission, is originally shown
Slope=2.6 in example property embodiment.
Further obtain the line width line_width of every Shu Jiguang:
Calculate single identification data volume num:
If should be noted thatResult be integer, can root
According to needing to its rounding, such as upward or downward or round.
Step 3:Identify the number of contours strong point on elliptic arc roughly
Step A1 can enable i=1, vertex=1, flag=0, enter step B1.
Step B1, can num outline data point progress ellipse fitting total to i to i+num-1.Specifically, it may be used
Nonlinear least square method, based on making following objective functions J minimums obtain the oval central coordinate of circle in the xoy planes
(x0_num, y0_num), major semiaxis length anum, semi-minor axis length bnum, long axis and x-axis angle thetanum:
WhereinIt can
With by x0_numInitial value be assigned to the x coordinate value in n number of contours strong point with the data point of maximum y-coordinate value, by y0_numJust
Value is assigned to that there is the y-coordinate value of the data point of maximum y-coordinate value to subtract the arc of circle face corresponding half in n number of contours strong point
Diameter r, by anumAnd bnumInitial value be assigned to r, the initial value of θ is assigned to 0.
Then C1 can be entered step.
Step C1 can obtain each and corresponding ellipse week in current num number of contours strong point for participating in ellipse fitting
Between absolute Euclidean distance errorj, j=i, i+1 ..., i+num-1.Specifically, error can be obtained based on following formulaj:
Wherein,
Then D1 can be entered step.
Step D1, if currently participated in absolute European between num number of contours strong point of ellipse fitting and corresponding oval week
Distance errorj, j=i, i+1 ..., i+num-1 are no more than measurement error threshold value error_measure, then E1 is entered step, it is no
Then enter step F1;
Step E1, it is believed that the num number of contours strong point is respectively positioned on same elliptic arc, and if flag=0,
Further record p (xi,yi) be starting point, that is, start (vertex)=i of the elliptic arc and flag=1 is set, it then can be into
Enter step G1;
Step F1, it is believed that the num number of contours strong point is not located on same elliptic arc, and if flag=1,
Further record p (xi+num-2,yi+num-2) be terminal, that is, finish (vertex)=i+num-2 of the elliptic arc and be arranged
Then vertex=vertex+1 and flag=0 can enter step G1;
Step G1 terminates if i+num-1=number;Otherwise i=i+1 is set, step B1 is returned to, to next group
Num outline data point is identified, until i+num-1=number.
Fig. 2 shows the rough screening schematic diagrames of data point of property embodiment according to an example of the present invention..
Step 4:Accurately screen out the error dot in each elliptic arc
Can in the middle part of the elliptic arc 60% data point, ellipse fitting is carried out to it (for example, can refer to the step in step 3
Rapid B1), judge before the elliptic arc 20% part and each point in the data point of rear 20% part with fit it is elliptical absolutely
Euclidean distance (for example, the step C1 that can refer in step 3 calculates absolute Euclidean distance).If some calculated data point pair
The absolute Euclidean distance answered is more than default error threshold, such as error_measure, then the data point is given up, it is accurate to realize
It screens out.
Step 5:Ellipse fitting is carried out for each elliptic arc after fine screen
Before carrying out ellipse fitting, can smoothing and Homogenization Treatments first be carried out to the data point after fine screen.
The smoothing may include:Choose the 30% of the remaining number of contours strong point that filtering window width is the elliptic arc, root
According to local regression method, the data point of the roomy small data quantity of spectral window is chosen successively, is obtained using weighted linear least square method
The second-order polynomial curve for making number of contours strong point point set optimal solution in filtering window width, to realize smoothing.
The homogenization may include:Calculate the maximum value x of the x coordinate value at the number of contours strong point after smoothing techniquesmaxWith
Minimum value xmin, in xmaxWith minimum value xminBetween be uniformly arranged new x coordinate value at a predetermined interval, obtained newly using spline interpolation
The corresponding y-coordinate value of x coordinate value, to realize homogenization.
Then ellipse fitting is carried out to the data point after smoothing and Homogenization Treatments.Specifically it can refer to above-mentioned steps 3
Approximating method in step B1, to determine corresponding elliptical characteristic parameter.The characteristic parameter includes elliptical center in the xoy
Position (can be indicated with coordinate (x, y) of the oval center of circle in the xoy planes) in plane, elliptical major semiaxis length
A, elliptical semi-minor axis length b, elliptical inclined direction (can be indicated with the angle theta of transverse and x-axis).This field skill
Art personnel can also be used any other applicable method and realize ellipse fitting.
Step 6:Obtain the pose of the columnar object section with round cambered surface corresponding with each elliptic arc identified
The real radius r of round cambered surface can be obtained according to oval semi-minor axis length breal;Transverse inclination angle theta is to justify
The axis of shape cambered surface is in the projection of xoy planes and the angle of x-axis;The axis and z-axis of round cambered surface according to the following formula can be obtained
Angle, wherein z-axis constitute left hand three-dimensional cartesian coordinate system with x-axis, y-axis:
Due to the characteristic of round cambered surface, the angle being rotated about axis need not consider, therefore solve above-mentioned five features ginseng
Number can determine the pose of the circle side plate bending.Position of the round cambered surface on the columnar object be it is changeless, therefore, can
Pose based on the circle side plate bending is inferred to the pose of corresponding columnar object section.
Step 7:Step 1~6 are repeated, until completing the measurement of entire columnar object
The sensor can be moved along the z-axis direction vertical with the xoy planes and execute above-mentioned steps 2~6 again, directly
To the measurement completed to the entire columnar object with round cambered surface.If the laser source point after certain movement and initial laser
Distance between source point is z, and it is (x, y) to calculate coordinate of the axis of round cambered surface in corresponding xoy planes, then relative to
The coordinate of initial three-dimensional cartesian coordinate system, the axis of the circle cambered surface and the intersection point of corresponding xoy planes is (x, y, z).Fig. 3 shows
The pose schematic diagram of the axis of the round cambered surface obtained after certain measurement is gone out.
The embodiment of the present invention is described above, above description is exemplary, and non-exclusive, and also not
It is limited to disclosed each embodiment.Without departing from the scope and spirit of illustrated each embodiment, for this technology
Many modifications and changes will be apparent from for the those of ordinary skill in field.The selection of term used herein, it is intended to
Best explain the principle, practical application or the improvement to the technology in market of each embodiment, or make the art its
Its those of ordinary skill can understand each embodiment disclosed herein.