An EMI spherical scanning imaging method and system based on a robotic arm

By combining robotic arms with microwave scanning imaging technology, a model was constructed and mathematical analysis and path planning were performed to solve the problems of imaging accuracy and positioning stability in EMI spherical scanning imaging, thus achieving high-precision imaging and positioning of EMI radiation sources.

CN116449112BActive Publication Date: 2024-11-29QINGDAO CLP GREEN NETWORK NEW ENERGY CO LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
CN202310227655.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-03-10
Publication Date
2024-11-29
Estimated Expiration
2043-03-10

AI Technical Summary

Technical Problem

Existing EMI spherical scanning imaging methods for electronic devices suffer from low imaging accuracy and relatively low stability and precision in mechanical scanning and positioning. In particular, it is difficult to achieve high-precision scanning and imaging in non-redundant working environments with multiple task constraints.

Method used

By combining robotic arms with microwave scanning imaging technology, a robotic arm model is constructed to determine the inaccessible area and the farthest area of ​​the wrist. Mathematical analysis is performed to obtain the maximum sampling spherical area, and an improved RRT algorithm is used to search for the path to achieve automatic focusing imaging in both near and far fields.

Benefits of technology

It achieves high-precision imaging and stable positioning of EMI radiation sources, provides a scanning system control strategy under multiple task constraints, and improves imaging accuracy and positioning stability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN116449112B_ABST
    Figure CN116449112B_ABST
Patent Text Reader

Abstract

The present invention relates to an EMI spherical scanning imaging method and system based on a mechanical arm, belonging to the field of robot and intelligent hardware technology, and the method comprises the following steps: constructing a mechanical arm model, determining the inaccessible area of ​​the wrist of the mechanical arm, the farthest area of ​​the wrist position, and the working range of the wrist; determining the working range of the mechanical arm under the end constraint condition according to the inaccessible area of ​​the mechanical arm and the farthest distribution range of the mechanical arm; mathematically analyzing the working range to obtain the parameters corresponding to the sampling sphere with the largest sampling area; using an improved RRT algorithm to search for paths; collecting radiation data according to the searched path; and using a near-field and far-field imaging automatic focusing algorithm to image the EMI radiation source. The present invention realizes the average joint change angle reduction, automatic focusing and precise imaging of the EMI radiation source, can provide theoretical and methodological support for the design of a spherical ESM scanning robot, and can be applied to EMI detection and positioning applications of electronic systems.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the field of robots and intelligent hardware technology in the field of new generation technology industry and high-end equipment manufacturing industry, and specifically relates to an EMI spherical scanning imaging method and system based on a robotic arm. Background Art

[0002] With the continuous improvement of the circuit density and integration of electronic systems, imaging and analyzing high-frequency interference signals of electronic equipment to provide more efficient fault detection and rectification suggestions has become an inherent demand for the development of the electronics industry. The existing idea is to use a plane expansion method to approximate the radiation field of the equipment interference source as a plane wave for calculation, and then complete the imaging transformation from far field to near field. However, since electromagnetic waves actually propagate in space in the form of spherical waves, this will inevitably affect the imaging accuracy. On the other hand, high-frequency electromagnetic signal imaging based on spherical waves has high requirements for detection accuracy, which requires providing stable and high-precision mechanical scanning and positioning solutions when designing related systems. In particular, it is necessary to explore the control strategy of the scanning system in a non-redundant working environment with multiple task constraints, as well as the detection and verification methods of automatic focusing and high-precision inversion performance during imaging. Summary of the invention

[0003] In order to solve the problems of low imaging accuracy, low mechanical scanning and positioning stability and accuracy in EMI spherical scanning imaging of electronic equipment, a method and system for EMI spherical scanning imaging based on a robotic arm are provided. The method and system combine the robotic arm with microwave scanning imaging technology, and focus on studying the system modeling method and motion control strategy under the spherical scanning mode, in order to achieve far-field and near-field transformation imaging and precise positioning of the EMI radiation source of the electronic equipment.

[0004] To solve the above problems, the present invention adopts the following technical solutions:

[0005] An EMI spherical scanning imaging method based on a mechanical arm comprises the following steps:

[0006] Step 1: Build a robot model and determine the inaccessible area Ω of the robot wrist w and the farthest area from the wrist fron , and according to the wrist inaccessible area Ω w and the farthest area W of the wrist position fron Determine the wrist working range W of the robot space ;

