Invention content
The purpose of the present invention is to provide double ends to lay post-processing approach, and the present invention moves the coordination between Liang Ge robots
It decouples, to reduce postpositive disposal difficulty.
The technical solution adopted in the present invention is to follow the steps below:
(1) first track data is pre-processed, establishes main shaft coordinate system B so that each axis is directed toward and robot basis coordinates
System is consistent, and envelope model is transformed under main shaft coordinate system and indicates on mold axis of rotation by coordinate origin, if mold is believed
Ceasing transformation matrix isFor space point (x, y, z)I, coordinate of this under main shaft coordinate system be:
(2) piddler wrist dot position information can be obtained along normal direction extension 900mm to all data points in trace information, from
Normal direction information unit vector Normal (x are extracted in track datan, yn, zn), for certain point (x on moldm, ym, zm), it obtains outer
The wrist point information (x delayedw, yw, zw), being write as component form is:
(3) to the wrist point data in each track, characteristic point is extracted in the directions z in an axial direction, extracting method is defined, for rail
Mark 1, judges whether next point is more than the value of some setting along the difference of z and a1 point by point since boundary point a1, is denoted as row
This point is denoted as a2, so analogizes, all characteristic points are all extracted by wide ξ if it is greater than ξ;
(4) for two characteristic points T1i, T2i in different two tracks along normal direction extension handle to obtain control point ki,
Mi is rotated around the spindle and is intersected to obtain ki', mi', ki ", mi " with both sides envelope curve bound respectively;
(5) time synchronization;When carrying out laying processing on complex-curved mold, adaptation allocation processing is being carried out to track
Before, the tracing point because changing greatly place with regard to curvature of curved surface first carries out densification so that is moved more by postpositive disposal to each axis
To be steady, and the reference that normal vector can change as curvature of curved surface in tracing point information, set the Curvature varying value of permission i.e.
Normal vector variable quantity is ε, is coordinated for two pairing tracing points by inserting point.
Further, in step (4), the track matched to two is verified point by point by period, until all point search finish, with
This filter criteria matched as track, according to being mutually matched to the discrete layering of three-dimensional CAD track data for length feed rate
Slice carries out the planning that dual trace adapts to cooperation by coordinating two track discrete point spacing.
Further, in step (5), determine that the step of inserting point position is as follows:
(1) it will first need to import with the tracing point information of processing;
(2) angle α between two neighboring tracing point per unit system arrow is found out, is become for characterizing the curved surface normal direction curvature at 2 points
Change;
(3) if α>ε, the then point to be inserted of label one between this 2 points;
(4) if also tracing point, then following two is taken, continues second step;Otherwise, terminate to insert point.
Specific implementation mode
The present invention is described in detail With reference to embodiment.
It is class swivel verification mold structure die shape as shown in Figure 1, Fig. 2 is class swivel verification mold structure die axis,
Fig. 3 is double laying apparatus layouts.Process method step of the present invention is as follows:
(1) reference frame of initial trace information is the coordinate system of catia digital-to-analogues, the coordinate system and robot basis coordinates
It is that each axis is directed toward possible difference.Therefore, it needs first to pre-process track data before verifying operation, establishes new mold
Coordinate system B (main shaft coordinate system) is so that each axis is directed toward is consistent with robot basis coordinates system, and coordinate origin is in mold rotating shaft
On line.Envelope model is transformed under main shaft coordinate system and is indicated, the calculating of position relationship is simplified.If die information transformation matrix isFor space point (x, y, z)I, coordinate of this under main shaft coordinate system be:
(2) piddler wrist dot position information can be obtained along normal direction extension 900mm to all data points in trace information.From
Normal direction information unit vector Normal (x are extracted in track datan, yn, zn), for certain point (x on moldm, ym, zm), it obtains outer
The wrist point information (x delayedw, yw, zw), being write as component form is:
(3) it is that characteristic point is extracted in the directions z in an axial direction to the wrist point data in each track.Extracting method is defined, when
Basis for estimation is provided for trace scheduling legitimacy, second is that for the generation service of initial solution.Consider for simplifying to calculate, for track
1, judge whether next point is more than the value of some setting along the difference of z and a1 point by point since boundary point a1, is denoted as col width
ξ.If it is greater than ξ, this point is denoted as a2, so analogizes, all characteristic points is all extracted.
(4) for two characteristic points T1i, T2i in different two tracks along normal direction extension handle to obtain control point ki,
Mi is rotated around the spindle and is intersected to obtain ki', mi', ki ", mi " with both sides envelope curve bound respectively.As shown in figure 4, O
Point is mold main-shaft core point.
Presence due to main shaft as redundant axes, in theory, if O is crossed at the corresponding control point in two tracks
Point angle can be in the section (α, β), can be reachable by so that two characteristic points can be in robot to the processing of main shaft
In space.The track matched to two is verified point by point by period, until all point search finish, in this, as the sieve of track pairing
It makes an accurate selection of then.It uses for reference Layered manufacturing, add up molding principle.According to being mutually matched to three-dimensional CAD track number for length feed rate
According to discrete hierarchy slicing, the planning that dual trace adapts to cooperation is carried out by coordinating two track discrete point spacing.
(5) time synchronization;Step (1)-(4) carry out the predistribution of class swivel mold laying track, by the paving of full die
It puts track and distributes to two lay robots, two tracks for being directed to while laying again after being assigned carry out tracing point adaptation and match
It closes i.e. densification or deletes an operation, to reach time synchronization effect.
When carrying out laying processing on complex-curved mold, the track theoretically generated should lay pressure roller and mold table
A kind of space curve that millet cake contact is constituted.But in actual processing, due to the limitation of CNC digital control system interpolation abilities, paving
Put what track was made of a section straight line connection.Obviously, the processing quality of the step-length selection and lay operation of machining locus
There is close association with processing efficiency.Higher depositing speeds can be obtained by improving step-length, but step-length, which crosses conference, leads to end
Movement locus generates apparent bending, especially goes out the more prominent of performance in the larger complex profile of Curvature varying, makes lay table
Face quality declines.In order to reach preferable precision, needs to carry out cumbersome follow-up trajectory processing work, reduce whole efficiency.But
It is that step-length selects the too small program structure that can make lay algorithm complicated, consumes memory, the process data being calculated is also more,
It influences to lay efficiency.
In the present invention, the mutual association of dual robot axially engaged mainly by robot base length feed rate
It transfers to complete, then completes the postpositive disposal of each axis of coordination system on this basis.Before carrying out adaptation allocation processing to track,
Tracing point because changing greatly place with regard to curvature of curved surface first carries out densification so that is moved by postpositive disposal to each axis more flat
Surely.And the reference that normal vector can change as curvature of curved surface in tracing point information, set the Curvature varying value i.e. normal direction of permission
Amount variable quantity is ε, is coordinated for two pairing tracing points by inserting point.Determine that the step of inserting point position is as follows:
(1) it will first need to import with the tracing point information of processing.
(2) angle α between two neighboring tracing point per unit system arrow is found out, is become for characterizing the curved surface normal direction curvature at 2 points
Change.
(3) if α>ε, the then point to be inserted of label one between this 2 points.
(4) if also tracing point, then following two is taken, continues second step;Otherwise, terminate to insert point.
The present invention is cut with the length feed cooperation of two robots of step-length selection control, by model track in axially progress adaptability
Piece ensures that only there are one tracing points for two tracks between being sliced at every two layers.In this way, being carried out on the basis of being pre-processed by track
When postpositive disposal, so that it may to convert two-shipper people's three dimensions coordination constraint ability to two dimensional surface problem.What algorithm to be determined
It is that the track that tracing point is constituted is selected according to the step-length in z-axis direction, by the curvature of upper analysis step-length selection and model surface each point
It is related.And the curvature feature of curved surface can be characterized with the normal vector of each point.If ni=(xi, yi, zi) be tracing point normal direction
Amount, due to normal direction magnitude in CAD trail filesIt is vectorial for unit, so | zi| represent niIn z
The size of axial projection's value, ziPositive and negative show method of loci vector niIn the direction of z-axis projection.
As shown in figure 5, track adapts to hop algorithm be the normal vector for searching out two pairing tracks in each step-length unit
Tracing point Traj [i] .point [m] and its normal vector n changed greatlyi.When determining step-length with tracing point Traj [i]
.point [m] and its normal vector niAs adaptability distribution parameter, here Traj [m] refer to the m articles track.Wherein Traj [i]
.point [m] is program language, refers to m-th of tracing point in i-th track, and algorithm basic step is as follows:
(1) initial step length is taken to set pw=0, pmax is step-length maximum value, and pmin is the minimum value of step-length, m=0, pmax
It is acquired with minimum step by the maximum step-length in two initial traces with pmin, Ha, Hb are the upper limit of the z values in a certain step-length section
And lower limit.
(2) search point [m] arrives the normal vector changing value of the section tracks Nei Liangtiao point [m+1], chooses normal direction quantitative change
Change larger track to be used as with reference to calculating in point [m] to the section point [m+1] endoadaptation step-length pw.
(3) point [m+1] in initial trace Traj [i] is assigned to T1, step-length section (Ha, Hb) where calculating pw,
And whether operative cooperation track Traj [j] contains tracing point in this section.If there is then by Traj [j] .point [m+1] point
Data assign T2, otherwise carry out inserting point processing to track Traj [j] at Hb.
(4) judge whether tracing point traverses completion, if not completing the processing operation of all tracing points, turn (2).Such as
Fruit completes the adaptation processing of all tracing points, turns (5).
(5) output adapts to two tracks T1, T2 that cooperation processing is completed;
The present invention is to grind with the laying forming of more complex class body member from robot coordinated space constraint is laid
Study carefully object, research dual robot parallel system coordinates to complete the motion planning problem of such operation, and detailed analysis is same in the time
The track distribution method of step and space up to robot coordinated running under two constraintss.It generates and processes in CAD segregation reasons
After the processed file of track, track reallocation is carried out by dynamic constrained of effective impulse stroke of double SCM, by two machines
Coordination decoupling between device people, to reduce postpositive disposal difficulty.
The above is only the better embodiment to the present invention, not makees limit in any form to the present invention
System, every any simple modification that embodiment of above is made according to the technical essence of the invention, equivalent variations and modification,
Belong in the range of technical solution of the present invention.