Method, device and terminal equipment for establishing actual kinematic transformation relationship of multi-axis motion system

By obtaining the actual motion parameters and theoretical coordinate transformation relationships of the multi-axis motion system, a coordinate transformation matrix is ​​established, and the problem of low accuracy of theoretical coordinate transformation relationships in the multi-axis motion system is solved, and the accurate reflection of the relationship between the motion axis and the execution end is achieved. and the precise compensation of the motion trajectory improves the accuracy of the kinematic transformation relationship.

CN113793391BActive Publication Date: 2024-11-22SUZHOU INOVANCE CONTROL TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111025249.4
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-09-03
Publication Date
2024-11-22
Estimated Expiration
2041-09-03

AI Technical Summary

Technical Problem

The accuracy of the theoretical coordinate transformation relationship of the existing multi-axis motion system is low, resulting in the inability to effectively compensate for geometric errors between the motion axes, affecting the accuracy of the motion trajectory.

Method used

By obtaining the actual motion parameters of the multi-axis motion system, combining the theoretical coordinate transformation relationship, a coordinate transformation matrix is ​​established, the geometric errors between the motion axes are eliminated, and the actual kinematic transformation relationship is obtained to improve accuracy.

Benefits of technology

The accuracy of the kinematic transformation relationship of the multi-axis motion system is improved, the relationship between the motion axis and the execution end is accurately reflected, and the accuracy of the motion trajectory is enhanced.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN113793391B_ABST
    Figure CN113793391B_ABST
Patent Text Reader

Abstract

The present invention discloses a method for establishing an actual kinematic transformation relationship of a multi-axis motion system, the method comprising the following steps: obtaining actual motion parameters of the multi-axis motion system; establishing a coordinate transformation matrix based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters; and obtaining the actual kinematic transformation relationship of the multi-axis motion system based on the coordinate transformation matrix. The present invention also discloses an apparatus for establishing an actual kinematic transformation relationship of a multi-axis motion system, a terminal device, and a computer-readable storage medium. By utilizing the method of the present invention, the technical effect of improving the accuracy of the kinematic transformation relationship of the multi-axis motion system is achieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of automatic control technology, and in particular to a method, device, terminal equipment and computer-readable storage medium for establishing actual kinematic transformation relationships of a multi-axis motion system. Background Art

[0002] As the processing and manufacturing industry has higher and higher requirements for processing accuracy, efficiency and complexity, multi-axis motion systems such as multi-axis machine tools and articulated robots are widely used in processing and manufacturing. Articulated robots and multi-axis machine tools, which are multi-axis motion systems composed of multiple rotating axes or rotating axes and linear axes, have improved processing accuracy and efficiency and enriched processing methods. Among them, the most commonly used multi-axis machine tool is the five-axis machine tool.

[0003] In the related art, a theoretical coordinate transformation relationship of the multi-axis motion system is determined based on the actual system structure of the multi-axis motion system.

[0004] However, the accuracy of the theoretical coordinate transformation relationship of the existing multi-axis motion system is low. Summary of the invention

[0005] The main purpose of the present invention is to provide a method, device, terminal equipment and computer-readable storage medium for establishing the actual kinematic transformation relationship of a multi-axis motion system, aiming to solve the technical problem of low accuracy of the theoretical coordinate transformation relationship of the existing multi-axis motion system in the prior art.

[0006] To achieve the above object, the present invention proposes a method for establishing an actual kinematic transformation relationship of a multi-axis motion system, the method comprising the following steps:

[0007] Acquiring actual motion parameters of the multi-axis motion system;

[0008] Based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters, a coordinate transformation matrix is ​​established;

[0009] Based on the coordinate transformation matrix, the actual kinematic transformation relationship of the multi-axis motion system is obtained.

[0010] Optionally, the actual motion parameters include a plurality of first coordinates and a plurality of coordinate groups; and the step of obtaining the actual motion parameters of the multi-axis motion system includes:

[0011] Acquire a plurality of first coordinates of the execution terminal in the calibration coordinate system and a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system, wherein one first coordinate corresponds to one coordinate group;

[0012] The step of establishing a coordinate transformation matrix between the multiple motion axes based on the theoretical coordinate transformation relationship between the axes in the multi-axis motion system and the actual motion parameters comprises:

[0013] The coordinate transformation matrix is ​​constructed by using the system structure of the multi-axis motion system, the theoretical coordinate transformation relationship, the plurality of first coordinates and the plurality of coordinate groups.

[0014] Optionally, the execution terminal is fixedly connected to a positioning device; the step of obtaining a plurality of first coordinates of the execution terminal in a calibration coordinate system and a plurality of coordinate groups of the plurality of motion axes in a motion axis coordinate system comprises:

[0015] Collecting a plurality of second coordinates of the positioning device in the calibration coordinate system, and collecting a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system, one second coordinate corresponds to one coordinate group;

[0016] Acquiring the relative position relationship between the execution end and the positioning device;

[0017] The plurality of second coordinates are transformed using the relative position relationship to obtain the plurality of first coordinates.

[0018] Optionally, before the step of acquiring a plurality of second coordinates of the positioning device in the calibration coordinate system and acquiring a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system, the method further comprises:

[0019] Based on the multi-axis motion system, the number of the multiple motion axes, and the motion range of the multi-axis motion system, obtaining multiple target positions of the positioning device;

[0020] The step of acquiring a plurality of second coordinates of the positioning device in the calibration coordinate system and acquiring a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system comprises:

[0021] Collect multiple second coordinates corresponding to the multiple target positions of the positioning device, and collect multiple coordinate groups corresponding to the multiple motion axes at the multiple target positions, wherein the multiple second coordinates are coordinates in the calibration coordinate system, and the multiple coordinate groups are coordinate groups in the motion axis coordinate system.

