Robot tail end three-dimensional space position and vibration monitoring method and system

Through the method based on microwave perception, a three-dimensional spatial position and its vibration monitoring coordinate system are constructed, and the three-dimensional spatial position and vibration displacement time series at the end of the robot are solved, which solves the problems of low accuracy and susceptibility to the environment in the existing technology, and realizes the High-precision three-dimensional spatial position tracking and vibration monitoring improve the reliability and safety of the system.

CN118977273APending Publication Date: 2024-11-19SHANGHAI JIAOTONG UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410168495.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-02-06
Publication Date
2024-11-19

AI Technical Summary

Technical Problem

The prior art is difficult to realize high-precision position tracking and vibration monitoring of robot ends in three-dimensional space, especially in large-scale movement and complex environments, where there is a problem of low accuracy and susceptibility to environmental factors.

Method used

Using a microwave perception method, by installing a microwave transceiver at the end of the robot, selecting a reference target to build a three-dimensional spatial position and its vibration monitoring coordinate system, extracting distance and displacement information from the baseband signal, and solving the three-dimensional spatial position and vibration at the end of the robot Displacement time series, high-precision monitoring is achieved using differential solution and filtering processing.

Benefits of technology

It realizes synchronous automated monitoring of the three-dimensional spatial position and vibration displacement of the robot at the end, solves the problems of high-precision tracking and vibration measurement under poor lighting conditions and large-scale motion, improves the accuracy and convenience of monitoring, and reduces the risk of accidents.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977273A_ABST
    Figure CN118977273A_ABST
Patent Text Reader

Abstract

The invention provides a robot tail end three-dimensional space position and vibration monitoring method and system. The robot tail end three-dimensional space position and vibration monitoring method comprises the steps that S1, a robot tail end position and vibration monitoring coordinate system is established; s2, resolving the initial three-dimensional space position of the tail end of the robot under the coordinate system established in the step S1; and S3, robot tail end three-dimensional space position tracking and vibration displacement monitoring are carried out. According to the method and system provided by the invention, the problems of high-precision tracking of the three-dimensional space tail end position of the robot and high-precision monitoring of the three-dimensional vibration of the robot under the working conditions of poor illumination conditions, large-range movement and the like are solved through microwave sensing and a corresponding processing method, and the three-dimensional space position of the tail end of the robot and the scene of monitoring the three-dimensional space position of the tail end of the robot are expanded.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot terminal monitoring technology, and specifically, to a three-dimensional spatial position of a robot terminal and its vibration monitoring method and system, and more particularly to a three-dimensional spatial position of a robot terminal and its vibration monitoring method and system based on microwave sensing. Background Art

[0002] With the continuous development of robot technology, robots have been more and more widely used in many fields. The end position and vibration monitoring of robots are crucial to ensure their normal operation and related environmental safety. In industrial production, ensuring the accuracy of the end position of the robot and vibration monitoring helps to improve operational accuracy and production safety. In the medical field, this technology can ensure the accuracy and safety of robot surgery. In underground tunnels, mine exploration and other projects, the end position and vibration monitoring of robots can monitor the movement state of robots in complex environments in real time, prevent abnormal vibrations that may cause structural damage, and ensure the safety and stability of engineering structures. Therefore, real-time monitoring of the end position and vibration of robots has an urgent engineering demand, which is of great significance to improving system reliability and safety and reducing accident risks.

[0003] In response to the above needs, the main monitoring methods currently include inertial navigation systems, visual sensors, ultrasonic sensors, etc. Among them, the inertial navigation system is sensitive to cumulative errors, and long-term use may cause position drift, and the price is relatively high; the visual sensor is sensitive to environmental factors such as illumination and occlusion, and may fail under certain conditions; the ultrasonic sensor is affected by environmental factors (such as temperature, humidity) and obstacles, and the accuracy is relatively low. Therefore, it is difficult to track the position of the robot end with high precision when it moves over a large range in three-dimensional space, and its vibration displacement measurement in three-dimensional space also lacks high-precision means. Existing technologies and methods are difficult to meet the needs of high-precision, large-range position changes, three-dimensional vibration measurement, etc. for robot ends and their vibration monitoring, and there are great limitations in terms of perception convenience, requirements for scene lighting conditions, and test automation. Summary of the invention