[0007] Step 2: With the end constraint condition that the end of the robotic arm always points to the radiation source, the wrist inaccessible area Ω w and the farthest area W of the wrist position fronThe points on the upper edge are offset by the unit vectors corresponding to the end constraints to obtain the corresponding unreachable area Ω of the manipulator and the farthest distribution interval EE of the manipulator. fron , according to the inaccessible area Ω of the robot and the farthest distribution interval EE of the robot fron Determine the working range EE of the robot under the end constraint condition space ;

[0008] Step 3: EE of the working interval under the terminal constraints space Perform mathematical analysis to obtain the maximum sampling sphere area;

[0009] Step 4: Generate a sampling point set corresponding to the sampling sphere and determine the sampling sequence with the shortest path. Use the improved RRT algorithm to search for a path with the shortest total path length and a smooth change in the joint angles of adjacent sequences.

[0010] Step 5: Collect radiation data according to the searched path to obtain spherical far-field scanning data of the EMI radiation source;

[0011] Step 6: Based on the spherical far-field scanning data, the EMI radiation source is imaged using a near- and far-field imaging automatic focusing algorithm.

[0012] Accordingly, the present invention also proposes an EMI spherical scanning imaging system based on a mechanical arm, comprising a mechanical arm, a vector network analyzer and a control computer, wherein the control computer comprises:

[0013] The robot modeling module is used to build a robot model and determine the inaccessible area Ω of the robot wrist. w and the farthest area from the wrist fron , and according to the wrist inaccessible area Ω w and the farthest area W of the wrist position fron Determine the wrist working range W of the robot space ;

[0014] The working range determination module is used to set the wrist inaccessible area Ω with the end of the robot arm always pointing to the radiation source as the end constraint condition w and the farthest area W of the wrist position fron The points on the upper edge are offset by the unit vectors corresponding to the end constraints to obtain the corresponding unreachable area Ω of the manipulator and the farthest distribution interval EE of the manipulator. fron , according to the inaccessible area Ω of the robot and the farthest distribution interval EE of the robot fron Determine the working range EE of the robot under the end constraint condition space ;

[0015] The sampling sphere acquisition module is used to obtain the EE of the working interval under the terminal constraint conditions.space Perform mathematical analysis to obtain the maximum sampling sphere area;

[0016] The path search module is used to generate a set of sampling points corresponding to the sampling sphere and determine the sampling sequence with the shortest path. The improved RRT algorithm is used to search for a path with the shortest total path length and a smooth change in the joint angles of adjacent sequences.

[0017] The driving and acquisition module is used to drive the robot arm to move to the specified sampling point according to the searched path, and control the vector network analyzer to collect radiation data to obtain the spherical far-field scanning data of the EMI radiation source;

[0018] The imaging module is used to image the EMI radiation source according to the spherical far-field scanning data by using a far-field and near-field imaging automatic focusing algorithm.

[0019] Compared with the prior art, the present invention has the following beneficial effects:

[0020] The present invention obtains the working range of the robot under the above constraints by modeling the robot arm configuration and spherical scanning boundary, and mathematically analyzes the working range to obtain the maximum sampling spherical area. Then, an improved Rapid-exploring Random Tree (RRT) algorithm is used to perform path search and planning based on the joint angle search strategy, and perform near- and far-field automatic focusing imaging, thereby achieving the average joint change angle reduction, automatic focusing and precise imaging of EMI radiation sources. This can provide theoretical and methodological support for the design of a spherical ESM scanning robot, and can be applied to EMI detection and positioning applications in electronic systems. BRIEF DESCRIPTION OF THE DRAWINGS

[0021] Figure 1 A flowchart of an EMI spherical scanning imaging method based on a mechanical arm according to an embodiment of the present invention;

[0022] Figure 2 Modeling of two robot arm configurations with six degrees of freedom and seven degrees of freedom, as well as schematic diagrams of the inaccessible area of ​​the wrist;

[0023] Figure 3 It is a schematic diagram of the working area of ​​the robotic arm wrist on the x0o0z0 plane;

[0024] Figure 4 Schematic diagram of the generation of the inaccessible area of ​​the robot under the end constraint;

[0025] Figure 5 Schematic diagram of the distribution of the sampling sphere in space;

[0026] Figure 6 It is a schematic diagram of some sampling surface paths;

[0027] Figure 7 This is a graph showing the relationship between image contrast and focusing distance. DETAILED DESCRIPTION

[0028] The present invention spatially models the mechanical arm and the electronic device EMI sphere, and explores the optimal design mode of the system under the above constraints and solves the optimal motion control by modeling the mechanical arm configuration, the spherical scanning boundary and the detection antenna posture. The technical solution of the present invention will be described in detail below in conjunction with the accompanying drawings and preferred embodiments.