[0022] Optionally, the step of collecting a plurality of second coordinates corresponding to the plurality of target positions of the positioning device, and collecting a plurality of coordinate groups corresponding to the plurality of motion axes at the plurality of target positions, comprises:

[0023] determining a selected target location among the plurality of target locations;

[0024] Controlling the positioning device to move to the selected target position;

[0025] Collecting the second coordinates of the positioning device corresponding to the selected target position;

[0026] Collecting the coordinate groups corresponding to the selected target positions of the multiple motion axes;

[0027] determining a new selected target location among the plurality of target locations;

[0028] The selected target position is updated using the new selected target position, and the step of controlling the positioning device to move to the selected target position is returned to be executed until the number of the second coordinates reaches a preset threshold, thereby obtaining the multiple second coordinates and the multiple coordinate groups.

[0029] Optionally, before the step of obtaining the relative position relationship between the execution terminal and the positioning device, the method further includes:

[0030] Controlling the execution end to move to a preset marking position;

[0031] Acquire first position information of a reference motion axis among the multiple motion axes;

[0032] Controlling the positioning device to move to the preset marking position;

[0033] Acquiring second position information of the reference motion axis;

[0034] The relative position relationship is obtained based on the first position information and the second position information.

[0035] Optionally, the positioning device includes a reading unit and a visual camera unit, the multiple target positions correspond to multiple preset marks, one target position corresponds to one preset mark, and each preset mark stores the two-dimensional coordinates corresponding to the target position corresponding to each preset mark in the calibration coordinate system; the step of collecting the second coordinates corresponding to the selected target position of the positioning device includes:

[0036] Reading the selected two-dimensional coordinates in the selected preset mark corresponding to the selected target position by the reading unit;

[0037] Collecting the vertical coordinates of the positioning device in the calibration coordinate system by the visual camera unit;

[0038] Based on the vertical coordinate and the selected two-dimensional coordinate, a second coordinate of the positioning device corresponding to the selected target position is obtained.

[0039] In addition, to achieve the above-mentioned purpose, the present invention also proposes a device for establishing actual kinematic transformation relationship of a multi-axis motion system, the device comprising:

[0040] An acquisition module, used for acquiring actual motion parameters of the multi-axis motion system;

[0041] An establishing module, used for establishing a coordinate transformation matrix based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters;

[0042] The obtaining module is used to obtain the actual kinematic transformation relationship of the multi-axis motion system based on the coordinate transformation matrix.

[0043] In addition, to achieve the above-mentioned purpose, the present invention also proposes a terminal device, which includes: a memory, a processor, and a program for establishing the actual kinematic transformation relationship of a multi-axis motion system stored in the memory and running on the processor, and when the program for establishing the actual kinematic transformation relationship of a multi-axis motion system is executed by the processor, the steps of the method for establishing the actual kinematic transformation relationship of a multi-axis motion system as described in any one of the above items are implemented.

[0044] In addition, to achieve the above-mentioned purpose, the present invention also proposes a computer-readable storage medium, on which is stored a program for establishing the actual kinematic transformation relationship of a multi-axis motion system. When the program for establishing the actual kinematic transformation relationship of a multi-axis motion system is executed by a processor, the steps of the method for establishing the actual kinematic transformation relationship of a multi-axis motion system as described in any of the above items are implemented.

[0045] The technical solution of the present invention proposes a method for establishing the actual kinematic transformation relationship of a multi-axis motion system, and the method includes the following steps: obtaining the actual motion parameters of the multi-axis motion system; establishing a coordinate transformation matrix based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters; and obtaining the actual kinematic transformation relationship of the multi-axis motion system based on the coordinate transformation matrix.

[0046] Because, in the existing method for establishing the actual kinematic transformation relationship of a multi-axis motion system, the trajectory of each motion axis is obtained based on the motion trajectory of the execution terminal and the theoretical coordinate transformation relationship corresponding to the motion of the multi-axis motion system. When the multi-axis motion system is assembled and manufactured, there are geometric errors such as non-perpendicularity between the motion axes and inaccurate angles between the motion axes, which makes the theoretical coordinate transformation relationship unable to accurately reflect the relationship between each motion axis and the execution terminal, thereby making the actual motion trajectory of the obtained multiple motion axes less accurate. In the present invention, the actual kinematic transformation relationship is obtained by using the actual motion parameters and the theoretical coordinate transformation relationship. The geometric errors of the multi-axis motion system in the actual motion process are added to the actual kinematic transformation relationship for compensation, thereby eliminating the geometric errors such as non-perpendicularity between the motion axes and inaccurate angles between the motion axes, so that the actual inverse kinematic transformation relationship can accurately reflect the relationship between each motion axis and the execution terminal, thereby achieving the technical effect of improving the accuracy of the kinematic transformation relationship of the multi-axis motion system. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the structures shown in these drawings without paying creative work.

[0048] Figure 1 A schematic diagram of the structure of a terminal device in a hardware operating environment involved in an embodiment of the present invention;

[0049] Figure 2 A schematic flow chart of a first embodiment of a method for establishing actual kinematic transformation relationships of a multi-axis motion system according to the present invention;

[0050] Figure 3 A schematic diagram of a preset mark of the present invention;

[0051] Figure 4 It is a structural schematic diagram of the first embodiment of the device for establishing actual kinematic transformation relationship of a multi-axis motion system of the present invention.

[0052] The realization of the purpose, functional features and advantages of the present invention will be further explained in conjunction with embodiments and with reference to the accompanying drawings. DETAILED DESCRIPTION

[0053] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0054] Reference Figure 1 , Figure 1 A schematic diagram of the terminal device structure of the hardware operating environment involved in the embodiment of the present invention.