[0004] In view of the defects in the prior art, an object of the present invention is to provide a method and system for monitoring the three-dimensional spatial position and vibration of a robot end.

[0005] A method for monitoring the three-dimensional spatial position of a robot end and its vibration based on microwave sensing is provided according to the present invention, comprising:

[0006] Step S1: Establish the robot end position and vibration monitoring coordinate system;

[0007] Step S2: Calculate the initial three-dimensional spatial position of the robot end in the coordinate system established in step S1;

[0008] Step S3: Three-dimensional spatial position tracking and vibration displacement monitoring of the robot end

[0009] Preferably, the step S1 includes:

[0010] Install a microwave transceiver at the robot end, select a reference plane within the field of view of the microwave transceiver, select three non-collinear measurement points in the reference plane as reference targets, and use the three reference targets to construct a three-dimensional spatial position and vibration monitoring coordinate system of the robot end

[0011] Preferably, the step S2 includes:

[0012] Assume that the coordinates of the robot end position in the coordinate system constructed in step S1 are (xDev, yDev, zDev), and the distances from each reference target to the microwave transceiver extracted from the baseband signal are R1, R2, and R3 respectively, and we get:

[0013]

[0014] where F n (n = 1, 2, 3) represents the function mapping relationship, r ij (1 ≤ i < j ≤ 3) represents the Euclidean distance between the i-th reference target and the j-th reference target; R1, R2, and R3 are the distances from each reference target to the microwave transceiver extracted from the baseband signal

[0015] Assume that at the initial moment, the distances from each reference target to the microwave transceiver extracted from the baseband signal are respectively Substitute into the function relationship to obtain the initial coordinates (xDev 0 , yDev 0 , zDev 0 ) of the robot end

[0016] Preferably, the step S3 includes:

[0017] Assume that the displacement time series of the three non-collinear reference targets extracted from the baseband signal are dR1(mT), dR2(mT), and dR3(mT) respectively, and the displacement time series of the robot end along the X, Y, and Z axes of the coordinate system established in step S1 are dxDev(mT), dyDev(mT), and dzDev(mT) respectively, where m = 1, 2,... is the equivalent displacement sampling period number, and T is the equivalent displacement sampling period time

[0018] Through the function F of the three-dimensional spatial coordinates (xDev, yDev, zDev) of the robot end position i(i=1,2,3) Differentiate R1, R2, and R3 to obtain the reconstructed mapping relationship between dxDev(mT), dyDev(mT), and dzDev(mT) and the displacement time series dR1(mT), dR2(mT), and dR3(mT) of the three reference targets, and obtain the displacement time series of the robot end in the X, Y, and Z directions of the coordinate system established in step S1.

[0019] Preferably, the displacement time series dxDev(mT), dyDev(mT), dzDev(mT) are processed to obtain the low-frequency component dxDev low (mT),dyDev low (mT),dzDev low (mT) and high frequency component dxDev high (mT),dyDev high (mT),dzDev high (mT), thus obtaining the change sequence of the three-dimensional spatial position coordinates of the robot end over time:

[0020]

[0021] And the vibration displacement time series:

[0022]

[0023] Among them, dxDev vib (mT),dyDev vib (mT), dzDev vib (mT) represents the vibration displacement time series of the robot end in the X, Y, and Z axis directions of the coordinate system established in step S1.

[0024] According to the present invention, a three-dimensional spatial position and vibration monitoring system of a robot end based on microwave perception is provided, comprising:

[0025] Module M1: Establish robot end position and vibration monitoring coordinate system;

[0026] Module M2: Calculate the initial three-dimensional spatial position of the robot end in the coordinate system established by module M1;

[0027] Module M3: Three-dimensional spatial position tracking and vibration displacement monitoring of the robot end.

[0028] Preferably, the module M1 comprises:

[0029] Install a microwave transceiver at the end of the robot. Select a reference plane within the field of view of the microwave transceiver, and select three non - collinear measurement points in the reference plane as reference targets. Use the three reference targets to construct the three - dimensional spatial position of the robot end and its vibration monitoring coordinate system.