[0029] like Figure 1 As shown, an embodiment of the present invention provides an EMI spherical scanning imaging method based on a mechanical arm, the method comprising the following steps:

[0030] Step 1: Build a robot model and determine the inaccessible area Ω of the robot wrist w and the farthest area from the wrist fron , and according to the wrist inaccessible area Ω w and the farthest area W of the wrist position fron Determine the wrist working range W of the robot space .

[0031] In ESM scanning, expanding the sampling area can obtain more accurate imaging, so it is also required that the working space of the robot arm used for detection is as large as possible. Since different robot arm configurations have an impact on the generation of ESM sampling area, the relationship between the robot arm's own configuration, joint angle restrictions, model parameters and the wrist's inaccessible area is first discussed. Common robot arms mainly have two configurations: six degrees of freedom (DOF_6) and seven degrees of freedom (DOF_7). To build a robot arm model, each joint has its own coordinate system, namely the base coordinate system, such as Figure 2 As shown, the base coordinate system x i y i z i (For DOF_6, 1≤i≤6; for DOF_7, 1≤i≤7) satisfies the right-hand screw rule, where z i is the axis of the base coordinate system, also refers to the direction of the corresponding joint axis; the connecting rod angle q i Represents the rotation z i The angle of axis rotation, where q2, q3 belongs to [-2π / 3, 2π / 3]; the connecting rod distance d i Indicates the robot arm joint along z i The distance of axis translation; the torsion angle of connecting rod α i Indicates z i Axis around x i+1 The angle of axis rotation; a i Indicates the robot arm joint along x i The distance the axis is translated.

[0032] Depend on Figure 2 It can be seen that both DOF_6 and DOF_7 configurations have the shortest distance r between the wrist position W and the shoulder position S under the joint angle restriction. short , at this time, with the rotation of the shoulder joint, W forms a circle with r in space short The spherical area with a radius of Ω is the inaccessible area of ​​the wrist of the robot. w The r of the manipulator with different degrees of freedom is short As shown in formula (1).

[0033]

[0034] When DOF_6 and DOF_7 satisfy formula (2), the Ω of the two manipulators is w Exactly equal.

[0035]

[0036] The two configuration parameters are defined as {a2, d4, q 3limit}∈DOF_6,{d3,d5,q 4limit}∈DOF_7.q 3limit is the maximum value of the connecting rod angle q3, which is 120°; q 4limit is the maximum value of the connecting rod angle q4, and its value is also 120°. By comparison, it can be found that in Ω w In the process of forming, the extra q3 of DOF_7 relative to DOF_6 is very important for reducing Ω w The discussion process of the farthest distribution area of ​​the wrist of DOF_6 and DOF_7 is similar to the above discussion, which shows that the seven-DOF manipulator has no substantial effect on increasing the ESM sampling area. Therefore, the present invention takes the six-DOF manipulator as the research object, and studies and discusses its application in the ESM scanning task.

[0037] Based on the construction of the robot model, the DH parameters of the six-axis robot can be obtained by substituting formula (1) into the DH parameters of the six-axis robot. w , as shown in formula (3):

[0038] Ω w :x 2 +y 2 +z-d1 2 ≤r short 2 (3)

[0039] Among them, d1 is the connecting rod distance, which means the distance of translation of the robot arm joint along the z1 axis, r shortIt is the shortest distance between the wrist position W and the shoulder position S of the robot under the joint angle restriction, and is also the inaccessible area Ω of the robot wrist. w The radius of .

[0040] When the elbow E of the robot arm is straight (q3 = 0), the distance r between the wrist position W and the shoulder position S of the robot arm is the largest. If q2 is at the joint limit while the above conditions are met, as q3 changes, the distribution of W in the x0o0z0 plane is as follows: Figure 2 (b) and Figure 2 (d) as shown.

[0041] from Figure 3 It can be found that when q2=q 2limit When 2limit is the maximum value of the connecting rod angle q2, which is 120°. The movement of q3 will form an irregular surface at the wrist position W. To solve the mathematical expression of the surface, the corresponding spherical coordinate system is established based on x1y1z1. The two end points are located at the origin of the spherical coordinate system and the irregular surface respectively. The mathematical expression of the irregular surface in the spherical coordinate system can be obtained. Correspondingly, the farthest area W of the wrist position fron It can be specifically expressed in the polar coordinate system, as shown in formula (4):

[0042]