[0055] Typically, the terminal device includes: at least one processor 301, a memory 302, and a program for establishing the actual kinematic transformation relationship of a multi-axis motion system stored in the memory and executable on the processor, wherein the program for establishing the actual kinematic transformation relationship of the multi-axis motion system is configured to implement the steps of the method for establishing the actual kinematic transformation relationship of the multi-axis motion system as described above.

[0056] The processor 301 may include one or more processing cores, such as a 4-core processor, an 8-core processor, etc. The processor 301 may be implemented in at least one hardware form of DSP (Digital Signal Processing), FPGA (Field-Programmable Gate Array), and PLA (Programmable Logic Array). The processor 301 may also include a main processor and a coprocessor. The main processor is a processor for processing data in the awake state, also known as a CPU (Central Processing Unit); the coprocessor is a low-power processor for processing data in the standby state. In some embodiments, the processor 301 may be integrated with a GPU (Graphics Processing Unit), which is responsible for rendering and drawing the content to be displayed on the display screen. The processor 301 may also include an AI (Artificial Intelligence) processor, which is used to process operations related to the actual kinematic transformation relationship establishment method of the multi-axis motion system, so that the actual kinematic transformation relationship establishment method model of the multi-axis motion system can be trained and learned autonomously to improve efficiency and accuracy.

[0057] The memory 302 may include one or more computer-readable storage media, which may be non-transitory. The memory 302 may also include a high-speed random access memory, and a non-volatile memory, such as one or more disk storage devices, flash memory storage devices. In some embodiments, the non-transitory computer-readable storage medium in the memory 302 is used to store at least one instruction, which is used to be executed by the processor 301 to implement the method for establishing the actual kinematic transformation relationship of the multi-axis motion system provided in the method embodiment of the present application.

[0058] In some embodiments, the terminal may further optionally include: a communication interface 303 and at least one peripheral device. The processor 301, the memory 302 and the communication interface 303 may be connected via a bus or a signal line. Each peripheral device may be connected to the communication interface 303 via a bus, a signal line or a circuit board. Specifically, the peripheral device includes: at least one of a radio frequency circuit 304, a display screen 305 and a power supply 306.

[0059] The communication interface 303 may be used to connect at least one peripheral device related to I / O (Input / Output) to the processor 301 and the memory 302. In some embodiments, the processor 301, the memory 302, and the communication interface 303 are integrated on the same chip or circuit board; in some other embodiments, any one or two of the processor 301, the memory 302, and the communication interface 303 may be implemented on a separate chip or circuit board, which is not limited in this embodiment.

[0060] The radio frequency circuit 304 is used to receive and transmit RF (Radio Frequency) signals, also known as electromagnetic signals. The radio frequency circuit 304 communicates with the communication network and other communication devices through electromagnetic signals. The radio frequency circuit 304 converts the electrical signal into an electromagnetic signal for transmission, or converts the received electromagnetic signal into an electrical signal. Optionally, the radio frequency circuit 304 includes: an antenna system, an RF transceiver, one or more amplifiers, a tuner, an oscillator, a digital signal processor, a codec chipset, a user identity module card, and the like. The radio frequency circuit 304 can communicate with other terminals through at least one wireless communication protocol. The wireless communication protocol includes, but is not limited to: a metropolitan area network, various generations of mobile communication networks (2G, 3G, 4G and 5G), a wireless local area network and / or a WiFi (Wireless Fidelity) network. In some embodiments, the radio frequency circuit 304 may also include circuits related to NFC (Near Field Communication), which is not limited in this application.

[0061] The display screen 305 is used to display the UI (User Interface). The UI may include graphics, text, icons, videos and any combination thereof. When the display screen 305 is a touch display screen, the display screen 305 also has the ability to collect touch signals on the surface or above the surface of the display screen 305. The touch signal can be input to the processor 301 as a control signal for processing. At this time, the display screen 305 can also be used to provide virtual buttons and / or virtual keyboards, also known as soft buttons and / or soft keyboards. In some embodiments, the display screen 305 can be one, the front panel of the electronic device; in other embodiments, the display screen 305 can be at least two, respectively arranged on different surfaces of the electronic device or in a folding design; in some further embodiments, the display screen 305 can be a flexible display screen, arranged on a curved surface or a folding surface of the electronic device. Even, the display screen 305 can also be set to a non-rectangular irregular shape, that is, a special-shaped screen. The display screen 305 can be made of materials such as LCD (Liquid Crystal Display), OLED (Organic Light-Emitting Diode, organic light-emitting diode).

[0062] The power supply 306 is used to power various components in the electronic device. The power supply 306 can be an alternating current, a direct current, a disposable battery, or a rechargeable battery. When the power supply 306 includes a rechargeable battery, the rechargeable battery can support wired charging or wireless charging. The rechargeable battery can also be used to support fast charging technology.

[0063] Those skilled in the art will understand that Figure 1 The structure shown in the figure does not constitute a limitation on the terminal device, and may include more or less components than shown in the figure, or combine certain components, or arrange the components differently.

[0064] In addition, an embodiment of the present invention further proposes a computer-readable storage medium, on which a program for establishing the actual kinematic transformation relationship of a multi-axis motion system is stored, and when the program for establishing the actual kinematic transformation relationship of the multi-axis motion system is executed by a processor, the steps of the method for establishing the actual kinematic transformation relationship of the multi-axis motion system as described above are implemented. Therefore, it will not be repeated here. In addition, the description of the beneficial effects of adopting the same method will not be repeated. For technical details not disclosed in the computer-readable storage medium embodiment involved in this application, please refer to the description of the method embodiment of this application. As an example, the program instructions can be deployed to be executed on one terminal device, or on multiple terminal devices located at one location, or on multiple terminal devices distributed at multiple locations and interconnected by a communication network.