[0030] Preferably, the module M2 includes:

[0031] Assume that the coordinates of the robot end position in the coordinate system constructed by the module M1 are (xDev, yDev, zDev). The distances from each reference target to the microwave transceiver extracted from the baseband signal are R1, R2, and R3 respectively, and we get:

[0032]

[0033] Among them, F n (n = 1, 2, 3) represents the function mapping relationship, and r ij (1 ≤ i < j ≤ 3) represents the Euclidean distance between the i - th reference target and the j - th reference target; R1, R2, and R3 are the distances from each reference target to the microwave transceiver extracted from the baseband signal;

[0034] Assume that at the initial moment, the distances from each reference target to the microwave transceiver extracted from the baseband signal are respectively Substitute into the function relation to obtain the initial coordinates (xDev 0 , yDev 0 , zDev 0 ) of the robot end.

[0035] Preferably, the module M3 includes:

[0036] Assume that the displacement time series of the three non - collinear reference targets extracted from the baseband signal are dR1(mT), dR2(mT), and dR3(mT) respectively, and the displacement time series of the robot end along the X, Y, and Z axes of the coordinate system established by the module M1 are dxDev(mT), dyDev(mT), and dzDev(mT) respectively. Among them, m = 1, 2,... is the equivalent displacement sampling period serial number, and T is the equivalent displacement sampling period time;

[0037] By performing differential solution on R1, R2, and R3 through the function F n (n = 1, 2, 3) of the three - dimensional spatial coordinates (xDev, yDev, zDev) of the robot end position, the reconstruction mapping relationships between dxDev(mT), dyDev(mT), dzDev(mT) and the displacement time series dR1(mT), dR2(mT), dR3(mT) of the three reference targets are obtained respectively, and the displacement time series of the robot end along the X, Y, and Z axes of the coordinate system established by the module M1 are obtained.

[0038] Preferably, the displacement time series dxDev(mT), dyDev(mT), dzDev(mT) are processed to obtain the low-frequency component dxDev low (mT),dyDev low (mT),dzDev low (mT) and high frequency component dxDev high (mT),dyDev high (mT),dzDev high (mT), thus obtaining the change sequence of the three-dimensional spatial position coordinates of the robot end over time:

[0039]

[0040] And the vibration displacement time series:

[0041]

[0042] Among them, dxDev vib (mT),dyDev vib (mT), dzDev vib (mT) represents the vibration displacement time series of the robot end in the X, Y, and Z axes of the coordinate system established in module M1.

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

[0044] 1. The monitoring method disclosed in the present invention can realize the synchronous automatic monitoring of the three-dimensional spatial position and vibration displacement of the robot end;

[0045] 2. The method and system proposed in the present invention solve the problem of high-precision tracking of the robot's three-dimensional spatial terminal position and high-precision monitoring of its three-dimensional vibration under working conditions such as poor lighting conditions and large-scale movement through microwave sensing and corresponding processing methods, and expand the scenarios of monitoring the three-dimensional spatial position and vibration of the robot's terminal.

[0046] 3. The method and system proposed in the present invention only require one microwave transceiver and a small number of reference targets to complete the ultra-large-scale spatial position tracking, positioning and vibration monitoring of a robot execution terminal, which is easy to operate in engineering and has a high degree of automation. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] Other features, objects and advantages of the present invention will become more apparent from the detailed description of non-limiting embodiments made with reference to the following drawings:

[0048] Figure 1It is a flow chart of the method for monitoring the three-dimensional spatial position of the robot end and its vibration based on microwave perception of the present invention;

[0049] Figure 2 It is a monitoring schematic diagram of the three-dimensional spatial position of the robot end and its vibration monitoring method and system based on microwave sensing of the present invention;

[0050] Figure 3 It is a schematic diagram of the filtering and extraction process of the time series of the coordinates of the three-dimensional space equilibrium position of the robot end and its vibration displacement time series according to an embodiment of the present invention;

[0051] Figure 4 This is a structural block diagram of the three-dimensional spatial position and vibration monitoring system of the robot terminal based on microwave perception of the present invention. DETAILED DESCRIPTION

