CN116049995B - Special mechanism collision prediction method based on virtual prototype in interstage separation test - Google Patents

Special mechanism collision prediction method based on virtual prototype in interstage separation test Download PDF

Info

Publication number
CN116049995B
CN116049995B CN202310245488.3A CN202310245488A CN116049995B CN 116049995 B CN116049995 B CN 116049995B CN 202310245488 A CN202310245488 A CN 202310245488A CN 116049995 B CN116049995 B CN 116049995B
Authority
CN
China
Prior art keywords
triangular
detected
model
virtual prototype
collision
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.)
Active
Application number
CN202310245488.3A
Other languages
Chinese (zh)
Other versions
CN116049995A (en
Inventor
魏志
谢志江
郑晓东
宋代平
周波
黄叙辉
欧德明
周海
蒙红宇
罗惠方
王志宾
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
High Speed Aerodynamics Research Institute of China Aerodynamics Research and Development Center
Original Assignee
Chongqing University
High Speed Aerodynamics Research Institute of China Aerodynamics Research and Development Center
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Chongqing University, High Speed Aerodynamics Research Institute of China Aerodynamics Research and Development Center filed Critical Chongqing University
Priority to CN202310245488.3A priority Critical patent/CN116049995B/en
Publication of CN116049995A publication Critical patent/CN116049995A/en
Application granted granted Critical
Publication of CN116049995B publication Critical patent/CN116049995B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/10Geometric CAD
    • G06F30/15Vehicle, aircraft or watercraft design
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F9/00Arrangements for program control, e.g. control units
    • G06F9/06Arrangements for program control, e.g. control units using stored programs, i.e. using an internal store of processing equipment to receive or retain programs
    • G06F9/44Arrangements for executing specific programs
    • G06F9/455Emulation; Interpretation; Software simulation, e.g. virtualisation or emulation of application or operating system execution engines
    • G06F9/45533Hypervisors; Virtual machine monitors
    • G06F9/45558Hypervisor-specific management and integration aspects
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00Three dimensional [3D] modelling, e.g. data description of 3D objects
    • G06T17/20Finite element generation, e.g. wire-frame surface description, tesselation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T19/00Manipulating 3D models or images for computer graphics
    • G06T19/003Navigation within 3D models or images
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/80Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
    • G06T7/85Stereo camera calibration
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2210/00Indexing scheme for image generation or computer graphics
    • G06T2210/21Collision detection, intersection
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Software Systems (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Computer Graphics (AREA)
  • Evolutionary Computation (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Mathematical Analysis (AREA)
  • Computational Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

The invention belongs to the field of aerospace and discloses a special mechanism collision prediction method based on a virtual prototype in an interstage separation test. The special mechanism collision prediction method establishes a three-dimensional digital model of a test section, a mechanism and a separator, and is used for predicting collision prediction in the test process; a virtual machine system which is independent of a control system and better in graphic calculation is established, the virtual machine system communicates through a high-speed communication protocol, and PLC resources can be occupied less when collision prediction is carried out; the real-time display is carried out through the OpenGL or DirectX technology of the computer, so that a user can monitor the whole motion process in real time and even manually intervene in collision prediction; when the triangular patch primitives are intersected and calculated, only triangular patches with the triangular patch speed direction being the same as the normal direction of the triangular patches are detected, so that the efficiency is improved. The collision prediction method of the special mechanism can be used for carrying out real-time collision prediction with high precision, and the safety of interstage separation is improved.

Description

Special mechanism collision prediction method based on virtual prototype in interstage separation test
Technical Field
The invention belongs to the field of aerospace, and particularly relates to a special mechanism collision prediction method based on a virtual prototype in an interstage separation test.
Background
The aircraft has complex aerodynamic phenomenon in the process of separating the multiple bodies, and the stress among the multiple bodies is very complex, so that the multiple bodies generate complex flight tracks, and if the separated gesture positions are unreasonable, the multiple bodies are easily separated and then meet to generate serious separation accidents. In order to obtain a reliable separation track, the separation track of the multi-body of each separation stage of the aircraft needs to be simulated more truly through a wind tunnel test so as to guide the structure of the aircraft and design a separation strategy.
The virtual prototype technology is a simulation method which utilizes a high-precision three-dimensional model established based on a physical model and establishes a mapping relation corresponding to the position of a driving joint of an actual mechanism. The virtual prototype technology has the characteristics of real-time and system bidirectional interaction and real-time feedback, and is widely applied to the aerospace, national defense industry and other fields.
In performing the interstage separation test, the trajectory of the interstage separation mechanism is calculated in real time by the system based on real-time aerodynamic data, and the trajectory of the interstage separation is not known until the test is performed. The space in the test section of the wind tunnel is narrow, and the mechanism and various devices of the test section of the wind tunnel have collision risks. The collision prediction which is mature at present often adopts a bounding box form, and the method has low precision on an aircraft model with a complex appearance. In view of the fact that sub-millimeter-scale spacing is possible between interstage separations, conventional bounding box collision prediction methods are not applicable.
Currently, development of a special mechanism collision prediction method based on a virtual prototype in an interstage separation test is urgently needed
Disclosure of Invention
The invention aims to provide a special mechanism collision prediction method based on a virtual prototype in an interstage separation test, which overcomes the defects of the prior art.
The invention discloses a special mechanism collision prediction method based on a virtual prototype in an interstage separation test, which comprises the following steps of:
s10, establishing a virtual prototype three-dimensional model according to a mechanism to be detected;
the virtual prototype three-dimensional model comprises a mechanism model to be detected and a spray pipe model; the mechanism model to be detected comprises a yaw mechanism model, a pitch mechanism model and a roll mechanism model;
s20, setting each driving joint in the mechanism model to be detected as a position input variable;
s30, acquiring a position input variable, and establishing a mapping relation between a mechanism model to be detected and the positions of all driving joints in the mechanism to be detected;
s40, calibrating the three-dimensional model of the virtual prototype according to a calibration standard, namely calibrating the virtual machine system;
s50, carrying out an interstage separation test on the mechanism to be detected, and synchronizing the motions of the mechanism to be detected and the virtual prototype three-dimensional model in real time;
s60, carrying out frame segmentation on the motion of the mechanism to be detected and the virtual prototype three-dimensional model, and predicting the pose and the speed of the nth frame of the virtual prototype three-dimensional model according to the motion position, the speed and the acceleration of the current frame of the virtual prototype three-dimensional model;
s70, predicting collision conditions of a mechanism model to be detected and a spray pipe model in an nth frame in the future by using a primitive intersection method;
s80, returning the collision condition of the nth frame in the future to a motion control system of the mechanism to be detected, and making a motion decision of the mechanism to be detected.
Further, the mechanism model to be detected and the spray pipe model are wrapped by triangular patches.
Further, the calibration standard of the three-dimensional model of the virtual prototype is as follows: the initial pose of the mechanism to be detected and the initial pose of the virtual prototype three-dimensional model are completely consistent, and the relative pose of each driving joint of the mechanism to be detected and the virtual prototype three-dimensional model are completely consistent.
Further, the standard for performing frame segmentation on the motion of the mechanism to be detected and the virtual prototype three-dimensional model is as follows: the three-dimensional model of the virtual prototype predicts the pose and the speed of the nth frame of the three-dimensional model of the virtual prototype according to the motion position, the speed and the acceleration of the current frame, and the time required for obtaining the pose and the speed of the nth frame of the three-dimensional model of the virtual prototype is less than the time for one frame of motion of a mechanism to be detected.
Further, the motion acceleration of the virtual prototype three-dimensional model is set to be a constant value.
Further, the virtual prototype three-dimensional model is displayed through an open graphics library OpenGL or DirectX based technology.
Further, the motion decision includes: if collision is predicted, gradually reducing the speed of the mechanism to zero; if no collision is predicted, the mechanism continues to move according to the planned track.
Further, the step of predicting the collision condition of the mechanism model to be detected and the spray pipe model in the nth frame in the future by using the primitive intersection method includes:
s71, recording two triangular patches to be detected asT 1 AndT 2 the method comprises the steps of carrying out a first treatment on the surface of the Which is a kind ofMiddle triangular surface patchT 1 Belongs to a mechanism model to be detected, triangular surface patchT 2 Belongs to a spray pipe model;
triangular face plateT 1 Is defined by three vertexes
Figure SMS_11
Figure SMS_1
Figure SMS_7
The method comprises the steps of carrying out a first treatment on the surface of the Triangular face plateT 2 Is +.>
Figure SMS_3
Figure SMS_10
Figure SMS_12
; wherein ,
Figure SMS_16
Is vertex->
Figure SMS_9
Coordinates of (c);
Figure SMS_13
Is vertex->
Figure SMS_2
Coordinates of (c);
Figure SMS_6
is vertex->
Figure SMS_14
Coordinates of (c);
Figure SMS_18
Is vertex->
Figure SMS_15
Coordinates of (c);
Figure SMS_17
Is vertex->
Figure SMS_4
Coordinates of (c);
Figure SMS_5
Is vertex->
Figure SMS_8
Coordinates of (c);
s72, calculating parameters
Figure SMS_19
Parameter->
Figure SMS_20
Parameters and parameters
Figure SMS_21
The method comprises the following steps: />
Figure SMS_22
S73, judging parameters
Figure SMS_23
Parameter->
Figure SMS_24
Parameters and parameters
Figure SMS_25
Whether the same number is not 0, if so, the triangular surface patchT 1 And triangular dough pieceT 2 No intersection occurs in the n-th frame in the future, otherwise, step S74 is entered;
s74, judging parameters
Figure SMS_26
Parameter->
Figure SMS_27
Parameters and parameters
Figure SMS_28
If the numbers are the same and are 0, the step S75 is carried out, otherwise, the step S76 is carried out;
s75, triangular dough pieceT 1 And triangular dough pieceT 2 The vertex coordinates of (2) are converted into two-dimensional coordinates to obtain
Figure SMS_29
Figure SMS_30
Figure SMS_31
Figure SMS_32
Figure SMS_33
Figure SMS_34
By triangular patchesT 1 Any one of the edges of (a)
Figure SMS_35
Establish the linear parameter equation ax+by+c=0 and fit the triangular patchesT 1 And triangular dough pieceT 2 Substituting the two-dimensional vertex coordinates of the two-dimensional vertex into a linear parameter equation to obtain:
Figure SMS_36
if the parameters are
Figure SMS_37
Parameter->
Figure SMS_38
Parameters are the same as the number and are the same as the parameters->
Figure SMS_39
Different numbers, triangular dough pieceT 1 And triangular dough pieceT 2 No intersection occurs in the future nth frame, otherwise, the triangular patchT 1 And triangular dough pieceT 2 Crossing in the future nth frame;
s76, in the triangular dough sheetT 1 On which a coordinate system O is established 1 X 1 Y 1 And putting triangular dough sheetT 1 And triangular dough pieceT 2 Conversion of vertex coordinates to coordinate System O 1 X 1 Y 1 In (a) and (b); judging straight line
Figure SMS_40
Straight line->
Figure SMS_41
Straight line->
Figure SMS_42
With O 1 X 1 Y 1 Intersection point P of planes 1 Intersection point P 2 Intersection point P 3 In (c) whether there is a triangle>
Figure SMS_43
Inside and at triangle->
Figure SMS_44
Intersection on one side, if yes, triangular surface patchT 1 And triangular dough pieceT 2 Crossing in the future nth frame, otherwise, proceeding to step S77; />
S77, in triangular dough pieceT 2 On which a coordinate system O is established 2 X 2 Y 2 And putting triangular dough sheetT 1 And triangular dough pieceT 2 Conversion of vertex coordinates to coordinate System O 2 X 2 Y 2 In (a) and (b); judging straight line
Figure SMS_45
Straight line->
Figure SMS_46
Straight line->
Figure SMS_47
With O 2 X 2 Y 2 Intersection point P of planes 4 Intersection point P 5 Intersection point P 6 In (c) whether there is a triangle>
Figure SMS_48
Inside and at triangle->
Figure SMS_49
Intersection on one side, if yes, triangular surface patchT 1 And triangular dough pieceT 2 Intersecting in the future nth frame, if not, then triangular patchesT 1 And triangular dough pieceT 2 No intersection occurs in the future nth frame;
s78, updating the triangular dough piece to be detectedT 1 And triangular dough pieceT 2 And returning to the step 1) until determining whether each triangular patch to be detected in the mechanism model to be detected and all triangular patches to be detected of the spray pipe model intersect in the future nth frame, and further judging whether the mechanism model to be detected and the spray pipe model collide in the future nth frame.
Further, the collision prediction includes: if a certain triangular patch to be detected exists in the mechanism model to be detected and the nozzle model, the mechanism model to be detected and the nozzle model collide in the future nth frame;
if all triangular patches in the mechanism model to be detected and the spray pipe model are not intersected in the future nth frame, the mechanism model to be detected and the spray pipe model are not collided in the future nth frame.
Further, the triangular patches to be detected comprise triangular patches with the same speed direction as the normal direction.
The special mechanism collision prediction method based on the virtual prototype in the interstage separation test has the following characteristics: establishing a high-precision three-dimensional model in the virtual machine according to requirements, and wrapping by using triangular patches; establishing a mapping relation between each driving joint position in the virtual prototype and each driving joint position of the actual mechanism; calibrating a virtual machine system; an interstage separation test was performed. Cutting the mechanism motion into a plurality of frame motions in 1 second by taking a frame as a unit, and synchronizing each frame motion of the actual model and the virtual prototype model in real time; in the virtual prototype, according to the motion position and the speed of the previous frame, predicting acceleration data to obtain pose and speed data of the next frame; obtaining the pose condition of the predicted frame according to the intersecting calculation of the graphic elements, and obtaining the collision condition of a mechanism and a model under the predicted frame; and the virtual prototype returns collision information of the predicted frame to the motion control system to carry out motion decision.
In short, the special mechanism collision prediction method based on the virtual prototype in the interstage separation test establishes a high-precision three-dimensional digital model of the whole test section, mechanism and separator, and is used for predicting the collision prediction in the test process; a virtual machine system which is independent of a control system and better in graphic calculation is established, the virtual machine system communicates through a high-speed communication protocol, and PLC resources can be occupied less when collision prediction is carried out; the method is characterized in that the method is displayed in real time through a computer OpenGL or DirectX technology, so that a user can monitor the whole motion process in real time and even perform human intervention collision prediction; when the triangular patch primitives are intersected and calculated, only triangular patches with the triangular patch speed direction being the same as the normal direction of the triangular patches are detected, so that the collision prediction accuracy is ensured, and meanwhile, the efficiency is improved. The special mechanism collision prediction method based on the virtual prototype in the interstage separation test can perform real-time collision prediction with high precision, and improves the safety of the whole interstage separation.
Drawings
FIG. 1 is a flow chart of a collision prediction method for a virtual prototype-based agency collision prediction in an interstage separation test of the present invention;
FIG. 2a is a physical model used in the virtual prototype-based method for predicting the collision of a special mechanism in the interstage separation test of the invention;
FIG. 2b is a schematic view of a three-dimensional digital model built in a virtual prototype of the virtual prototype-based method for predicting a collision of a special mechanism in an interstage separation test of the present invention;
FIG. 3a is a schematic view of the normal direction and the movement direction (first movement direction) of a triangle established by the virtual prototype-based mechanism collision prediction method in the interstage separation test of the present invention;
FIG. 3b is a schematic view of the normal direction and the movement direction (second movement direction) of a triangle established by the virtual prototype-based mechanism collision prediction method in the interstage separation test of the present invention;
FIG. 3c is a schematic view of the normal direction and the movement direction (third movement direction) of a triangle established by the virtual prototype-based mechanism collision prediction method in the interstage separation test of the present invention;
fig. 4 is a schematic diagram of the intersection calculation of the triangle on the opposite sides in the collision prediction method of the special mechanism based on the virtual prototype in the interstage separation test of the invention.
In the figure, 1. A spray pipe in a wind tunnel test; 2. a physical model in a wind tunnel test; 3. an actuator; 4. a mechanism model to be detected; 5. and (5) a spray pipe model.
Description of the embodiments
The present invention is further described below with reference to examples, but it should not be construed that the scope of the above subject matter of the present invention is limited to the following examples. Various substitutions and alterations are made according to the ordinary skill and familiar means of the art without departing from the technical spirit of the invention, and all such substitutions and alterations are intended to be included in the scope of the invention.
Example 1
As shown in fig. 1, the method for predicting the collision of the special mechanism based on the virtual prototype in the interstage separation test of the embodiment comprises the following steps:
s10, establishing a virtual prototype three-dimensional model according to a mechanism to be detected; the virtual prototype three-dimensional model comprises a mechanism model 4 to be detected and a spray pipe model 5; the mechanism model 4 to be detected comprises a yaw mechanism model, a pitch mechanism model and a roll mechanism model;
the mechanism model 4 to be detected and the spray pipe model 5 are wrapped by triangular patches.
The virtual prototype three-dimensional model is displayed through an open graphics library OpenGL or DirectX based technology.
S20, setting each driving joint in the mechanism model 4 to be detected as a position input variable;
s30, acquiring a position input variable, and establishing a mapping relation between a mechanism to be detected model 4 and the positions of all driving joints in the mechanism to be detected;
s40, calibrating the three-dimensional model of the virtual prototype, namely calibrating a virtual machine system;
the standard for completing the calibration of the three-dimensional model of the virtual prototype comprises the following steps: the initial pose of the mechanism to be detected is completely consistent with that of the virtual prototype three-dimensional model, and the relative pose of each driving joint of the mechanism to be detected is completely consistent with that of the virtual prototype three-dimensional model;
s50, carrying out an interstage separation test on the mechanism to be detected, and synchronizing the motions of the mechanism to be detected and the virtual prototype three-dimensional model in real time;
s60, carrying out frame segmentation on the motion of the mechanism to be detected and the virtual prototype three-dimensional model, and predicting the pose and the speed of the nth frame of the virtual prototype three-dimensional model in the future through C++ software according to the motion position, the speed and the acceleration of the current frame of the virtual prototype three-dimensional model; the C++ software stores a program for predicting the pose and the speed in advance;
the frame segmentation criteria for the motion of the mechanism to be detected and the virtual prototype three-dimensional model include: the three-dimensional model of the virtual prototype predicts that the time required for obtaining the pose and the speed of the future nth frame of the three-dimensional model of the virtual prototype is less than the time required for one frame of motion of a mechanism to be detected according to the motion position, the speed and the acceleration of the current frame;
setting the motion acceleration of the three-dimensional model of the virtual prototype as a constant value;
s70, predicting the collision condition of the mechanism model 4 to be detected and the spray pipe model 5 in the nth frame in the future by using a primitive intersection method;
the step of predicting the collision condition of the mechanism model 4 to be detected and the spray pipe model 5 in the nth frame in the future by using the primitive intersection method comprises the following steps:
s71, recording two triangular patches to be detected asT 1 AndT 2 the method comprises the steps of carrying out a first treatment on the surface of the Wherein, triangular dough pieceT 1 Belonging to waiting forDetecting mechanism model 4, triangular dough pieceT 2 Belonging to the nozzle model 5;
triangular face plateT 1 Is defined by three vertexes
Figure SMS_58
Figure SMS_50
Figure SMS_56
The method comprises the steps of carrying out a first treatment on the surface of the Triangular face plateT 2 Is +.>
Figure SMS_61
Figure SMS_65
Figure SMS_66
; wherein ,
Figure SMS_67
Is vertex->
Figure SMS_59
Coordinates of (c);
Figure SMS_64
Is vertex->
Figure SMS_51
Coordinates of (c);
Figure SMS_55
is vertex->
Figure SMS_52
Coordinates of (c);
Figure SMS_54
Is vertex->
Figure SMS_60
Coordinates of (c);
Figure SMS_63
Is vertex->
Figure SMS_53
Coordinates of (c);
Figure SMS_57
Is vertex->
Figure SMS_62
Coordinates of (c);
s72, calculating parameters
Figure SMS_68
Parameter->
Figure SMS_69
Parameters and parameters
Figure SMS_70
The method comprises the following steps:
Figure SMS_71
s73, judging parameters
Figure SMS_72
Parameter->
Figure SMS_73
Parameters and parameters
Figure SMS_74
Whether the same number is not 0, if so, the triangular surface patchT 1 And triangular dough pieceT 2 No intersection occurs in the n-th frame in the future, otherwise, step S74 is entered;
s74, judging parameters
Figure SMS_75
Parameter->
Figure SMS_76
Parameters and parameters
Figure SMS_77
If the numbers are the same and are 0, the step S75 is carried out, otherwise, the step S76 is carried out;
s75, triangular dough pieceT 1 And triangular dough pieceT 2 The vertex coordinates of (2) are converted into two-dimensional coordinates to obtain
Figure SMS_78
Figure SMS_79
Figure SMS_80
Figure SMS_81
Figure SMS_82
Figure SMS_83
;/>
By triangular patchesT 1 Any one of the edges of (a)
Figure SMS_84
Establish the linear parameter equation ax+by+c=0 and fit the triangular patchesT 1 And triangular dough pieceT 2 Substituting the two-dimensional vertex coordinates of the two-dimensional vertex into a linear parameter equation to obtain:
Figure SMS_85
;
if the parameters are
Figure SMS_86
Parameter->
Figure SMS_87
Parameters are the same as the number and are the same as the parameters->
Figure SMS_88
Different numbers, triangular dough pieceT 1 And triangular dough pieceT 2 No intersection occurs in the future nth frame, otherwise, the triangular patchT 1 And triangular dough pieceT 2 Crossing in the future nth frame;
s76, in the triangular dough sheetT 1 On which a coordinate system O is established 1 X 1 Y 1 And putting triangular dough sheetT 1 And triangular dough pieceT 2 Conversion of vertex coordinates to coordinate System O 1 X 1 Y 1 In (a) and (b); judging straight line
Figure SMS_89
Straight line->
Figure SMS_90
Straight line->
Figure SMS_91
With O 1 X 1 Y 1 Intersection point P of planes 1 Intersection point P 2 Intersection point P 3 In (c) whether there is a triangle>
Figure SMS_92
Inside and at triangle->
Figure SMS_93
Intersection on one side, if yes, triangular surface patchT 1 And triangular dough pieceT 2 Crossing in the future nth frame, otherwise, proceeding to step S77;
s77, in triangular dough pieceT 2 On which a coordinate system O is established 2 X 2 Y 2 And putting triangular dough sheetT 1 And triangular dough pieceT 2 Conversion of vertex coordinates to coordinate System O 2 X 2 Y 2 In (a) and (b); judging straight line
Figure SMS_94
Straight line->
Figure SMS_95
Straight line->
Figure SMS_96
With O 2 X 2 Y 2 Intersection point P of planes 4 Intersection point P 5 Intersection point P 6 In (c) whether there is a triangle>
Figure SMS_97
Inside and at triangle->
Figure SMS_98
Intersection on one side, if yes, triangular surface patchT 1 And triangular dough pieceT 2 Intersecting in the future nth frame, if not, then triangular patchesT 1 And triangular dough pieceT 2 No intersection occurs in the future nth frame;
s78, updating the triangular dough piece to be detectedT 1 And triangular dough pieceT 2 Returning to the step 1) until determining whether each triangular patch to be detected in the mechanism model 4 to be detected and all triangular patches to be detected of the spray pipe model 5 intersect in the future nth frame, and further judging whether the mechanism model 4 to be detected and the spray pipe model 5 collide in the future nth frame;
s79, if a certain triangular patch to be detected exists in the mechanism model 4 to be detected and a certain triangular patch to be detected of the spray pipe model 5 are intersected in the future nth frame, the mechanism model 4 to be detected and the spray pipe model 5 collide in the future nth frame;
if each triangular patch in the mechanism model 4 to be detected and all triangular patches of the spray pipe model 5 do not intersect in the future nth frame, the mechanism model 4 to be detected and the spray pipe model 5 do not collide in the future nth frame.
The triangular patches to be detected comprise triangular patches with the same speed direction as the normal direction.
S80, returning the collision condition of the nth frame in the future to a motion control system of the mechanism to be detected, and making a motion decision of the mechanism to be detected.
The motion decision comprises: if collision is predicted, gradually reducing the speed of the mechanism to zero; if no collision is predicted, the mechanism continues to move according to the planned track.
Example 2
The special mechanism collision prediction method based on the virtual prototype in the interstage separation test of the embodiment is a simplified method, and specifically comprises the following steps:
s10, accurately establishing a wind tunnel test section, a mechanism and a three-dimensional digital model of a test model in the virtual prototype, and setting each driving joint in the mechanism as a position input variable.
In step S10, the critical model outline may be enlarged by a certain threshold to perform three-dimensional accurate modeling, and the final three-dimensional digital model is wrapped with triangular patches, taking into account the threshold for collision prediction between different components.
S20, establishing mapping relations between the positions of all driving joints in the virtual prototype and the positions of all driving joints of the actual mechanism.
S30, calibrating the virtual machine system.
In step S30, the purpose of the calibration is to ensure that the relative pose between the models in the real model and in the virtual prototype model at the initial moment is completely consistent.
S40, performing an interstage separation test. And cutting the mechanism motion into a plurality of frame motions in 1 second by taking the frame as a unit, and synchronizing each frame motion of the actual model and the virtual prototype model in real time.
In step S40, when frame slicing is performed, the communication capability of the field device and the calculation speed of the virtual prototype should be considered, so as to ensure that the total time for the virtual prototype to process a frame and predict the next frame is less than the time for the mechanism to actually operate a frame.
S50, in the virtual prototype, the pose and speed data of the last n frames are obtained according to the motion position, the speed and the acceleration of the last frame.
In step S50, a constant acceleration assumption is used for motion prediction at the next time in the entire frame.
S60, according to the position and pose conditions of the predicted frame obtained through the intersecting calculation of the graphic elements, the collision conditions of the mechanism and the model under the predicted frame are obtained.
In step S60, in order to improve the detection efficiency, only triangular patches having the same triangular patch speed direction as the normal direction thereof are detected in the triangular patch primitive intersection calculation.
S70, the virtual prototype returns collision information of the predicted frame to the motion control system to carry out motion decision.
Example 3
The embodiment is used for describing in detail the primitive intersection method in the special mechanism collision prediction method based on the virtual prototype in the interstage separation test, and specifically comprises the following steps:
fig. 2a is a phantom in a wind tunnel. In fig. 2a, 1 is a nozzle in a wind tunnel test, in this example an obstacle to the operation of the mechanism; and 2, a physical model in a wind tunnel test is mounted at the tail end of the executing mechanism 3. The tail end of the actuator 3 has six degrees of freedom, and three rotations of yaw, pitch and roll are realized in the three directions of X, Y and Z in an aviation coordinate system. Fig. 2b is a virtual prototype model based on the physical model of fig. 2a, taking into account the threshold requirements of collision prediction, and in fig. 2b, the yaw, pitch, roll mechanism and mechanism to be detected model 4 of a possible collision are wrapped in a triangular patch, and also the nozzle model 5 is wrapped in a triangular patch. The display technology of the virtual prototype adopts an open graphics library OpenGL or DirectX technology.
Before wind tunnel test, a one-to-one mapping relationship between the joint information (X movement, axis 1, axis 2, pitch, yaw and roll) of the physical model and the corresponding joint in the virtual prototype is established. And then calibrating the system, namely ensuring that the initial pose of the physical model and the initial pose of the virtual prototype are completely consistent, and ensuring that the relative pose of each part is completely consistent. When wind tunnel test is carried out, the pose and the speed of the physical model and the virtual prototype model are synchronized in real time according to a certain frame rate, and the time for synchronizing one frame is smaller than the time for predicting one frame by collision. Assuming that the time of a frame is deltat, assuming uniform motion when the position and the speed of the frame are obtained, obtaining the pose of the nth frame (such as the 5 th frame) later, then calculating the positions and the speeds of all triangular patch vertexes on the model to be detected, and then carrying out collision detection according to the predicted pose. In order to reduce the detection effort, before collision detection, all triangular patches to be detected are classified into three types as shown in fig. 3a, 3b and 3c, and the triangular patches in fig. 3b have an obtuse angle between the moving direction and the normal direction, so that collision risk does not occur, and therefore, such triangular patches are omitted in the detection of this frame, and only the triangular patches shown in fig. 3a and 3c are detected. The detection mode is to detect all triangular patches which are consistent with fig. 3a and 3c on the yaw, pitch and roll mechanisms and the mechanism to be detected model 4 and all triangular patches of the spray pipe model 5 one by one. The detection algorithm for each pair of triangular patches is as follows:
assume that the two triangles to be detected areT 1 AndT 2, wherein T 1 Is defined by three vertexes
Figure SMS_99
Figure SMS_100
Figure SMS_101
T 2 Is +.>
Figure SMS_102
Figure SMS_103
Figure SMS_104
The following determinant operation is defined:
Figure SMS_105
;
first by
Figure SMS_106
Figure SMS_107
Figure SMS_108
Classifying the problem by the value of (2):
if the three determinant are of the same sign and are not 0, then this is illustratedT 1 AndT 2 no intersection occurs;
if the three determinant is 0, the description and coplanarity are changed to the intersection judgment of the two-dimensional triangle, and the following can be realizedT 1 AndT 2 the point coordinates of (2) are converted into two-dimensional coordinates, and can be arbitrarily found in the two-dimensional coordinate system, and the point coordinates are assumed to be at the momentT 1 AndT 2 two-dimensional coordinate values of (a) are respectively
Figure SMS_109
Figure SMS_110
Figure SMS_111
Figure SMS_112
Figure SMS_113
Figure SMS_114
. To be used forT 1 Is->
Figure SMS_115
A linear parameter equation ax+by+c=0 is established. Will beT 1 Is the third point of (2)T 2 Is brought into this equation:
Figure SMS_116
;
if forT 1 Is provided with three sides
Figure SMS_117
The same number and->
Figure SMS_118
In the case of different numbers, thenT 1 AndT 2 no intersection occurs, whereas there is an intersection.
If not, then the description is thatT 1 AndT 2 different surfaces, wherein a certain triangle intersects with a plane determined by another triangle, a coordinate system is established on the certain triangle, and coordinate values of the two triangles are converted into the coordinate system.
As shown in fig. 4, a judgment is made
Figure SMS_119
,
Figure SMS_120
,
Figure SMS_121
Determined straight line and O 1 X 1 Y 1 Three intersection points P of planes 1 、P 2 、P 3 (if there is no intersection point, it is defined to intersect at infinity) whether there is a certain intersection point P i Belongs to triangle->
Figure SMS_122
Is a closure of triangle ++>
Figure SMS_123
Is provided. If present, the two triangles intersect. If not, a local coordinate system will be established on the other triangle, and the above is repeated. If neither calculation exists, then the two triangles do not intersect.
After the detection of all the triangular surface patches is finished, if the condition that two triangles intersect exists, the feedback is that collision occurs; if the condition that two triangles intersect does not exist for all the triangular patch pairs, no collision occurs in feedback. And then waiting for data of the next frame to perform collision prediction.

Claims (9)

1. The special mechanism collision prediction method based on the virtual prototype in the interstage separation test is characterized by comprising the following steps of:
s10, establishing a virtual prototype three-dimensional model according to a mechanism to be detected;
the virtual prototype three-dimensional model comprises a mechanism model to be detected (4) and a spray pipe model (5); the mechanism model to be detected (4) comprises a yaw mechanism model, a pitch mechanism model and a roll mechanism model;
s20, setting each driving joint in a mechanism model (4) to be detected as a position input variable;
s30, acquiring a position input variable, and establishing a mapping relation between a mechanism to be detected model (4) and the positions of all driving joints in the mechanism to be detected;
s40, calibrating the three-dimensional model of the virtual prototype according to a calibration standard, namely calibrating the virtual machine system;
s50, carrying out an interstage separation test on the mechanism to be detected, and synchronizing the motions of the mechanism to be detected and the virtual prototype three-dimensional model in real time;
s60, carrying out frame segmentation on the motion of the mechanism to be detected and the virtual prototype three-dimensional model, and predicting the pose and the speed of the nth frame of the virtual prototype three-dimensional model according to the motion position, the speed and the acceleration of the current frame of the virtual prototype three-dimensional model;
s70, predicting collision conditions of a mechanism model (4) to be detected and a spray pipe model (5) of an nth frame in the future by using a primitive intersection method; the method comprises the following steps:
s71, recording two triangular patches to be detected asT 1 AndT 2 the method comprises the steps of carrying out a first treatment on the surface of the Wherein, triangular dough pieceT 1 Belongs to a mechanism model (4) to be detected, and a triangular surface patchT 2 Belongs to a spray pipe model (5);
triangular face plateT 1 Is defined by three vertexes
Figure QLYQS_2
Figure QLYQS_5
Figure QLYQS_16
The method comprises the steps of carrying out a first treatment on the surface of the Triangular face plateT 2 Is +.>
Figure QLYQS_8
Figure QLYQS_11
Figure QLYQS_7
; wherein ,
Figure QLYQS_18
is vertex->
Figure QLYQS_9
Coordinates of (c);
Figure QLYQS_12
Is vertex->
Figure QLYQS_4
Coordinates of (c);
Figure QLYQS_17
Is vertex->
Figure QLYQS_1
Coordinates of (c);
Figure QLYQS_13
Is vertex->
Figure QLYQS_10
Coordinates of (c);
Figure QLYQS_14
Is vertex->
Figure QLYQS_6
Coordinates of (c);
Figure QLYQS_15
Is the vertex
Figure QLYQS_3
Coordinates of (c);
s72, calculating parameters
Figure QLYQS_19
Parameter->
Figure QLYQS_20
Figure QLYQS_21
The method comprises the following steps: />
Figure QLYQS_22
S73, judging parameters
Figure QLYQS_23
Parameter->
Figure QLYQS_24
Figure QLYQS_25
Whether the same number is not 0, if so, the triangular surface patchT 1 And triangular dough pieceT 2 No intersection occurs in the n-th frame in the future, otherwise, step S74 is entered;
s74, judging parameters
Figure QLYQS_26
Parameter->
Figure QLYQS_27
Figure QLYQS_28
If the numbers are the same and are 0, the step S75 is carried out, otherwise, the step S76 is carried out;
s75, triangular dough pieceT 1 And triangular dough pieceT 2 The vertex coordinates of (2) are converted into two-dimensional coordinates to obtain
Figure QLYQS_29
Figure QLYQS_30
Figure QLYQS_31
Figure QLYQS_32
Figure QLYQS_33
Figure QLYQS_34
By triangular patchesT 1 Any one of the edges of (a)
Figure QLYQS_35
Establish the linear parameter equation ax+by+c=0 and fit the triangular patchesT 1 And triangular dough pieceT 2 Substituting the two-dimensional vertex coordinates of the two-dimensional vertex into a linear parameter equation to obtain:
Figure QLYQS_36
if the parameters are
Figure QLYQS_37
Parameter->
Figure QLYQS_38
Parameters are the same as the number and are the same as the parameters->
Figure QLYQS_39
Different numbers, triangular dough pieceT 1 And triangleDough sheetT 2 No intersection occurs in the future nth frame, otherwise, the triangular patchT 1 And triangular dough pieceT 2 Crossing in the future nth frame;
s76, in the triangular dough sheetT 1 On which a coordinate system O is established 1 X 1 Y 1 And putting triangular dough sheetT 1 And triangular dough pieceT 2 Conversion of vertex coordinates to coordinate System O 1 X 1 Y 1 In (a) and (b); judging straight line
Figure QLYQS_40
Straight line->
Figure QLYQS_41
Straight line->
Figure QLYQS_42
With O 1 X 1 Y 1 Intersection point P of planes 1 Intersection point P 2 Intersection point P 3 In (c) whether there is a triangle>
Figure QLYQS_43
Inside and at triangle->
Figure QLYQS_44
Intersection on one side, if yes, triangular surface patchT 1 And triangular dough pieceT 2 Crossing in the future nth frame, otherwise, proceeding to step S77;
s77, in triangular dough pieceT 2 On which a coordinate system O is established 2 X 2 Y 2 And putting triangular dough sheetT 1 And triangular dough pieceT 2 Conversion of vertex coordinates to coordinate System O 2 X 2 Y 2 In (a) and (b); judging straight line
Figure QLYQS_45
Straight line->
Figure QLYQS_46
Straight line
Figure QLYQS_47
With O 2 X 2 Y 2 Intersection point P of planes 4 Intersection point P 5 Intersection point P 6 In (c) whether there is a triangle>
Figure QLYQS_48
Inside and at triangle->
Figure QLYQS_49
Intersection on one side, if yes, triangular surface patchT 1 And triangular dough pieceT 2 Intersecting in the future nth frame, if not, then triangular patchesT 1 And triangular dough pieceT 2 No intersection occurs in the future nth frame;
s78, updating the triangular dough piece to be detectedT 1 And triangular dough pieceT 2 Returning to the step S71 until determining whether each triangular patch to be detected in the mechanism model to be detected (4) and all triangular patches to be detected in the spray pipe model (5) intersect in the future nth frame, and further judging whether the mechanism model to be detected (4) and the spray pipe model (5) collide in the future nth frame;
s80, returning the collision condition of the nth frame in the future to a motion control system of the mechanism to be detected, and making a motion decision of the mechanism to be detected.
2. The special mechanism collision prediction method based on the virtual prototype in the interstage separation test according to claim 1, wherein the mechanism model (4) to be detected and the spray pipe model (5) are wrapped by triangular patches.
3. The special mechanism collision prediction method based on the virtual prototype in the interstage separation test according to claim 1, wherein the calibration standard of the virtual prototype three-dimensional model is: the initial pose of the mechanism to be detected and the initial pose of the virtual prototype three-dimensional model are completely consistent, and the relative pose of each driving joint of the mechanism to be detected and the virtual prototype three-dimensional model are completely consistent.
4. The special mechanism collision prediction method based on the virtual prototype in the interstage separation test according to claim 1, wherein the standard for performing frame segmentation on the motion of the mechanism to be detected and the virtual prototype three-dimensional model is as follows: the three-dimensional model of the virtual prototype predicts the pose and the speed of the nth frame of the three-dimensional model of the virtual prototype according to the motion position, the speed and the acceleration of the current frame, and the time required for obtaining the pose and the speed of the nth frame of the three-dimensional model of the virtual prototype is less than the time for one frame of motion of a mechanism to be detected.
5. The method for predicting the collision of a special mechanism based on a virtual prototype in an interstage separation test according to claim 1, wherein the motion acceleration of the three-dimensional model of the virtual prototype is set to a constant value.
6. The virtual prototype-based special mechanism collision prediction method in the inter-stage separation test according to claim 1, wherein the virtual prototype three-dimensional model is displayed by an open graphics library OpenGL or DirectX technology.
7. The virtual prototype-based method for predicting a collision of a special mechanism in an interstage separation test according to claim 1, wherein said motion decision comprises: if collision is predicted, gradually reducing the speed of the mechanism to zero; if no collision is predicted, the mechanism continues to move according to the planned track.
8. The method for predicting the collision of the special mechanism based on the virtual prototype in the interstage separation test according to claim 1, wherein the predicting the collision condition comprises: if a certain triangular patch to be detected exists in the mechanism model to be detected (4) and the triangular patch to be detected of the spray pipe model (5) are intersected in the future nth frame, the mechanism model to be detected (4) collides with the spray pipe model (5) in the future nth frame;
if all triangular patches in the mechanism model (4) to be detected and the spray pipe model (5) are not intersected in the future nth frame, the mechanism model (4) to be detected and the spray pipe model (5) are not collided in the future nth frame.
9. The method for predicting the collision of a special mechanism based on a virtual prototype in an interstage separation test according to claim 1, wherein the triangular patches to be detected comprise triangular patches with the same speed direction as the normal direction.
CN202310245488.3A 2023-03-15 2023-03-15 Special mechanism collision prediction method based on virtual prototype in interstage separation test Active CN116049995B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310245488.3A CN116049995B (en) 2023-03-15 2023-03-15 Special mechanism collision prediction method based on virtual prototype in interstage separation test

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310245488.3A CN116049995B (en) 2023-03-15 2023-03-15 Special mechanism collision prediction method based on virtual prototype in interstage separation test

Publications (2)

Publication Number Publication Date
CN116049995A CN116049995A (en) 2023-05-02
CN116049995B true CN116049995B (en) 2023-06-02

Family

ID=86133378

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310245488.3A Active CN116049995B (en) 2023-03-15 2023-03-15 Special mechanism collision prediction method based on virtual prototype in interstage separation test

Country Status (1)

Country Link
CN (1) CN116049995B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117710449B (en) * 2024-02-05 2024-04-16 中国空气动力研究与发展中心高速空气动力研究所 NUMA-based real-time pose video measurement assembly line model optimization method

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108052703A (en) * 2017-11-22 2018-05-18 南京航空航天大学 Fast Collision Detection Algorithm based on hybrid hierarchy bounding box

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9898388B2 (en) * 2014-05-23 2018-02-20 Mentor Graphics Corporation Non-intrusive software verification
EP3040797B1 (en) * 2014-12-31 2020-10-28 Dassault Systèmes Simulating the machining of a workpiece

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108052703A (en) * 2017-11-22 2018-05-18 南京航空航天大学 Fast Collision Detection Algorithm based on hybrid hierarchy bounding box

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
Virtual prototyping simulation of minitype universal docking mechanism based on ADAMS;Yangtao Yu等;2011 International Conference on Electronic & Mechanical Engineering and Information Technology;第3848-3851页 *
基于ADAMS的飞行器级间分离动力学分析;孙乐园等;科技创新导报(第24期);第49-50页 *
基于虚拟样机的级间分离系统仿真;张耀磊等;计算机仿 真;第23卷(第12期);第43-45,73页 *
高马赫数多体分离试验技术研究与应用;林敬周等;推进技术;第41卷(第4期);第925-933页 *

Also Published As

Publication number Publication date
CN116049995A (en) 2023-05-02

Similar Documents

Publication Publication Date Title
USRE48940E1 (en) Simulation of the machining of a workpiece
CN102528555B (en) Geometry and mechanics integrated optimization information processing method of interference-free tool path on complex curved surface
CN107972034B (en) Complex workpiece trajectory planning simulation system based on ROS platform
CN116049995B (en) Special mechanism collision prediction method based on virtual prototype in interstage separation test
KR20160082481A (en) Simulating the machining of a workpiece
CN102426424B (en) Visual emulation method of near-space flying vehicle based on distributed framework
CN104484522A (en) Method for building robot simulation drilling system based on reality scene
CN111324977B (en) Method for simulating cutting by using dynamic position error
CN106041928A (en) Robot job task generation method based on workpiece model
Liu et al. Optimal path planning for automated dimensional inspection of free-form surfaces
CN112405541B (en) Laser 3D precision cutting double-robot cooperative operation method
CN114012726B (en) Method for detecting collision of spaceflight mechanical arm
CN105096381A (en) Collision detecting method using moving three-dimension ship models in navigation channel
CN103810313B (en) A kind of STL model is to the conversion method of space parted pattern
CN110147649A (en) A kind of analogy method and device of plate process
CN103886120A (en) Lightweighting visualization method for digital mockups of large products
CN113761646A (en) Method for determining dynamic response of aircraft in mobile wind field environment
CN111210520A (en) Reverse forming method and system for physical model
CN102393827A (en) Flexible scene continuous collision detection method based on continuous normal cone remover
CN112090619B (en) Off-line simulation machining method and system for spraying robot of high-speed rail car body
CN101308523B (en) Dummy laser processing procedure geometric simulation method
CN113836745B (en) Simulation system and method for intelligent inspection device
Falin et al. Research on visualization technology of 3D cable harness wiring of complex electromechanical products
CN106023064A (en) Assessment method for field of vision of airplane cabin
Wang Collision Detection Algorithm Based on Particle System in Virtual Simulation

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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20240726

Address after: 621900 Box 14, No. 6, South Section of Second Ring Road, Fucheng District, Mianyang City, Sichuan Province

Patentee after: Institute of High Speed Aerodynamics, China Aerodynamic Research and Development Center

Country or region after: China

Address before: 621900 box 14, no.6, south section of the Second Ring Road, Mianyang City, Sichuan Province

Patentee before: Institute of High Speed Aerodynamics, China Aerodynamic Research and Development Center

Country or region before: China

Patentee before: Chongqing University