[0065] Those skilled in the art can understand that all or part of the processes in the above-mentioned embodiments can be implemented by instructing the relevant hardware through a computer program, and the above-mentioned program can be stored in a computer-readable storage medium, and when the program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, the above-mentioned computer-readable storage medium can be a disk, an optical disk, a read-only memory (ROM) or a random access memory (RAM), etc.

[0066] Based on the above hardware structure, an embodiment of the method for establishing the actual kinematic transformation relationship of the multi-axis motion system of the present invention is proposed.

[0067] Reference Figure 2 , Figure 2 This is a flow chart of a first embodiment of a method for establishing an actual kinematic transformation relationship of a multi-axis motion system according to the present invention. The method is used in a terminal device and comprises the following steps:

[0068] Step S11: Acquire actual motion parameters of the multi-axis motion system.

[0069] Step S12: establishing a coordinate transformation matrix based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters.

[0070] It should be noted that the execution subject of the present invention is a terminal device, and the structure of the terminal device is referred to the above description, which will not be repeated here. The terminal device is installed with a multi-axis motion system actual kinematic transformation relationship establishment program, and when the terminal device executes the multi-axis motion system actual kinematic transformation relationship establishment program, the steps of the multi-axis motion system actual kinematic transformation relationship establishment method of the present invention are implemented.

[0071] In the present invention, the multi-axis motion system includes multiple motion axes. The multi-axis motion system can be a common five-axis motion system. The multi-axis motion system can also be an articulated robot (the articulated robot includes multiple joints, and one joint is equivalent to one motion axis). In the present invention, a five-axis motion system is taken as an example for explanation. The theoretical coordinate transformation relationship refers to the coordinate transformation relationship between multiple motion axes in a multi-axis motion system. The theoretical coordinate transformation relationship (also called theoretical forward and inverse kinematics transformation relationship) means that after the multi-axis motion system is installed, the installation positions of the multiple motion axes are all in theoretically perfect positions, that is, the multiple motion axes are perpendicular to each other, and the angles between the motion axes are accurate.

[0072] However, in actual applications, after the multi-axis motion system is installed, the installation positions of the multiple motion axes cannot be in the theoretically perfect positions. There is a gap between the actual installation positions of the multiple motion axes and the theoretically perfect positions, that is, there are geometric errors such as non-perpendicularity between the motion axes and inaccurate angles between the motion axes.

[0073] First of all, in the present invention, it is necessary to determine the most important parameters: the actual motion parameters of the multi-axis motion system, construct a coordinate transformation matrix through the actual motion parameters and the theoretical coordinate transformation relationship of the multi-axis motion system, and obtain the key unknowns of the coordinate transformation matrix, and then bring the key unknowns into the coordinate transformation matrix to obtain the final actual kinematic transformation relationship; because when constructing the actual kinematic transformation relationship, it is based on the actual motion parameters, so as to eliminate geometric errors as much as possible, so that the actual kinematic transformation relationship obtained has a higher accuracy rate.

[0074] Specifically, the actual motion parameters include multiple first coordinates and multiple coordinate groups; the step of obtaining the actual motion parameters of the multi-axis motion system includes: obtaining multiple first coordinates of the execution terminal in the calibration coordinate system and multiple coordinate groups of the multiple motion axes in the motion axis coordinate system, one first coordinate corresponds to one coordinate group; correspondingly, the step of establishing a coordinate transformation matrix between the multiple motion axes based on the theoretical coordinate transformation relationship between the axes in the multi-axis motion system and the actual motion parameters includes: constructing the coordinate transformation matrix using the system structure of the multi-axis motion system, the theoretical coordinate transformation relationship, the multiple first coordinates and the multiple coordinate groups.

[0075] It should be noted that in order to eliminate the above-mentioned geometric errors, it is necessary to use the actual motion parameters and the theoretical coordinate transformation relationship to construct a coordinate transformation matrix (also called a set of equations, hereinafter referred to as the set of equations to refer to the constructed coordinate transformation matrix). The actual motion parameters are the position information of the execution end and multiple motion axes in the multi-axis motion system. At this time, it is necessary to set up a calibration coordinate system and a motion axis coordinate system so that the execution end corresponds to the position information in the calibration coordinate system, and the multiple motion axes correspond to the position information in the motion axis coordinate system, which is convenient for solving the coordinate transformation matrix. By solving the coordinate transformation matrix to obtain the key unknowns, and then substituting the key unknowns into the coordinate transformation matrix, what is obtained is the actual kinematic transformation relationship.

[0076] In a specific application, when the execution end moves to a position, the respective positions of the multiple motion axes are also fixed, that is, the coordinates of the execution end at this position (the coordinates in the calibration coordinate system) are the first coordinates. At this position, the coordinates of the multiple motion axes constitute a group of first coordinates (the coordinates in the motion axis coordinate system), that is, a coordinate group includes the coordinates of the multiple motion axes. For example, the motion axes include 5, and a coordinate group includes 5 coordinates corresponding to the 5 motion axes. It can be understood that a first coordinate and a coordinate group are used as a set of known parameters when constructing a set of equations.

[0077] In the present invention, the number of multiple motion axes is represented by N, and a coordinate group can be represented as P1, P2, P2, . . . , P N . Wherein, the coordinates of multiple motion axes are the coordinates of the center of the motion axis in the motion axis coordinate system. Generally, for a multi-axis motion system, each additional motion axis may need to add 6 equations. Taking the 5-axis motion system of the present invention as an example, the constructed set of equations includes at least 30 equations. Among them, the existence of geometric errors also involves the geometric errors corresponding to each of the multiple motion cycles. Among them, the system structure mainly refers to the number of axes of the multi-axis motion system, which is used to determine how many equations are needed.