[0043] Among them, the connecting rod distance d4 represents the translation distance of the robot arm joint along the z4 axis, a2 is the translation distance of the robot arm joint along the x2 axis, lim=[-120 ° , 120 ° ], Represents the elevation angle in the base coordinate system x1y1z1.

[0044] In getting W fron Then the wrist working range W can be expressed space As shown in formula (5):

[0045]

[0046] Step 2: With the end of the robot always pointing to the radiation source as the end constraint, the wrist inaccessible area Ω w and the farthest area from the wrist fron The points on the upper edge are offset by the unit vectors corresponding to the end constraints to obtain the corresponding unreachable area Ω of the manipulator and the farthest distribution interval EE of the manipulator. fron , according to the inaccessible area Ω of the robot and the farthest distribution interval EE of the robot fron Determine the working range EE of the robot under the end constraint condition space .

[0047] During the ESM scanning process, the end of the robotic arm needs to point to the radiation source, that is, there is an additional offset vector between the end of the robotic arm and the wrist position W By offsetting the wrist working area W space The working range EE under the terminal constraint can be obtained space , the principle is as follows Figure 4 As shown, where A∈Ω w ; A' is the offset of point A The position after the scan; O' is the center of the scanning sphere; is the direction vector formed by the center of the scanning sphere and point A; for The unit vector of

[0048]

[0049] Depend on Figure 4 It can be seen that the inaccessible area Ω of the manipulator under the end constraint is composed of the inaccessible area Ω of the wrist w The point set A on the corresponding offset Get, the farthest distribution interval EE of the robot arm fron The above corresponding relationship is also satisfied. Substituting formula (3) and formula (4) into the formula, we can get the unreachable area Ω of the robot arm and the farthest distribution interval EE of the robot arm. fron , the results are shown in formulas (6) and (7) respectively:

[0050]

[0051] Among them, [l x l y l z ] T is the unit vector corresponding to the terminal constraint;

[0052]

[0053] Thus, the working range EE under the constraint of the end of the robot arm is obtained space :

[0054]

[0055] Step 3: EE of the working interval under the terminal constraints space Perform mathematical analysis to obtain the maximum sampling sphere area S scan .

[0056] This step analyzes the maximum sampling surface under the ESM task, and calculates the working range EE of the manipulator under the end constraint. space Mathematical analysis is performed to obtain the maximum area S of the sampling sphere scan, and then perform motion planning for the robot arm. The specific process is as follows: Assume that the sampling sphere takes the radiation source O' as the sphere center and R s is the sampling radius, in R s As the size of the sampling sphere increases, the distribution of the sampling sphere in space is as follows: Figure 5 To simplify the calculation, the working interval EE is ignored. space The influence of irregular areas in the robot is considered only in the x1o1y1 plane established by the base coordinate system x1y1z1 with the robot shoulder S as the origin, which belongs to EE space The sampling sphere area S up , while fixing the center O' on the y1 axis and the corresponding coordinate on the axis is w; define the complete sampling sphere and EE fron The intersection line when the boundaries intersect is L. The problem of generating the largest sampling sphere in the working area is simplified to generating the maximum S up problem.

[0057] Since the sampling sphere is farthest from the robot arm's distribution area EE fron It is symmetric with respect to the coordinate axis y1 in space. When R s When the sampling sphere is larger, the EE fron The intersection above the x1o1y1 plane is a space curve L parallel to the x1o1z1 plane, so the projection L' of the intersection line L on x1o1y1 is a line segment. up First, L' is established. Here, O' is taken as the origin, and the ray O'x' parallel to the ray o1x1 and in the same direction is used as the polar axis to establish a two-dimensional polar coordinate system x'O'y'; β is the polar angle in the coordinate system, and the range of variation is [-π,π]. Therefore, L' can be expressed in x1o1y1 as shown in formula (9):

[0058]

[0059] The polar angle β can be obtained by combining the spherical equation and formula (7), and is expressed in x1o1y1 as shown in formula (10):

[0060]

[0061] The corresponding sampling sphere area S up The calculation formula is shown in formula (11):

[0062] S up =πR s 2 (1+|sin(β)|) (11)

[0063] Considering the mechanical structure of the robot arm and the sampling surface and EE fron The intersection condition of w and R sThe constraints shown in formula (12) should be met:

[0064]

