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.

CN118965687AActive Publication Date: 2024-11-15BEIHANG UNIV
View PDF 5 Cites 0 Cited by

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

Technical Problem

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.

Method used

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.

Benefits of technology

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.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118965687A_ABST
    Figure CN118965687A_ABST
Patent Text Reader

Abstract

The invention discloses an automatic fiber placement track geodesic curvature calculation method based on a track point set, and belongs to the field of track planning. The method specifically comprises the steps that three adjacent track points Pi-1, Pi and Pi + 1 are traversed in sequence; calculating a tangent plane S of the point Pi based on the coordinate value of the intermediate point Pi and a normal vector # imgabs0 # thereof; then, two points Pi-1 and Pi + 1 before and after the middle point Pi are projected to a tangent plane S, and corresponding projection points P'i-1 and P'i + 1 are obtained; the curvature radius is calculated based on the projection points P'i-1 and P 'i + 1, namely, the geodesic curvature radius R of the middle point Pi is obtained, and the reciprocal of the geodesic curvature radius R is the geodesic curvature; the value of i is increased by 1, the three track points are sequentially extended to Pi, Pi + 1 and Pi + 2, and the steps are repeated until the geodesic curvature of each track point except the starting point and the ending point is obtained; finally, according to the geodesic curvature of each track point, the fiber laying track is corrected, and the situation that when the fiber is laid, wrinkles are caused due to the fact that the geodesic curvature is too large is avoided. The method is suitable for the condition that the geodesic curvature does not need to be accurately obtained.
Need to check novelty before this filing date? Find Prior Art

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