[0078] In addition, when constructing a set of equations, the actual motion parameters and the theoretical coordinate transformation relationship can be used to construct a set of equations for unknown numbers, which includes the influence of possible geometric errors. Then, the known multiple first coordinates and the multiple sets of second coordinates are substituted into the set of equations for unknown numbers to obtain the set of equations, and the set of equations is solved to solve the key unknowns. The solved key unknowns are now known quantities, and then the known key unknowns are substituted into the set of equations for unknown numbers to obtain a new set of equations, which is the actual kinematic transformation relationship.

[0079] For multi-axis motion systems, different numbers of motion axes use different sets of unknown equations constructed using actual motion parameters and theoretical coordinate transformation relationships. At the same time, for a multi-axis motion system, after its installation, without any adjustment, its corresponding geometric error will not change, and thus its corresponding actual kinematic transformation relationship will not change, and it can be reused.

[0080] Furthermore, the execution terminal is fixedly connected to the positioning device; the step of obtaining multiple first coordinates of the execution terminal in the calibrated coordinate system and multiple coordinate groups of the multiple moving axes in the moving axis coordinate system includes: collecting multiple second coordinates of the positioning device in the calibrated coordinate system, and collecting multiple coordinate groups of the multiple moving axes in the moving axis coordinate system, one second coordinate corresponds to one coordinate group; obtaining the relative position relationship between the execution terminal and the positioning device; and using the relative position relationship to transform the multiple second coordinates to obtain the multiple first coordinates.

[0081] Wherein, before the step of collecting multiple second coordinates of the positioning device in the calibrated coordinate system and collecting multiple coordinate groups of the multiple motion axes in the motion axis coordinate system, the method also includes: obtaining multiple target positions of the positioning device based on the multi-axis motion system, the number of the multiple motion axes, and the motion range of the multi-axis motion system; accordingly, the step of collecting multiple second coordinates of the positioning device in the calibrated coordinate system and collecting multiple coordinate groups of the multiple motion axes in the motion axis coordinate system includes: collecting multiple second coordinates corresponding to the positioning device at the multiple target positions, and collecting multiple coordinate groups corresponding to the multiple motion axes at the multiple target positions, wherein the multiple second coordinates are coordinates in the calibrated coordinate system, and the multiple coordinate groups are coordinate groups in the motion axis coordinate system.

[0082] Among them, the step of collecting multiple second coordinates corresponding to the positioning device at the multiple target positions, and collecting multiple coordinate groups corresponding to the multiple motion axes at the multiple target positions, includes: determining a selected target position from the multiple target positions; controlling the positioning device to move to the selected target position; collecting the second coordinates corresponding to the positioning device at the selected target position; collecting the coordinate groups corresponding to the multiple motion axes at the selected target position; determining a new selected target position from the multiple target positions; updating the selected target position using the new selected target position, and returning to execute the step of controlling the positioning device to move to the selected target position until the number of the second coordinates reaches a preset threshold, thereby obtaining the multiple second coordinates and the multiple coordinate groups.

[0083] It should be noted that it is necessary to determine multiple target positions of the positioning device of the multi-axis motion system based on the multi-axis motion system, the number of the multiple motion axes, and the motion range of the multi-axis motion system. In the present invention, each operation controls the positioning device to move to a target position, which is the selected target position of the operation. At the selected target position, a second coordinate and a coordinate group are obtained. The second coordinate is the coordinate of the positioning device in the calibrated coordinate system corresponding to the selected target position; a coordinate in a coordinate group is the coordinate of a motion axis in the motion axis coordinate system corresponding to the selected target position, and a coordinate group includes the coordinates of each of the multiple motion axes in the multi-axis motion system. The second coordinates and coordinate groups corresponding to different target positions may be different.

[0084] Through the above-mentioned multiple operation steps, the second coordinates and coordinate groups corresponding to the multiple target positions can be obtained, and the multiple second coordinates can be converted into multiple first coordinates. Finally, the multiple first coordinates and the multiple coordinate groups are brought into the unknown number equation group mentioned above to construct the equation group. Among them, the preset threshold is related to the number of motion axes of the multi-axis motion system, that is, the number of target positions is the same as or related to the number of preset thresholds. Among them, the preset threshold can refer to the number of equations required.

[0085] Furthermore, the step of obtaining the relative position relationship between the execution end and the positioning device includes: controlling the execution end to move to a preset mark position; obtaining first position information of a reference motion axis among the multiple motion axes; controlling the positioning device to move to the preset mark position; obtaining second position information of the reference motion axis; and obtaining the relative position relationship based on the first position information and the second position information.

[0086] It should be noted that the relative position relationship group includes the relative position relationship between each motion axis and the execution end in the multi-axis motion system. The second coordinate corresponding to the positioning device cannot be directly used to construct the equation group. It is necessary to use the relative position relationship to convert the second coordinate into the first coordinate, and the first coordinate can be used to construct the equation group, wherein the coordinate group does not need to be converted and can be used to construct the equation group.

[0087] In addition, when the execution end moves to the preset mark position, the first position information of the reference motion axis may be the coordinates in the calibration coordinate system, and when the positioning device moves to the preset mark position, the second position information may also be the coordinates in the calibration coordinate system. Based on the first position information and the second position information, the relative position relationship is obtained; In addition, when the execution end moves to the preset mark position, the first position information of the reference motion axis may be the relative position of the reference motion axis and the execution end, and when the positioning device moves to the preset mark position, the second position information may also be the relative position of the reference motion axis and the execution end. Based on the first position information and the second position information, the relative position relationship is obtained. Among them, the preset mark position can be set by the user based on demand. The user can set multiple preset mark positions, obtain multiple relative position relationships corresponding to multiple preset mark positions, and average the multiple relative position relationships to obtain the relative position relationship, thereby improving the accuracy of the relative position relationship.

