Automatic fiber placement track geodesic curvature calculation method based on track point set
By traversing three adjacent points in the trajectory point set and calculating the tangent plane projection point to solve the geodesic curvature, the complexity and accuracy problems of traditional methods are solved, and the high-precision curvature calculation and defects of fiber wire are realized when laying wires. prevent.
Patent Information
- Application Number
- CN202410926362.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-11
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-07-11
AI Technical Summary
The traditional method has complicated steps when calculating the geodesic curvature of the silk laying trajectory, and it is difficult to obtain accurate results directly from the track point set information, resulting in the fiber wires being prone to wrinkles and other defects when the geodesic curvature is large.
By traversing three adjacent points in the trajectory point set, calculating the tangent plane projection point of the intermediate point and calculating the radius of curvature, directly solving the geodesic curvature from the point coordinates and vector information of the trajectory point set, suitable for the geodesics that do not require accurate acquisition of geodesics. The situation of curvature.
It is realized that the geodesic curvature is accurately calculated without increasing the computational complexity, and the absolute deviation of fiber wires when laying does not exceed 0.01mm, avoiding the occurrence of defects such as wrinkles.
Smart Images

Figure CN118965687A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the field of trajectory planning, and in particular relates to a method for calculating the geodesic curvature of an automatic wire laying trajectory based on a trajectory point set. Background Art
[0002] Laying trajectory planning refers to pre-planning the laying path to control the movement of the laying head on the laying surface. Since the laid fiber filaments have a certain width (common specifications are 6.35mm, 12.7mm, etc.), when laying a trajectory with a large geodesic curvature, the displacement of the two boundaries of the fiber filaments will have a large difference, which will cause defects such as wrinkles.
[0003] According to document 1: Fang Yiwu. Research on automatic wire placement technology for composite wing beams based on geodesic algorithm [D]. Nanjing University of Aeronautics and Astronautics, 2014. It is recorded that the minimum allowable geodesic curvature radius of CYCOM 5320-1FP / T40 / 800B fiber with a width of 6.35mm and a thickness of 0.125mm is about 1000mm.
[0004] In order to ensure that the geodesic curvature radius of the wire laying trajectory is not less than the allowable value, the geodesic curvature radius of the trajectory needs to be calculated. The traditional method calculates the geodesic curvature by differential method, and then finds the inverse to get the geodesic curvature radius; however, the storage of the wire laying trajectory is mostly a point set with normal vector and tangent vector information. This method needs to be fitted into a curve first, and then differentiated to solve, which is complicated. Summary of the invention
[0005] In response to the above problems, the present invention provides a method for calculating the geodesic curvature of an automatic wire placing trajectory based on a trajectory point set. The geodesic curvature is calculated directly through the point coordinates and vector information of the trajectory point set. Simulation shows that the absolute deviation between the straight line segment connected by the trajectory point set and the actual trajectory curve does not exceed 0.01 mm.
[0006] The method for calculating the geodesic curvature of the automatic wire laying trajectory based on the trajectory point set comprises the following specific steps:
[0007] Step 1: From each trajectory point that constitutes the trajectory, traverse the three adjacent trajectory points P in turn i-1 , P i and P i+1 ;
[0008] The initial value of i is 2;
[0009] Step 2: Based on the middle point P i The coordinates and normal vector of Calculate the point P i The tangent plane S;
[0010] The expression of the tangent plane S is: AX+BY+CZ+D=0;
[0011] A=N ix , B=N iy , C=N iz
[0012] D=-(AP ix +BP iy +CP iz )
[0013] Among them, (N ix , N iy , N iz ) is the normal vector The coordinates of (P ix , P iy , P iz ) is point P i The coordinate value of
[0014] Step 3: Set the middle point P i Two points before and after P i-1 and P i+1 Project onto the tangent plane S to obtain the corresponding projection point P′ i-1 and P′ i+1 ;
[0015] Step 4: Based on the projection point P′ i-1 and P′ i+1 Calculate the radius of curvature, that is, get the middle point P i The geodesic curvature radius R of a point, its reciprocal is the geodesic curvature;
[0016] The formula is:
[0017]
[0018] Among them, the intermediate variable is the projection point P′ i-1 Point to the middle point P i The vector of The middle point P i Pointing to the projection point P′ i+1 The vector of
[0019] Step 5: Increment the value of i by 1, and defer the three trajectory points to P in this way. i , P i+1 and P i+2 , return to step 2, repeat the above steps to continue to calculate the geodesic curvature of the current middle point, until the geodesic curvature of each trajectory point except the starting point and the end point is obtained;
[0020] Step 6: Correct the fiber placement trajectory according to the geodesic curvature of each trajectory point to prevent the fiber from wrinkling due to excessive geodesic curvature during placement.
[0021] The advantages of the present invention are:
[0022] The present invention can directly solve the geodesic curvature based on the information of the trajectory point set, and is suitable for situations where the geodesic curvature does not need to be accurately obtained. BRIEF DESCRIPTION OF THE DRAWINGS
[0023] Figure 1 The present invention is a flow chart of a method for calculating geodesic curvature of an automatic wire laying trajectory based on a trajectory point set.
[0024] Figure 2 It is a schematic diagram of the projection of three consecutive points onto the tangent plane.
[0025] Figure 3 This is a schematic diagram for calculating the radius of curvature from three consecutive points. DETAILED DESCRIPTION
[0026] The present invention will be further described in detail below with reference to the accompanying drawings and embodiments.
[0027] The present invention proposes a method for calculating the geodesic curvature of an automatic wire placing trajectory based on a trajectory point set. The geodesic curvature of the middle point is calculated based on three consecutive trajectory points. It is verified by simulation that the absolute deviation between the straight line segment connected by the trajectory point set and the actual trajectory curve does not exceed 0.01 mm.
[0028] like Figure 1 As shown, the specific steps are:
[0029] Step 1: From each trajectory point that constitutes the trajectory, traverse the three adjacent trajectory points P in turn 1 , P 2 and P 3 ;
[0030] If a curve is selected, call the GCPnts_QuasiUniformDeflection class of the Opencascade engine to discretize the track into trajectory points.
[0031] Step 2: Based on the middle point P 2 The coordinates and normal vector of Calculate the point P 2 The tangent plane S;
[0032] The expression of the tangent plane S is: AX+BY+CZ+D=0;
[0033] A=N 2x , B=N 2y , C=N 2z
[0034] D=-(AP 2x +BP 2y +CP 2z )
[0035] Among them, (N 2x , N 2y , N 2z ) is the normal vector The coordinates of (P 2x , P 2y , P 2z ) is point P 2 The coordinate value of .
[0036] Step 3: Set the middle point P 2 Two points before and after P 1 (P 1x , P 1y , P 1z ) and P 3 (P 3x , P 3y , P 3z ) is projected onto the tangent plane S to obtain the corresponding projection point P′ 1 (P′ 1x , P′ 1y , P′ 1z ) and P′ 3 (P′ 3x , P′ 3y , P′ 3z );
[0037] Step 4: Based on the projection point P′ 1 and P′ 3 Calculate the radius of curvature, that is, get the middle point P 2 The geodesic curvature radius R of a point, its reciprocal is the geodesic curvature;
[0038] The formula is:
[0039]
[0040] Among them, L 1 , L 2 is an intermediate variable; is the projection point P′ 1 Point to the middle point P 2 A vector of The middle point P 2 Pointing to the projection point P′ 3 vector; because the central angle and the opposite circumference angle are complementary, θ and The angles are equal.
[0041] Step 5: Return to step 1 and postpone the three trajectory points to P2 , P 3 and P 4 , repeat the above steps to find the geodesic curvature of the middle point until the last three points of the trajectory are reached, and the geodesic curvature of each trajectory point except the starting point and the end point is obtained;
[0042] Step 6: According to the geodesic curvature of each trajectory point, the fiber placement trajectory is corrected, such as selecting fiber filaments of other widths for placement (CN117238414A), to ensure that the fiber filaments will not cause wrinkles due to excessive geodesic curvature during placement.
[0043] Example:
[0044] The specific steps are:
[0045] S100: Input the Kth trajectory point set P{n} with normal vector N and tangent vector t; i=0;
[0046] S110: Take three consecutive points P[i], P[i+1], P[i+2];
[0047] S120: Project P[i], P[i+2] onto the tangent plane of P[i+1] to obtain P[i]', P[i+2]';
[0048] S130: Calculate the curvature radius R of P[i+1] through the three points P[i]', P[i+1], and P[i+2]', and the reciprocal of the curvature radius R is the geodesic curvature of P[i+1];
[0049] S140: Add 1 to i and repeat steps S110-S130 to obtain the geodesic curvature radius of each point on the trajectory.
[0050] Figure 2 FIG. 1 is a schematic diagram of the projection of the three consecutive points onto the tangent plane described in S120, in which P 1 , P 2 , P 3 are three consecutive points, the plane S is P 2 The tangent plane, P′ 1 P 1 Projection on plane S, P′ 3 P 3 The projection on plane S is calculated as follows:
[0051] P 1 (P 1x , P 1y , P 1z ), P 2 (P 2x , P 2y , P 2z ), P 3 (P3x , P 3y , P 3z ), P′ 1 (P′ 1x , P′ 1y , P′ 1z ), P′ 3 (P′ 3x , P′ 3y , P′ 3z )
[0052] Tangent plane S: AX + BY + CZ + D = 0, A = N 2x , B = N 2y , C = N 2z , D = -(AP 2x + BP 2y + CP 2z )
[0053] E = A 2 + B 2 + C 2
[0054] P′ 1x = ((B 2 + C 2 ) * P 1x - A * (B * P 1y + C * P 1z + D)) / E
[0055] P′ 1y = ((A 2 + C 2 ) * P 1y - B * (A * P 1x + C * P 1z + D)) / E
[0056] P′ 1z = ((B 2 + A 2 ) * P 1z - C * (B * P 1y + A * P 1x + D)) / E
[0057] P′ 3x = ((B 2 + C 2 ) * P 3x - A * (B * P 3y + C * P 3z + D)) / E
[0058] P′ 3y = ((A 2 + C 2 ) * P3y -B*(A*P 3x +C*P 3z +D)) / E
[0059] P′ 3z =((B 2 +A 2 )*P 3z -C*(B*P 3y +A*P 3x +D)) / E
[0060] Figure 3 The figure shows a schematic diagram of calculating the curvature radius from three consecutive points in S130. 1 , P 2 , P 3 is three consecutive points, namely P′ after S120 projection 1 , P 2 , P′ 3 , and its calculation formula is:
[0061]
[0062]
Claims
1. A method for calculating geodesic curvature of an automatic wire laying trajectory based on a trajectory point set, characterized in that: The specific steps are as follows: Step 1: From each trajectory point that constitutes the trajectory, traverse the three adjacent trajectory points P in turn i-1 , P i and P i+1 ; The initial value of i is 2; Step 2: Based on the middle point P i The coordinates and normal vector of Calculate the point P i The tangent plane S; The expression of the tangent plane S is: AX+BY+CZ+D=0; A=N ix ,B=N iy ,C=N iz D=-(AP ix +BP iy +CP iz ) Among them, (N ix ,N iy ,N iz ) is the normal vector The coordinates of (P ix ,P iy ,P iz ) is point P i The coordinate value of Step 3: Set the middle point P i Two points before and after P i-1 and P i+1 Project onto the tangent plane S to obtain the corresponding projection point P′ i-1 and P′ i+1 ; Step 4: Based on the projection point P′ i-1 and P′ i+1 Calculate the radius of curvature, that is, get the middle point P i The geodesic curvature radius R of a point, its reciprocal is the geodesic curvature; The formula is: Among them, the intermediate variable is the projection point P′ i-1 Point to the middle point P i The vector of The middle point P i Pointing to the projection point P′ i+1 The vector of Step 5: Increment the value of i by 1, and defer the three trajectory points to P in this way. i , P i+1 and P i+2 , return to step 2, repeat the above steps to continue to calculate the geodesic curvature of the middle point, until the geodesic curvature of each trajectory point except the starting point and the end point is obtained; Step 6: According to the geodesic curvature of each trajectory point, the fiber placement trajectory is corrected to prevent the fiber from wrinkling due to excessive geodesic curvature during placement.
Citation Information
Patent Citations
Fiber reinforced rebar with shaped sections and a concrete panel including the shaped rebar sections
CN103459125A
Special-shaped cabin with high lift-drag ratio aerodynamic shape and preparation method of special-shaped cabin
CN115258126A
Method for planning and designing wire placement forming trajectory of normal Gaussian curved surface orthogonal frame
CN115688462A
Automatic fiber placement curve placement track algorithm based on bearing information
CN117195638A
Curved-surface variable-bandwidth automatic fiber placement forming trajectory planning design method and storage medium thereof
CN117238414A