[0065] The sampling sphere area S up The maximum objective function is nonlinear programming to maximize the generated sampling sphere area S scan Under the above conditions, the maximum scanning area S up and its corresponding w and R s After that, you need to up Processing to obtain a larger S scan , thereby reducing the impact of the above simplification on the generation of the maximum sampling area. scan With EE fron The unreachable area below intersects and will be in EE fron A plane is generated at the position of the point with the maximum z coordinate value in the irregular area, and the final sampling area S is obtained by cutting off the scanned surface below the plane. scan .

[0066] Step 4: Generate a set of sampling points corresponding to the sampling sphere and determine the sampling sequence with the shortest path. Use the improved RRT algorithm to search for a path with the shortest total path length and smooth changes in the joint angles of adjacent sequences.

[0067] After obtaining the maximum sampling sphere area in step 3, the sampling sphere parameters can be obtained, the sampling point set corresponding to the sampling sphere with the maximum area is generated, and the sampling sequence with the shortest path is determined. At the same time, the improved RRT algorithm is used to search for a path that reduces the total path length and has a smooth change in the joint angles of adjacent sequences.

[0068] First, the obtained sampling sphere is preprocessed by rasterization to generate a sampling point set.

[0069] Then, an undirected graph G(D,B) is constructed according to the spatial relationship of the sampling points, as follows: Figure 6 As shown, D is the line between the sampling points; B represents the Euclidean distance weight of the line; B(i,j) represents the weight of the edge connecting two sampling points.

[0070] Use the Christofides algorithm and the target loss function to search for the shortest path without repeated sampling, where the target loss function is:

[0071]

[0072] Among them, Bi,j is the weight, indicating the two sampling endpoints v before and after i and v j The Euclidean distance of the connection line, D is the connection line between the sampling points.

[0073] After searching, we finally get the sampling sequence with the shortest path. The order of the path sequence in space is as follows: Figure 6 The direction is shown by the thick black line.