[0088] In addition, the reference motion axis may be any motion axis in the multi-axis motion system, and the present invention does not limit this.

[0089] In a specific application, the positioning device includes a reading unit and a visual camera unit. The reading unit may be an encoder or a grating ruler in a servo system. The visual camera unit may be a visual camera or a depth camera, etc., which is not limited in the present invention.

[0090] Furthermore, the positioning device includes a reading unit and a visual camera unit, the multiple target positions correspond to multiple preset marks, one target position corresponds to one preset mark, and each preset mark stores the two-dimensional coordinates corresponding to each target position corresponding to the preset mark in the calibrated coordinate system; the step of collecting the second coordinate corresponding to the selected target position of the positioning device includes: reading the selected two-dimensional coordinates in the selected preset mark corresponding to the selected target position by the reading unit; collecting the vertical coordinates of the positioning device in the calibrated coordinate system by the visual camera unit; based on the vertical coordinates and the selected two-dimensional coordinates, obtaining the second coordinate corresponding to the selected target position of the positioning device. Among them, the visual camera unit can be a binocular visual camera, a 2D vision camera system with laser ranging, or a 3D visual camera, etc. The two-dimensional coordinate is a horizontal two-dimensional coordinate based on the multi-axis motion system workbench, and the vertical coordinate is a vertical coordinate based on the multi-axis motion system workbench.

[0091] It can be understood that when the positioning device moves to a target position, the visual camera also moves to the target position, and the two-dimensional coordinates corresponding to the target position in the calibration coordinate system are the selected two-dimensional coordinates of the target position, that is, the two-dimensional coordinates stored in the preset mark are the two-dimensional coordinates corresponding to the positioning device.

[0092] Reference Figure 3 , Figure 3 Schematic diagram of the preset mark of the present invention. In the present invention, the preset mark can be a QR code mark, and the preset mark is set on the calibration plate ( Figure 3 In the figure, four two-dimensional code marks are set on the calibration plate), the center point of the preset mark is the mark point, and the two-dimensional coordinates of the mark point in the calibration coordinate system are stored in the two-dimensional code mark. The reading unit in the positioning device reads the two-dimensional coordinates of the selected two-dimensional code mark corresponding to the selected target position, that is, the selected two-dimensional coordinates, and then the visual camera unit is used to collect the vertical coordinates of the positioning device in the calibration coordinate system. Based on the selected two-dimensional coordinates and the vertical coordinates, the second coordinates of the positioning device corresponding to the selected target position are obtained. The second coordinates are three-dimensional coordinates. Similarly, it can be seen that the first coordinates are also three-dimensional coordinates.

[0093] It is understandable that in other embodiments, the preset mark can also be visually identifiable information such as a barcode, numeric characters, alphabetic characters, etc., and the present invention is not limited thereto. The QR code mark proposed in this application is a preferred solution.

[0094] It should be noted that in order to ensure that the constructed set of equations can solve the key unknowns, the multiple second coordinates need to include two types of second coordinates with a depth of 0 and a depth not equal to 0, that is, the multiple second coordinates need to include a second coordinate with a vertical coordinate (z-axis coordinate) of 0 and a second coordinate with a vertical coordinate not equal to 0.

[0095] It can be understood that a selected target position may be a target position with depth or a target position without depth. It is necessary to determine the specific method for obtaining the second coordinate based on whether the selected target position has depth, that is: for a selected target position without depth, directly read the two-dimensional coordinate and add the Z-axis coordinate of Z=0 to it to obtain the second coordinate; for a selected target position with depth, read the depth coordinate of the selected target position and obtain the second coordinate based on the depth coordinate and the selected two-dimensional coordinate.

[0096] For example, the positioning device is a binocular vision camera, and the preset mark is a QR code mark. The QR code mark is set on the calibration plate, and the center of the calibration plate is used as the origin of the calibration coordinate system. The two-dimensional coordinates of the QR code mark are determined and stored in the QR code mark. The calibration plate is placed on the workbench of the multi-axis motion system, and the motion axis connected to the workbench in the multi-axis motion system is adjusted so that the calibration plate is at a certain angle to the horizontal plane, and then the motion axis is adjusted so that the focus of the binocular vision camera is located on the plane of the calibration plate, and the focus is ensured to coincide with the calibration point (the center of the QR code mark, that is, the point corresponding to the two-dimensional coordinate stored in the QR code mark) to read the two-dimensional coordinates in the QR code mark, that is, read the coordinates (x1, y1), so that a three-dimensional coordinate (x1, y1, 0) can be obtained. Repeat this step to obtain multiple three-dimensional coordinates, which are the coordinates without depth in the multiple second coordinates.

[0097] Adjust the motion axis connected to the workbench in the multi-axis motion system so that the calibration plate is parallel to the horizontal plane, and then adjust the motion axis connected to the tool so that the focus of the binocular vision camera is located on the calibration plate plane, and ensure that the focus coincides with the calibration point, and then read the coordinates (x2, y2) in the QR code mark, and then, under the premise of ensuring that the focus coincides with the calibration point in the x and y directions, adjust the motion axis so that the visual focus leaves the calibration plate plane, and measure the distance away (the vertical coordinate) through the binocular vision camera, that is, the z coordinate value of the focus in the calibration coordinate system, so that the three-dimensional coordinate (x2, y2, z) coordinate value can be obtained, and the z coordinate is not zero. Repeat this step to obtain multiple three-dimensional coordinates. The multiple three-dimensional coordinates are the coordinates with depth in the multiple second coordinates.