[0052] The present invention is described in detail below in conjunction with specific embodiments. The following embodiments will help those skilled in the art to further understand the present invention, but are not intended to limit the present invention in any form. It should be noted that, for those of ordinary skill in the art, several changes and improvements can also be made without departing from the concept of the present invention. These all belong to the protection scope of the present invention.

[0053] The invention discloses a method for monitoring the three-dimensional spatial position and vibration of a robot terminal based on microwave perception. According to the spatial scene in which the robot is located, the position and mutual spacing relationship of the reference target are determined, and a coordinate system for monitoring the three-dimensional spatial position and vibration of the robot terminal is established. A microwave transceiver is fixed at the robot terminal, and the microwave transceiver is controlled to transmit and receive electromagnetic wave signals, and the generated baseband signal is collected. The distance from each reference target to the microwave transceiver and the displacement information of each reference target along the line of sight of the microwave transceiver are extracted from the baseband signal. Finally, the change sequence of the three-dimensional spatial position coordinates of the robot terminal over time is solved through the functional mapping relationship between the three-dimensional spatial coordinates of the robot terminal and the distance from each reference target to the microwave transceiver. The sequence includes the superposition of the three-dimensional spatial equilibrium position and three-dimensional vibration displacement time series of the robot terminal. The change sequence of the three-dimensional spatial equilibrium position coordinates of the robot terminal over time and the three-dimensional vibration displacement time series are extracted respectively by using a method including a filter as needed. The microwave transceiver is controlled to transmit and receive electromagnetic waves in real time by using automated measurement software, and the above-mentioned signal processing and calculation are performed to realize convenient real-time and high-precision perception of the three-dimensional spatial position and vibration of the robot terminal.

[0054] Specifically, the method for monitoring the three-dimensional spatial position and vibration of the robot terminal based on microwave sensing includes the following steps:

[0055] Step S1: Establish the robot end position and vibration monitoring coordinate system;

[0056] As Figure 2 shown, select a reference plane within the field of view of the microwave transceiver, such as the ground, or a wall surface, etc. Select three non-collinear measurement points within the reference plane as reference targets, and use these three reference targets to construct a three-dimensional space position of the robot end and its vibration monitoring coordinate system.

[0057] For example, take the position of the No. 1 reference target as the coordinate origin, the positive direction of the Y-axis points from the No. 1 reference target to the No. 2 reference target, the positive direction of the X-axis is perpendicular to the positive direction of the Y-axis and points to the half-plane where the No. 3 reference target is located. The positive direction of the Z-axis points to the half-space where the robot is located. Under the coordinate system constructed in step S1, the coordinates of the i-th reference target are denoted as (x i , y i , z i )(i = 1, 2, 3). The Euclidean distances between the three reference targets are respectively denoted as: r 12 , r 13 , r 23 . Among them, r ij (1 ≤ i < j ≤ 3) represents the Euclidean distance between the i-th reference target and the j-th reference target.

[0058] Step S2: Calculate the initial three-dimensional space position of the robot end;

[0059] Assume that the coordinates of the robot end position under the coordinate system constructed in step S1 are (xDev, yDev, zDev), and the distances from each reference target to the microwave transceiver extracted from the baseband signal are R1, R2, R3 respectively. Then we can get:

[0060]

[0061] Among them, F n (n = 1, 2, 3) represents the function mapping relationship, r ij (1 ≤ i < j ≤ 3) represents the Euclidean distance between the i-th reference target and the j-th reference target, both of which are constants; R1, R2, R3 are the distances from each reference target to the microwave transceiver extracted from the baseband signal, and all change with time. In this way, the functional relationship between the three-dimensional space position coordinates of the robot end and R1, R2, R3 is calculated.

[0062] Assume that at the initial moment, the distances from each reference target to the microwave transceiver extracted from the baseband signal are Substitute them into the above functional relationship formula, and the initial coordinates (xDev 0 , yDev 0 , zDev 0 ) of the robot end can be obtained.

[0063] Specifically, according to the Euclidean distance from the microwave transceiver to the three reference targets in step S1, it can be obtained:

[0064]

[0065] in, is the vector pointing from reference target 1 to reference target 3 The angle with the Y axis.