[0074] To obtain the pose matrix under the end constraint, for the sampling point in space (the position matrix P of the sampling point end =[x,y,z]') uses the pitch angle pitch and yaw angle yaw in the Euler angle to satisfy the terminal constraint (set [1,1,1] as the base coordinate system), which is defined as shown in formula (14):

[0075]

[0076]

[0077]

[0078] The rotation matrix R of each sampling point end As shown in formula (17):

[0079] R end =R ya R pi (17)

[0080] The rotation matrix of each sampling point plus the position matrix corresponding to each sampling point can obtain the pose matrix of the sampling point. Under the known shortest sampling sequence and the pose matrix of the corresponding sampling point, the path searched by the traditional rapid-exploring random tree method (Rapid-exploring Random Tree, RRT) often has too large a change in the joint angle, which will cause some joint angles to move overspeed when the robot is running, thereby reducing the stability and accuracy of the overall scanning process. Therefore, the present invention improves the search strategy of the rapid-exploring random tree algorithm, and the improved RRT algorithm (RRT-JSS) performs path search based on the joint angle search strategy. The smoothness of the path searched using the RRT*-JSS algorithm will be significantly increased. Considering that the sixth joint has no effect on the scan when the robot performs the ESM scanning task and only the first five joint angles are searched, a path with the smallest total path length and a smooth change in the joint angles of adjacent sequences is searched.

[0081] Due to the increase in dimensionality, the improved RRT-JSS algorithm search strategy will increase its search time compared to the previous one. However, the small interval between sampling points in space makes the overall increase time within an acceptable range, and the algorithm speed can be changed by changing the range of nodes in the tree. As a result, the unit time cost of the improved method is small and relatively fixed, and the joint angle change amplitude of the improved RRT algorithm based on the joint angle search strategy will be greatly reduced.

[0082] Step 5: Collect radiation data at each sampling point along the searched path, and finally obtain the spherical far-field scanning data of the EMI radiation source.

[0083] Step 6: Based on the spherical far-field scanning data, use the near-field and far-field imaging automatic focusing algorithm to image the EMI radiation source.

[0084] The electromagnetic center point of the measurement antenna is difficult to determine through measurement, which may cause deviations when the system performs phase transformation. In order to reduce the impact of this deviation on the imaging results, the near-field and far-field imaging autofocus algorithm is used to determine the phase transformation distance between the antenna and the radiation source. After obtaining the spherical far-field scanning data, the contrast of the grayscale difference in image processing is first replaced by the amplitude intensity contrast on the radiation source plane, and the amplitude intensity contrast at different focusing distances is analyzed to obtain the most accurate focusing distance. The calculation of the amplitude intensity contrast G(x,y) is shown in formula (18):

[0085]

[0086]

[0087]

[0088] Where I(x,y) is the amplitude intensity at position (x,y), G min is the minimum contrast, G max is the maximum contrast, W(x,y) is the normalized contrast, J is the image length, K is the image width, and L(x,y) is the total contrast.

[0089] By calculating the amplitude intensity contrast of the imaging results at different phase shift distances, the phase shift distance with the smallest amplitude intensity contrast (which means that the relative amplitude change in the inversion imaging amplitude distribution diagram is small) is selected as the phase shift distance after the system is refocused, such as Figure 7 As shown in the figure, the extreme point of the imaging contrast (radiance intensity contrast) is L = 0.332m. Here, the concept of phase shift distance is similar to that of focal length.

[0090] On the basis of effectively confirming the phase shift distance, the imaging results at the non-optimal focusing distance are significantly different from those of the automatic focusing imaging in terms of field strength and field strength distribution; for the focusing distance obtained by manual measurement without using a focusing algorithm, the imaging result at the maximum field strength is significantly different from that of the automatic focusing imaging result, and the imaging accuracy is lower than that of the automatic focusing imaging result; the effectiveness of the far-field and near-field imaging automatic focusing algorithm adopted by the present invention can be verified by comparison.

[0091] In another embodiment, the present invention provides an EMI spherical scanning imaging system based on a mechanical arm, the system includes a mechanical arm, a vector network analyzer VNA and a control computer, the control computer as the control center of the entire system respectively forms a device network with the vector network analyzer VNA and the mechanical arm through GPIB to realize the communication of the system, wherein the control computer uses the EMI spherical scanning imaging method based on the mechanical arm described in the above embodiment to control the movement of the mechanical arm, control the vector network analyzer to collect radiation data and realize the imaging of the EMI radiation source. Specifically, the control computer includes:

[0092] The robot modeling module is used to build a robot model and determine the inaccessible area Ω of the robot wrist. w and the farthest area from the wrist fron , and according to the wrist inaccessible area Ω w and the farthest area W of the wrist position fron Determine the wrist working range W of the robot space ;

[0093] The working range determination module is used to set the wrist inaccessible area Ω with the end of the robot arm always pointing to the radiation source as the end constraint condition w and the farthest area W of the wrist position fron The points on the upper edge are offset by the unit vectors corresponding to the end constraints to obtain the corresponding unreachable area Ω of the manipulator and the farthest distribution interval EE of the manipulator. fron , according to the inaccessible area Ω of the robot and the farthest distribution interval EE of the robot fron Determine the working range EE of the robot under the end constraint condition space ;

[0094] The sampling sphere acquisition module is used to obtain the EE of the working interval under the terminal constraint conditions. space Perform mathematical analysis to obtain the maximum sampling sphere area;

[0095] The path search module is used to generate a set of sampling points corresponding to the sampling sphere and determine the sampling sequence with the shortest path. The improved RRT algorithm is used to search for a path with the shortest total path length and a smooth change in the joint angles of adjacent sequences.

[0096] The driving and acquisition module is used to drive the robot arm to move to the specified sampling point according to the searched path, and control the vector network analyzer to collect radiation data, and obtain the spherical far-field scanning data of the EMI radiation source after the collection, and the vector network analyzer feeds back the spherical far-field scanning data of the EMI radiation source to the control computer;

[0097] The imaging module is used to image the EMI radiation source according to the spherical far-field scanning data by using a far-field and near-field imaging automatic focusing algorithm.

[0098] The implementation method of the specific functions of each module in the control computer can refer to the implementation method described in the above-mentioned embodiment of the EMI spherical scanning imaging method based on the robotic arm, which will not be repeated here.

[0099] In order to verify the feasibility of the aforementioned EMI spherical scanning imaging method based on a mechanical arm, the present invention has built an experimental simulation verification system. In the experimental simulation verification system, the module under test is composed of a signal generator and a measurement reference source. The measurement reference source is a patch antenna composed of two square microstrips, and the patch antenna uses FR4 material as a substrate, with a dielectric constant er=4.4F / M, a dielectric loss tangent of 0.02, and a thickness of 0.8mm for the patch antenna; the detection module is composed of a detection antenna and a reference antenna installed at the end of the mechanical arm. There is a certain distance between the reference antenna and the mechanical arm, which is used to detect electromagnetic signals in the air as a reference. The control computer, as the control center of the entire system, respectively forms a device network with the vector network analyzer VNA and the mechanical arm through the general-purpose interface bus (GPIB) to realize the communication of the system. Before starting the experiment, the frequency and power of the output signal of the signal generator are first set, and the resonant frequency of the complex amplitude distribution of the radiation source is determined by the spectrum analyzer. During the experiment, the control computer drives the robot arm to move to the specified sampling point, and then controls the VNA to obtain the radiation data of the A and B channels and transmits it to the control computer. The above process is repeated until the robot arm has traversed all sampling points. The control computer uses the HFSS simulation software to obtain the radiation field of the measurement reference source. This simulation field can be used as a reference to verify the performance of the spherical ESM scanning imaging system.

[0100] The present invention takes the system modeling and control strategy of the manipulator under the ESM spherical scanning imaging detection task as the research object. By modeling the constraints such as the manipulator configuration, the polarization characteristics of the detection antenna and the spherical scanning boundary, a configuration selection and scanning surface (imaging aperture) generation method of the manipulator under the above constraints is proposed. On the basis of obtaining the maximum scanning surface, the optimal motion planning and automatic focusing algorithm of the robot under this task are further solved. The average joint change angle reduction, automatic focusing and precise imaging are achieved, which can provide theoretical and methodological support for the design of the spherical ESM scanning robot and be applied to the EMI detection and positioning application of electronic systems.

[0101] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0102] The above-mentioned embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.