[0098] Step S13: Based on the coordinate transformation matrix, the actual kinematic transformation relationship of the multi-axis motion system is obtained.

[0099] It should be noted that after the key unknowns are obtained using the coordinate transformation matrix, the key unknowns are substituted into the coordinate transformation matrix to obtain the actual kinematic transformation relationship, which is the transformation relationship between the execution terminal and multiple motion axes in the multi-axis motion system.

[0100] Specifically, the actual kinematic transformation relationship obtained is as shown in Formula 1, which is as follows:

[0101] {x, y, z} = f pos (P1,P2,P3,···,P N )

[0102] Among them, {x, y, z} is a first coordinate corresponding to a target position, (P1, P2, P3, ···, P N ) is the coordinate group corresponding to the first coordinate, fpos It is a mapping function, which is determined based on the theoretical inverse motion transformation relationship. The mapping function is used to represent the position relationship between multiple motion axes and the execution end in a multi-axis motion system (the position relationship between multiple motion axes and the execution end is represented by the calibrated coordinate system as the reference coordinate system).

[0103] In some embodiments, the terminal motion trajectory of the execution terminal may be acquired, and then based on the terminal motion trajectory and the actual kinematic transformation relationship, the actual motion trajectory of each of the multiple axes in the multi-axis motion system may be obtained.

[0104] Generally, the terminal motion trajectory of the execution terminal of the multi-axis motion system can be acquired by an acquisition module of the terminal device, such as a camera, and the acquisition module sends the acquired terminal motion trajectory of the execution terminal of the multi-axis motion system to the terminal device, and the terminal device continues to process the data of the terminal motion trajectory of the execution terminal of the multi-axis motion system. The terminal motion trajectory can be the motion trajectory of the execution terminal.

[0105] Generally, the execution end of the multi-axis motion system is used to perform specific actions, for example, the execution end is a dispensing head, which performs dispensing operations, etc. The present invention does not make specific restrictions. The multi-axis motion system outputs specific actions based on execution instructions to drive the execution end to move, so that the end motion trajectory of the execution end can be obtained.

[0106] The actual inverse kinematic transformation relationship includes the relationship between multiple motion axes and the execution end respectively. Based on the respective relationships between the multiple motion axes and the execution end and the end motion trajectory of the execution end, the actual motion trajectory of each of the multiple motion axes can be obtained, that is, the actual motion trajectory includes the actual motion trajectory of each of the multiple motion axes.

[0107] For example, the multiple motion axes include 5, and the actual inverse kinematics transformation relationship includes the relationship between the 5 motion axes and the execution end respectively. Based on the relationship between the 5 motion axes and the execution end respectively and the end running trajectory of the execution end, the 5 actual motion trajectories corresponding to the 5 motion axes can be obtained.

[0108] The technical solution of the present invention proposes a method for establishing the actual kinematic transformation relationship of a multi-axis motion system, and the method includes the following steps: obtaining the actual motion parameters of the multi-axis motion system; establishing a coordinate transformation matrix between the multiple motion axes based on the theoretical coordinate transformation relationship between the axes in the multi-axis motion system and the actual motion parameters; and obtaining the actual kinematic transformation relationship between the execution end and the multiple motion axes in the multi-axis motion system based on the coordinate transformation matrix.

[0109] Because, in the existing method for establishing the actual kinematic transformation relationship of a multi-axis motion system, the trajectory of each motion axis is obtained based on the motion trajectory of the execution terminal and the theoretical coordinate transformation relationship corresponding to the motion of the multi-axis motion system. When the multi-axis motion system is assembled and manufactured, there are geometric errors such as non-perpendicularity between the motion axes and inaccurate angles between the motion axes, which makes the theoretical coordinate transformation relationship unable to accurately reflect the relationship between each motion axis and the execution terminal, thereby making the actual motion trajectory of the obtained multiple motion axes less accurate. In the present invention, the actual kinematic transformation relationship is obtained by using the actual motion parameters and the theoretical coordinate transformation relationship. The geometric errors of the multi-axis motion system in the actual motion process are added to the actual kinematic transformation relationship for compensation, thereby eliminating the geometric errors such as non-perpendicularity between the motion axes and inaccurate angles between the motion axes, so that the actual inverse kinematic transformation relationship can accurately reflect the relationship between each motion axis and the execution terminal, thereby achieving the technical effect of improving the accuracy of the kinematic transformation relationship of the multi-axis motion system.

[0110] Reference Figure 4 , Figure 4 The present invention is a schematic structural diagram of a first embodiment of a device for establishing an actual kinematic transformation relationship of a multi-axis motion system, the device is used in a terminal device, and is based on the same inventive concept as the above-mentioned embodiment, the device comprises:

[0111] An acquisition module 10 is used to acquire actual motion parameters of the multi-axis motion system;

[0112] An establishing module 20, for establishing a coordinate transformation matrix based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters;

[0113] The obtaining module 30 is used to obtain the actual kinematic transformation relationship of the multi-axis motion system based on the coordinate transformation matrix.

[0114] It should be noted that, since the steps executed by the device of this embodiment are the same as the steps of the aforementioned method embodiment, its specific implementation method and the technical effects that can be achieved can refer to the aforementioned embodiment and will not be repeated here.

[0115] The above descriptions are only optional embodiments of the present invention, and are not intended to limit the patent scope of the present invention. All equivalent structural changes made using the contents of the present invention's specification and drawings, or directly / indirectly applied in other related technical fields, are included in the patent protection scope of the present invention.

Claims