[0066] Then we can solve it and get:

[0067]

[0068] Assume that at the initial moment, the distances from each reference target extracted from the baseband signal to the microwave transceiver are Substituting the above functional relationship, we can get the initial coordinates of the robot end (xDev 0 ,yDev 0 ,zDev 0 ).

[0069] Step S3: three-dimensional spatial position tracking and vibration displacement monitoring of the robot end;

[0070] Assume that the displacement time series of the three non-collinear reference targets extracted from the baseband signal are dR1(mT), dR2(mT), and dR3(mT), and the displacement time series of the X, Y, and Z axes of the coordinate system established by the robot end along the module M1 are dxDev(mT), dyDev(mT), and dzDev(mT), respectively, where m=1, 2, ... is the equivalent displacement sampling cycle number, and T is the equivalent displacement sampling cycle time. Through the three-dimensional spatial coordinates (xDev, yDev, zDev) of the robot end position function F i (i=1,2,3) Differentiate R1, R2, and R3 to obtain the reconstructed mapping relationship between dxDev(mT), dyDev(mT), and dzDev(mT) and the displacement time series dR1(mT), dR2(mT), and dR3(mT) of the three reference targets, and obtain the displacement time series of the robot end in the X, Y, and Z directions of the coordinate system established in step S1.

[0071] Specifically, the three-dimensional space coordinates (xDev, yDev, zDev) of the robot end position can be expressed as a function of F i (i=1,2,3) The second-order Taylor expansion of R1, R2, R3 gives:

[0072]

[0073]

[0074]

[0075] The above formula can be written in matrix form as:

[0076]

[0077] in,

[0078] M=[dxDev(mT) dyDev(mT) dzDev(mT)] T ,

[0079]

[0080] dR=[dR1(mT) dR2(mT) dR3(mT)] T ,

[0081]

[0082] The displacement time series dxDev(mT), dyDev(mT), and dzDev(mT) obtained above include the displacement caused by the three-dimensional spatial position of the robot end moving over time and the displacement caused by vibration. The former is characterized by large amplitude and low frequency; the latter is characterized by small amplitude and high frequency. The low-frequency component dxDev can be obtained by using filters as needed. low (mT),dyDev low (iT),dzDev low (mT) and high frequency component dxDev high (mT),dyDev high (mT),dzDev high (mT), and further processing to obtain the change sequence of the three-dimensional spatial position coordinates of the robot end over time:

[0083]

[0084] And the vibration displacement time series:

[0085]

[0086] Among them, dxDev vib (mT),dyDev vib (mT), dzDev vib (mT) represents the vibration displacement time series of the robot end in the X, Y, and Z axes of the coordinate system established in step S1. vib (mT),dyDev vib (mT), dzDev vib(mT) represents the vibration displacement time series of the robot end in the X, Y, and Z axis directions of the coordinate system established in step S1.

[0087] The robot end referred to in the present invention includes but is not limited to the robot end actuator, the robot's motion arms, and the working mechanisms of various mechanical equipment including cranes, excavators, and cranes, and other moving parts that can produce spatial or planar displacement.

[0088] The three-dimensional spatial position and vibration monitoring system of the robot terminal based on microwave sensing includes:

[0089] The microwave transceiver is fixed on the end of the robot, transmits frequency-modulated continuous-wave microwave signals, receives echo signals from reference targets, and outputs baseband signals for subsequent processing.

[0090] The control module is used to configure the sensing parameters, microwave transmission and reception, and signal processing operations of the microwave transceiver.

[0091] The signal processing module includes a baseband signal processing unit and a unit for reconstructing the three-dimensional spatial position and vibration displacement of the robot end.

[0092] The baseband signal processing unit processes the baseband signal output by the microwave transceiver, and processes the baseband signal to obtain the Euclidean distance from the reference target to the microwave transceiver and the displacement of the reference target along the line of sight of the microwave transceiver.

[0093] The processing content of the three-dimensional spatial position and vibration displacement reconstruction unit of the robot terminal includes using the processing result of the baseband signal processing unit to solve the spatial position and three-dimensional vibration displacement time series of the robot terminal.