Claims

1. An EMI spherical scanning imaging method based on a robotic arm, characterized in that: The following steps are involved: Step 1: Build a robot model and determine the inaccessible area Ω of the robot wrist w and the farthest area from the wrist fron , and according to the wrist inaccessible area Ω w and the farthest area W of the wrist position fron Determine the wrist working range W of the robot space ; Step 2: With the end constraint condition that the end of the robotic arm always points to the radiation source, the wrist inaccessible area Ω w and the farthest area W of the wrist position fron The points on the upper edge are offset by the unit vectors corresponding to the end constraints to obtain the corresponding unreachable area Ω of the manipulator and the farthest distribution interval EE of the manipulator. fron , according to the inaccessible area Ω of the robot and the farthest distribution interval EE of the robot fron Determine the working range EE of the robot under the end constraint condition space ; Step 3: EE of the working interval under the terminal constraints space Perform mathematical analysis to obtain the maximum sampling sphere area; Step 4: Generate a sampling point set corresponding to the sampling sphere and determine the sampling sequence with the shortest path. Use the improved RRT algorithm to search for a path with the shortest total path length and a smooth change in the joint angles of adjacent sequences. Step 5: Collect radiation data according to the searched path to obtain spherical far-field scanning data of the EMI radiation source; Step 6: Based on the spherical far-field scanning data, the EMI radiation source is imaged using a far-field and near-field imaging automatic focusing algorithm. The far-field and near-field imaging automatic focusing algorithm calculates the amplitude intensity contrast of the imaging results at different phase transformation distances, and selects the phase transformation distance with the smallest amplitude intensity contrast as the phase transformation distance after refocusing.

2. The EMI spherical scanning imaging method based on a mechanical arm according to claim 1, characterized in that: The wrist inaccessible area Ω w The formula is as follows: Ω w :x 2 +y 2 +(z-d1) 2 ≤r short 2 (3) Among them, the connecting rod distance d1 represents the distance that the robot arm joint translates along the z1 axis, r short is the shortest distance between the wrist position W and the shoulder position S of the robot under the joint angle limit; the farthest area of ​​the wrist position W fron The formula is as follows: W fron : Among them, the connecting rod distance d4 is the translation distance of the robot joint along the z4 axis, a2 is the translation distance of the robot joint along the x2 axis, lim=[-120°, 120°], Represents the elevation angle in the base coordinate system x1y1z1; The wrist working area W of the robot arm space The formula is as follows: 。 3. The EMI spherical scanning imaging method based on a mechanical arm according to claim 2, characterized in that: The formula of the robot's inaccessible area Ω is as follows: Oh: Among them, [l x l y l z ] T is the unit vector corresponding to the end constraint condition, and the farthest distribution interval of the robot arm is EE fron The formula is as follows: EE fron : Working interval EE under terminal constraints space The formula is as follows: 。 4. The EMI spherical scanning imaging method based on a mechanical arm according to claim 1, characterized in that: In step 3, the working interval EE under the terminal constraint condition space The process of performing mathematical analysis includes the following steps: Assume that the sampling sphere has the radiation source O' as the center and R s is the sampling radius, ignoring the working interval EE space The influence of irregular areas in the working interval EE is only considered above the x1o1y1 plane space The sampling sphere area S up , while fixing the center of the ball O' on the y1 axis and the corresponding coordinate on the axis is w; define the farthest distribution interval EE between the complete sampling sphere and the robotic arm fron The intersection line when the boundaries intersect is L; With O' as the origin and ray O'x' parallel to ray o1x1 and in the same direction as ray o1x1 as the polar axis, a two-dimensional polar coordinate system x'O'y' is established. The projection L' of the intersection line L on x1o1y1 is a line segment. The expression of line segment L' is: L′: Among them, β is the polar angle in the two-dimensional polar coordinate system x'O'y', and the range is [-π,π]. The calculation formula is as follows: Among them, the connecting rod distance d1 and the connecting rod distance d4 represent the translation distances of the robot joint along the z1 axis and the z4 axis respectively, a2 is the translation distance of the robot joint along the x2 axis, R s is the sampling radius; Calculate the area S of the sampling sphere up : S up =πR s 2 (1+|sin(β)|) (11) The area of ​​the sampling sphere S up The maximum is the objective function for nonlinear programming, and the farthest distribution interval EE of the robot arm fron A plane is generated at the position of the point with the maximum z coordinate value in the irregular area, and the scanning surface below the plane is cut off to obtain the final sampling area S after processing. scan .