1. A method for establishing actual kinematic transformation relationship of a multi-axis motion system, characterized in that: The method comprises the following steps: Acquire actual motion parameters of the multi-axis motion system; the actual motion parameters include a plurality of first coordinates and a plurality of coordinate groups; Based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters, a coordinate transformation matrix is ​​established; Based on the coordinate transformation matrix, obtaining the actual kinematic transformation relationship of the multi-axis motion system; The step of obtaining the actual motion parameters of the multi-axis motion system comprises: Acquire multiple first coordinates of the execution terminal in the calibration coordinate system and multiple coordinate groups of the multiple motion axes in the motion axis coordinate system, where one first coordinate corresponds to one coordinate group; The step of establishing a coordinate transformation matrix between the multiple motion axes based on the theoretical coordinate transformation relationship between the axes in the multi-axis motion system and the actual motion parameters comprises: The coordinate transformation matrix is ​​constructed by using the system structure of the multi-axis motion system, the theoretical coordinate transformation relationship, the plurality of first coordinates and the plurality of coordinate groups.

2. The method according to claim 1, characterized in that The execution end is fixedly connected to the positioning device; the step of obtaining a plurality of first coordinates of the execution end in the calibration coordinate system and a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system comprises: Collecting a plurality of second coordinates of the positioning device in the calibration coordinate system, and collecting a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system, one second coordinate corresponds to one coordinate group; Acquiring the relative position relationship between the execution end and the positioning device; The plurality of second coordinates are transformed using the relative position relationship to obtain the plurality of first coordinates.

3. The method according to claim 2, characterized in that Before the step of acquiring a plurality of second coordinates of the positioning device in the calibration coordinate system and acquiring a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system, the method further comprises: Based on the multi-axis motion system, the number of the multiple motion axes, and the motion range of the multi-axis motion system, obtaining multiple target positions of the positioning device; The step of acquiring a plurality of second coordinates of the positioning device in the calibration coordinate system and acquiring a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system comprises: Collect multiple second coordinates corresponding to the multiple target positions of the positioning device, and collect multiple coordinate groups corresponding to the multiple motion axes at the multiple target positions, wherein the multiple second coordinates are coordinates in the calibration coordinate system, and the multiple coordinate groups are coordinate groups in the motion axis coordinate system.

4. The method according to claim 3, characterized in that The step of collecting a plurality of second coordinates corresponding to the plurality of target positions of the positioning device, and collecting a plurality of coordinate groups corresponding to the plurality of motion axes at the plurality of target positions, comprises: determining a selected target location among the plurality of target locations; Controlling the positioning device to move to the selected target position; Collecting the second coordinates of the positioning device corresponding to the selected target position; Collecting the coordinate groups corresponding to the selected target positions of the multiple motion axes; determining a new selected target location among the plurality of target locations; The selected target position is updated using the new selected target position, and the step of controlling the positioning device to move to the selected target position is returned to be executed until the number of the second coordinates reaches a preset threshold, thereby obtaining the multiple second coordinates and the multiple coordinate groups.

5. The method according to claim 4, characterized in that Before the step of obtaining the relative position relationship between the execution end and the positioning device, the method further includes: Controlling the execution end to move to a preset marking position; Acquire first position information of a reference motion axis among the multiple motion axes; Controlling the positioning device to move to the preset marking position; Acquiring second position information of the reference motion axis; The relative position relationship is obtained based on the first position information and the second position information.

6. The method according to claim 5, characterized in that The positioning device includes a reading unit and a visual camera unit, the multiple target positions correspond to multiple preset marks, one target position corresponds to one preset mark, and each preset mark stores the two-dimensional coordinates corresponding to the target position corresponding to each preset mark in the calibration coordinate system; The step of acquiring the second coordinates of the positioning device corresponding to the selected target position includes: Reading the selected two-dimensional coordinates in the selected preset mark corresponding to the selected target position by the reading unit; Collecting the vertical coordinates of the positioning device in the calibration coordinate system by the visual camera unit; Based on the vertical coordinate and the selected two-dimensional coordinate, a second coordinate of the positioning device corresponding to the selected target position is obtained.

7. A device for establishing actual kinematic transformation relationship of a multi-axis motion system, characterized in that: The device comprises: An acquisition module, used for acquiring actual motion parameters of the multi-axis motion system; the actual motion parameters include a plurality of first coordinates and a plurality of coordinate groups; An establishing module, used for establishing a coordinate transformation matrix based on the theoretical coordinate transformation relationship of the multi-axis motion system and the actual motion parameters; An acquisition module, used for acquiring an actual kinematic transformation relationship of the multi-axis motion system based on the coordinate transformation matrix; The acquisition module is further used to acquire a plurality of first coordinates of the execution terminal in the calibration coordinate system and a plurality of coordinate groups of the plurality of motion axes in the motion axis coordinate system, wherein one first coordinate corresponds to one coordinate group; The establishment module is also used to construct the coordinate transformation matrix by using the system structure of the multi-axis motion system, the theoretical coordinate transformation relationship, the multiple first coordinates and the multiple coordinate groups.

8. A terminal device, characterized in that: The terminal device includes: a memory, a processor, and a program for establishing the actual kinematic transformation relationship of a multi-axis motion system stored in the memory and running on the processor. When the program for establishing the actual kinematic transformation relationship of a multi-axis motion system is executed by the processor, the steps of the method for establishing the actual kinematic transformation relationship of a multi-axis motion system as described in any one of claims 1 to 6 are implemented.

9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a program for establishing actual kinematic transformation relationships of a multi-axis motion system, and when the program for establishing actual kinematic transformation relationships of a multi-axis motion system is executed by a processor, the steps of the method for establishing actual kinematic transformation relationships of a multi-axis motion system as described in any one of claims 1 to 6 are implemented.