[0094] The data access and display output module is used to display and store information including but not limited to intermediate processing information, robot position and vibration displacement measurement data, and abnormal working condition identification and elimination information as needed, and transmit relevant analog and digital quantities to the data platform through methods including but not limited to network cable transmission, WiFi transmission, Bluetooth transmission, etc.

[0095] The reference target module is used to install or arrange the reference target to construct the three-dimensional spatial position of the robot end and its vibration displacement measurement coordinate system.

[0096] Those skilled in the art know that, in addition to realizing the system and its various devices, modules, and units provided by the present invention in a purely computer-readable program code, it is entirely possible to realize the same functions in the form of logic gates, switches, application-specific integrated circuits, programmable logic controllers, and embedded microcontrollers by logically programming the method steps. Therefore, the system and its various devices, modules, and units provided by the present invention can be considered as a hardware component, and the devices, modules, and units included therein for realizing various functions can also be regarded as structures within the hardware component; the devices, modules, and units for realizing various functions can also be regarded as both software modules for realizing the method and structures within the hardware component.

[0097] In the description of the present application, it should be understood that the terms "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside", etc., indicating orientations or positional relationships, are based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present application and simplifying the description, and do not indicate or imply that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as a limitation on the present application.

[0098] The above describes the specific embodiments of the present invention. It should be understood that the present invention is not limited to the above specific embodiments, and those skilled in the art can make various changes or modifications within the scope of the claims, which does not affect the essence of the present invention. In the absence of conflict, the embodiments of the present application and the features in the embodiments can be combined with each other arbitrarily.

Claims

1. A method for monitoring the three-dimensional spatial position of a robot end and its vibration, It is characterized in that include: Step S1: Establish the robot end position and vibration monitoring coordinate system; Step S2: Calculate the initial three-dimensional spatial position of the robot end in the coordinate system established in step S1; Step S3: Three-dimensional spatial position tracking and vibration displacement monitoring of the robot end.

2. The three-dimensional spatial position and vibration monitoring method of the robot end according to claim 1, It is characterized in that The step S1 comprises: A microwave transceiver is installed at the end of the robot, a reference plane is selected within the field of view of the microwave transceiver, three non-collinear measuring points are selected in the reference plane as reference targets, and the three reference targets are used to construct the three-dimensional spatial position of the robot end and its vibration monitoring coordinate system.

3. The three-dimensional spatial position and vibration monitoring method of the robot end according to claim 1, It is characterized in that The step S2 comprises: Assume that the coordinates of the robot end position in the coordinate system constructed in step S1 are (xDev, yDev, zDev), and the distances from each reference target to the microwave transceiver extracted from the baseband signal are R 1 ,R 2 ,R 3 ,get: Among them, F n (n = 1, 2, 3) represents the function mapping relationship, and r ij (1 ≤ i < j ≤ 3) represents the Euclidean distance between the i-th reference target and the j-th reference target; R 1 , R 2 , R 3 is the distance from each reference target extracted from the baseband signal to the microwave transceiver; Assume that at the initial moment, the distances from each reference target extracted from the baseband signal to the microwave transceiver are Substituting the function relationship, we can get the initial coordinates of the robot end (xDev 0 ,yDev 0 ,zDev 0 ).

4. The three-dimensional spatial position and vibration monitoring method of the robot end according to claim 1, It is characterized in that The step S3 comprises: Assume that the displacement time series of the three non-collinear reference targets extracted from the baseband signal are dR 1 (mT),dR 2 (mT),dR 3 (mT), the displacement time series of the robot end along the X, Y, and Z axes of the coordinate system established in step S1 are dxDev(mT), dyDev(mT), and dzDev(mT), respectively, where m=1, 2, ... is the equivalent displacement sampling cycle number, and T is the equivalent displacement sampling cycle time; Through the three-dimensional space coordinates (xDev, yDev, zDev) of the robot end position function F n (n=1,2,3) for R 1 ,R 2 ,R 3 By performing differential solution, we can obtain the displacement time series dR of dxDev(mT),dyDev(mT),dzDev(mT) and the three reference targets respectively. 1 (mT),dR 2 (mT),dR 3 The reconstructed mapping relationship of (mT) is obtained to obtain the displacement time series of the robot end along the X, Y, and Z axes of the coordinate system established in step S1.