5. The EMI spherical scanning imaging method based on a mechanical arm according to claim 1, characterized in that: Step 4 includes the following steps: Perform rasterization preprocessing on the sampling sphere to generate a sampling point set; Construct an undirected graph based on the spatial relationship of sampling points; Use the Christofides algorithm and the target loss function to search for the shortest path without repeated sampling and obtain the sampling sequence with the shortest path; Determine the pose matrix of each sampling point in the sampling sequence with the shortest path under the terminal constraint condition; According to the sampling sequence with the shortest path and the pose matrix of its sampling points, the improved RRT algorithm performs path search based on the joint angle search strategy, and searches for a path with the shortest total path length and smooth changes in the joint angles of adjacent sequences.

6. The EMI spherical scanning imaging method based on a mechanical arm according to claim 5, characterized in that: The objective loss function is: min{∑B(i,j)|v j ∈D-{v i }} (13) Among them, B(i,j) is the weight, which represents the two sampling endpoints v before and after i and v j The Euclidean distance of the connection line, D is the connection line between the sampling points; The rotation matrix of each sampling point is: R end =R ya R pi (17) in: According to the rotation matrix R of each sampling point end The position matrix corresponding to the sampling point is the pose matrix of the sampling point.

7. The EMI spherical scanning imaging method based on a mechanical arm according to claim 1, characterized in that: The mechanical arm adopts a six-degree-of-freedom mechanical arm.

8. An EMI spherical scanning imaging system based on a robotic arm, characterized in that: It includes a mechanical arm, a vector network analyzer and a control computer, wherein the control computer includes: The robot modeling module is used to build a robot model and determine the inaccessible area Ω of the robot wrist. w and the farthest area from the wrist fron , and according to the wrist inaccessible area Ω w and the farthest area W of the wrist position fron Determine the wrist working range W of the robot space ; The working range determination module is used to set the wrist inaccessible area Ω with the end of the robot arm always pointing to the radiation source as the end constraint condition w and the farthest area W of the wrist position fron The points on the upper edge are offset by the unit vectors corresponding to the end constraints to obtain the corresponding unreachable area Ω of the manipulator and the farthest distribution interval EE of the manipulator. fron , according to the inaccessible area Ω of the robot and the farthest distribution interval EE of the robot fron Determine the working range EE of the robot under the end constraint condition space ; The sampling sphere acquisition module is used to obtain the EE of the working interval under the terminal constraint conditions. space Perform mathematical analysis to obtain the maximum sampling sphere area; The path search module is used to generate a set of sampling points corresponding to the sampling sphere and determine the sampling sequence with the shortest path. The improved RRT algorithm is used to search for a path with the shortest total path length and a smooth change in the joint angles of adjacent sequences. The driving and acquisition module is used to drive the robot arm to move to the specified sampling point according to the searched path, and control the vector network analyzer to collect radiation data to obtain the spherical far-field scanning data of the EMI radiation source; An imaging module is used to image the EMI radiation source according to the spherical far-field scanning data using a far-field and near-field imaging automatic focusing algorithm. The far-field and near-field imaging automatic focusing algorithm calculates the amplitude intensity contrast of the imaging results at different phase transformation distances, and selects the phase transformation distance with the smallest amplitude intensity contrast as the phase transformation distance after refocusing.

Citation Information

Patent Citations

  • Mechanical arm control strategy and optimization method for microwave far field-near field scanning and imaging task

    CN115319758A