5. The three-dimensional spatial position and vibration monitoring method of the robot end according to claim 4, It is characterized in that The displacement time series dxDev(mT), dyDev(mT), dzDev(mT) are processed to obtain the low-frequency component dxDev low (mT),dyDev low (mT),dzDev low (mT) and high frequency component dxDev high (mT),dyDev high (mT),dzDev high (mT), thus obtaining the change sequence of the three-dimensional spatial position coordinates of the robot end over time: And the vibration displacement time series: Among them, dxDev vib (mT),dyDev vib (mT), dzDev vib (mT) represents the vibration displacement time series of the robot end in the X, Y, and Z axis directions of the coordinate system established in step S1.

6. A robot terminal three-dimensional spatial position and vibration monitoring system, It is characterized in that include: Module M1: Establish robot end position and vibration monitoring coordinate system; Module M2: Calculate the initial three-dimensional spatial position of the robot end in the coordinate system established by module M1; Module M3: Three-dimensional spatial position tracking and vibration displacement monitoring of the robot end.

7. The robot end three-dimensional spatial position and vibration monitoring system according to claim 1, It is characterized in that The module M1 comprises: A microwave transceiver is installed at the end of the robot, a reference plane is selected within the field of view of the microwave transceiver, three non-collinear measuring points are selected in the reference plane as reference targets, and the three reference targets are used to construct the three-dimensional spatial position of the robot end and its vibration monitoring coordinate system.

8. The robot end three-dimensional spatial position and vibration monitoring system according to claim 1, It is characterized in that The module M2 comprises: Assume that the coordinates of the robot end position in the coordinate system constructed by module M1 are (xDev, yDev, zDev), and the distances from each reference target to the microwave transceiver extracted from the baseband signal are R 1 ,R 2 ,R 3 ,get: Among them, F n (n = 1, 2, 3) represents a function mapping relationship, and r ij (1 ≤ i < j ≤ 3) represents the Euclidean distance between the i-th reference target and the j-th reference target; R 1 , R 2 , R 3 are the distances from each reference target extracted from the baseband signal to the microwave transceiver; Assume that at the initial moment, the distances from each reference target extracted from the baseband signal to the microwave transceiver are Substituting the function relationship, we can get the initial coordinates of the robot end (xDev 0 ,yDev 0 ,zDev 0 ).

9. The robot end three-dimensional spatial position and vibration monitoring system according to claim 1, It is characterized in that The module M3 comprises: Assume that the displacement time series of the three non-collinear reference targets extracted from the baseband signal are dR 1 (mT),dR 2 (mT),dR 3 (mT), the displacement time series of the robot end in the X, Y, and Z axes of the coordinate system established by module M1 are dxDev(mT), dyDev(mT), and dzDev(mT), respectively, where m=1, 2, ... is the equivalent displacement sampling cycle number, and T is the equivalent displacement sampling cycle time; Through the three-dimensional space coordinates (xDev, yDev, zDev) of the robot end position function F n (n=1,2,3) for R 1 ,R 2 ,R 3 By performing differential solution, we can obtain the displacement time series dR of dxDev(mT),dyDev(mT),dzDev(mT) and the three reference targets respectively. 1 (mT),dR 2 (mT),dR 3 The reconstructed mapping relationship of (mT) is obtained to obtain the displacement time series of the robot end along the X, Y, and Z axes of the coordinate system established by module M1.

10. The robot end three-dimensional spatial position and vibration monitoring system according to claim 9, It is characterized in that The displacement time series dxDev(mT), dyDev(mT), dzDev(mT) are processed to obtain the low-frequency component dxDev low (mT),dyDev low (mT),dzDev low (mT) and high frequency component dxDev high (mT),dyDev high (mT),dzDev high (mT), thus obtaining the change sequence of the three-dimensional spatial position coordinates of the robot end over time: And the vibration displacement time series: Among them, dxDev vib (mT),dyDev vib (mT), dzDev vib (mT) represents the vibration displacement time series of the robot end in the X, Y, and Z axes of the coordinate system established in module M1.