A Robot Arm Collision Detection Method Based on Uniform Sampling of Low-Discrepancy Sequences
By uniformly sampling the motion path of the robotic arm using van der Kopite sequences, the problems of low accuracy and slow efficiency in collision detection of the robotic arm are solved, achieving efficient and accurate collision detection and reducing the computational resource requirements.
Patent Information
- Application Number
- CN202411778734.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-12-05
- Publication Date
- 2026-11-17
- Estimated Expiration
- 2044-12-05
AI Technical Summary
Current technologies for collision detection in robotic arms are characterized by low accuracy and slow efficiency. Traditional sampling methods result in uneven distribution of sampling points, increasing computational resources and time costs.
A uniform sampling method based on van der Koppit sequences is adopted to uniformly sample the motion path of the robotic arm. By constructing a model of the robotic arm and the environment, collision detection is performed using a collision detection library.
It improves the accuracy and efficiency of collision detection, reduces computational costs, ensures the accuracy and reliability of detection results, and reduces hardware requirements.
Smart Images

Figure CN119458346B_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of robotic arm collision detection technology, and in particular to a robotic arm collision detection method, device and medium based on uniform sampling of low-difference sequences. Background Technology
[0002] Collision detection is an important part of the research on obstacle avoidance path planning for robotic arms. Its main purpose is to determine whether a collision has occurred between objects, while also taking into account the safety of the robotic arm when interacting with the environment. Therefore, fast and safe collision detection algorithms are of great significance to path planning.
[0003] Because the robotic arm needs to calculate in real time whether it collides with itself or environmental obstacles during movement, the collision detection process actually requires discretization of the path. This involves dividing the path into a series of small segments, such as discretizing the robotic arm's joint space path into multiple joint angle combinations with a certain step size. This makes it easier to assess the robotic arm's state and position, as well as its relationship with surrounding objects, at each discrete point. Then, at each discrete path point, collision detection calculations are performed according to the selected collision detection method. When the robotic arm performs collision detection on the planned path, the entire path must be obstacle-free. Checking each point individually would result in an infinite number of calls to the collision detection algorithm, which is impractical. Therefore, the most common method is to sample discrete points on the path, perform collision checks on the sampled points, and ensure the planned path is obstacle-free by setting an appropriate step size.
[0004] However, in the discrete point sampling stage, traditional sampling methods either sample sequentially or randomly in the sampling space using random number generation algorithms. This can lead to uneven distribution of sampling points, with some areas being oversampled while others are undersampled, affecting the accuracy and efficiency of collision detection. Moreover, obtaining sufficiently accurate results often requires a large number of sampling points, which necessitates more computational resources and time for processing and analysis, thus increasing computational costs. Summary of the Invention
[0005] The technical problem to be solved by this invention is: In order to solve the problem of low accuracy and slow efficiency of existing technologies for collision detection of robotic arms, this invention provides a robotic arm collision detection method based on uniform sampling of low difference sequences, which can uniformly sample the path that needs to be collision detected, thereby improving the accuracy and efficiency of detection and reducing the computational cost.
[0006] The technical solution adopted by this invention to solve its technical problem is: a collision detection method for robotic arms based on uniform sampling of low-difference sequences, the method comprising the following steps:
[0007] S1, planning the motion path of the robotic arm;
[0008] S2, based on the van der Coppit sequence, uniformly sample the planned mechanical avoidance motion path to obtain the path uniform state points;
[0009] S3, construct the geometric model of the robotic arm and the environmental obstacle model, and save the constructed geometric model of the robotic arm and the environmental obstacle model to the configuration file;
[0010] S4, input the configuration file into the collision detection library, and use the collision detection library to process the uniform state points of the path to achieve collision detection.
[0011] Furthermore, specifically, step S1 includes:
[0012] S11, Obtain the current joint position of the robotic arm, and generate a motion path from the current joint position to the target joint position using a robotic arm path planning algorithm. When time t is t, the vector representation of the motion path is:
[0013] q(t)=[q1(t),q2(t),q3(t),…,q n (t)],
[0014] Where, q i (t) is the joint position of the i-th joint of the robotic arm at time t;
[0015] The joint angle values of the current positions of the six axes of the robotic arm are expressed as follows:
[0016] current_joints=[α1,α2,α3,α4,α5,α6];
[0017] The joint angle value at the target position is expressed as:
[0018] goal_joint=[β1,β2,β3,β4,β5,β6];
[0019] S12, based on the joint angle values of the current position and the joint angle values of the target position of the six axes of the robotic arm, check the validity of the motion path from the current position to the target joint position, and calculate the final joint angle values of the current position and the target position based on the validity results;
[0020] S13, obtain the final joint angle values at the current position and the target position, and calculate the joint tangent vector from the current joint position to the target joint position. The calculation formula is as follows:
[0021] joint_tangent=goal_joint-current_joints;
[0022] S14, set the minimum distance for path node detection to S, calculate the cardinality b of the Vanderkopit sequence and the number of key points K on the path based on the joint tangent vector, and the distance between the number of key points K is not less than S.
[0023] Furthermore, specifically, step 2 includes the following steps:
[0024] S21, obtain the cardinality b and the number of key points K on the path of the van der Copeet sequence, obtain the sequence length n based on the number of key points K on the path, n = K, and use the cardinality b and sequence length n of the van der Copeet sequence as parameters of the van der Copeet sequence generation algorithm to generate the van der Copeet sequence.
[0025] S22, the joint path is sampled using the van der Coppit sequence to obtain the uniform sampling sequence V. i =(v i1 ,v i2 ,…,v in ), v i1 ,v i2 ,…,v in Represented as uniform sampling points, where n is the number of uniform sampling points, i is the number of joints on each axis of the robotic arm, and each sampling point element corresponds to a uniformly distributed random number;
[0026] S23, using the random number as a parameter for linear interpolation, the intermediate_state point of the path uniformity between the initial position and the target position is calculated using the linear interpolation method. The calculation formula is as follows:
[0027] intermediate_state=current_joints+joint_tangent*V i Furthermore, specifically, step S3 includes the following steps:
[0028] Based on the three-dimensional features of the robotic arm, a geometric model of the robotic arm is established, and the position and orientation of each link of the robotic arm relative to the base coordinate system in the initial state are obtained.
[0029] Based on the kinematic model of the robotic arm, calculate the position of each link in space under the intermediate_state posture at each uniform state point;
[0030] An environmental obstacle model is established based on the three-dimensional features of the obstacles and the three-dimensional features of the surrounding environment. Each obstacle in the environmental obstacle model is used as a static constraint, and each obstacle is described as its position (x, y, z) and orientation (roll, pitch, yaw) relative to the world coordinate system.
[0031] The geometric model of the robotic arm, the position and orientation of each link of the robotic arm relative to the base coordinate system in the initial state, the position of each link in space in the intermediate_state orientation at each uniform state point, and the obstacle model are saved to the configuration file.
[0032] Furthermore, specifically, in step S4, processing the path uniform state points using the collision detection library to achieve collision detection specifically includes the following steps:
[0033] Obtain the path uniform state point intermediate_state, and obtain the pose corresponding to the path uniform state point intermediate_state by inverse solving the path uniform state point intermediate_state;
[0034] The collision detection library analyzes the posture corresponding to the intermediate_state of the path uniform state point according to the set collision detection rules to determine whether the robotic arm collides with the robotic arm body or an obstacle.
[0035] Furthermore, specifically, step S12 includes:
[0036] Set the upper and lower limits of the allowable joint position;
[0037] The joint angle values at the current position and the joint angle values at the target position of each axis of the robotic arm are compared with the upper and lower allowable values, respectively.
[0038] If the joint angle value of the current position or the joint angle value of the target position of any axis is greater than the allowable upper limit value, then 2*M_PI is subtracted from the joint angle value of the current position or the joint angle value of the target position until the joint angle value of the current position or the joint angle value of the target position of each axis is less than the allowable upper limit value.
[0039] If the joint angle value of the current position or the joint angle value of the target position of any axis is less than the allowable lower limit, then 2*M_PI is added to the joint angle value of the current position or the joint angle value of the target position until the joint angle value of the current position or the joint angle value of the target position of each axis is greater than or equal to the allowable lower limit.
[0040] Where M_PI is the preset angle value.
[0041] Furthermore, specifically, step S14 includes:
[0042] S141. Let the joint tangent vector J = {j1,j2,j3,…,j n} represents joint_tangent, where j i It is the i-th element of vector J;
[0043] S142, Calculate the absolute value of each element in the joint tangent vector J to obtain a new vector:
[0044] J′={|j1|,|j2|,|j3|,…,|j n |};
[0045] S143, find the maximum element value in the new vector J′, denoted as M = max(|j1|,|j2|,|j3|,…,|j…). n |);
[0046] S144, for Round up to obtain the base number.
[0047] S145, Calculate the number of key points K on the path based on the base number, K = 2 b .
[0048] Furthermore, specifically, the robotic arm path planning algorithm includes a Cartesian space planning algorithm or a joint space planning algorithm.
[0049] A computer device, comprising:
[0050] processor;
[0051] Memory, used to store executable instructions;
[0052] The processor is configured to read the executable instructions from the memory and execute the executable instructions to implement the robotic arm collision detection method based on low-difference sequence uniform sampling as described above.
[0053] A computer-readable storage medium storing a computer program that, when executed by a processor, causes the processor to implement the robotic arm collision detection method based on low-difference sequence uniform sampling as described above.
[0054] The beneficial effects of this invention are that the robotic arm collision detection method based on low-difference sequence uniform sampling uses van der Koppet sequences to uniformly sample the planned robotic avoidance path, resulting in sampling points that more comprehensively and completely cover the workspace, thus improving the accuracy and reliability of collision detection. Furthermore, the van der Koppet sequences can generate a sufficient number of sampling points in a short time, eliminating the need for powerful processors and reducing hardware requirements. This approach reduces computational load and improves detection efficiency while ensuring the accuracy and reliability of the detection results. Attached Figure Description
[0055] The present invention will be further described below with reference to the accompanying drawings and embodiments.
[0056] Figure 1 This is a schematic diagram of the structure of Embodiment 1 of the present invention.
[0057] Figure 2 This is a schematic diagram of the computer device structure according to Embodiment 2 of the present invention.
[0058] In the diagram, 10 is a computer device; 1002 is a processor; 1004 is a memory; and 1006 is a transmission device. Detailed Implementation
[0059] The present invention will now be described in further detail with reference to the accompanying drawings. These drawings are simplified schematic diagrams, illustrating only the basic structure of the invention, and therefore only show the components relevant to the invention.
[0060] In the description of this invention, it should be understood that the terms "center," "longitudinal," "lateral," "length," "width," "thickness," "upper," "lower," "front," "rear," "left," "right," "vertical," "horizontal," "top," "bottom," "inner," "outer," "clockwise," "counterclockwise," "axial," "radial," and "circumferential," etc., indicating orientation or positional relationships, are based on the orientation or positional relationships shown in the accompanying drawings and are only for the convenience of describing the invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, or be constructed and operated in a specific orientation, and therefore should not be construed as a limitation of the invention. Furthermore, features defined with "first" or "second" may explicitly or implicitly include one or more of that feature. In the description of this invention, unless otherwise stated, "a plurality of" means two or more.
[0061] In the description of this invention, it should be noted that, unless otherwise explicitly specified and limited, the terms "installation," "connection," and "linking" should be interpreted broadly. For example, they can refer to a fixed connection, a detachable connection, or an integral connection; they can refer to a mechanical connection or an electrical connection; they can refer to a direct connection or an indirect connection through an intermediate medium; and they can refer to the internal connection of two components. Those skilled in the art can understand the specific meaning of the above terms in this invention based on the specific circumstances.
[0062] Example 1
[0063] This application provides a robotic arm collision detection method based on uniform sampling of low-difference sequences, such as... Figure 1 As shown, the method includes the following steps:
[0064] S1 is for planning the motion path of the robotic arm.
[0065] S2, based on the van der Coppit sequence, uniformly sample the planned mechanical avoidance motion path to obtain the path uniform state points.
[0066] S3, construct the geometric model of the robotic arm and the environmental obstacle model, and save the constructed geometric model of the robotic arm and the environmental obstacle model to the configuration file.
[0067] S4. Input the configuration file into the collision detection library, and use the collision detection library to process uniform state points along the path to achieve collision detection.
[0068] In this embodiment, step S1 specifically includes:
[0069] S11, Obtain the current joint position of the robotic arm, and generate the motion path from the current joint position to the target joint position using a robotic arm path planning algorithm. This algorithm can be either a Cartesian space planning algorithm or a joint space planning algorithm. At time t, the vector representation of the motion path is:
[0070] q(t)=[q1(t),q2(t),q3(t),…,q n (t)],
[0071] Where, q i (t) is the joint position of the i-th joint of the robotic arm at time t;
[0072] The joint angle values of the current positions of the six axes of the robotic arm are expressed as follows:
[0073] current_joints=[α1,α2,α3,α4,α5,α6];
[0074] The joint angle value at the target position is expressed as:
[0075] goal_joint=[β1,β2,β3,β4,β5,β6].
[0076] S12, based on the joint angle values of the current position and the target position of the six axes of the robotic arm, check the validity of the motion path from the current position to the target joint position, and calculate the final joint angle values of the current position and the target position based on the validity results; through validity detection, ensure that the joint angle values of the current position and the target position are within the specified units. Specifically, step S12 includes:
[0077] Set the upper and lower limits of the allowable joint position;
[0078] Compare the joint angle values at the current position and the joint angle values at the target position of each axis of the robotic arm with the upper and lower allowable limits, respectively.
[0079] If the joint angle value of the current position or the joint angle value of the target position of any axis is greater than the upper limit value, then 2*M_PI is subtracted from the joint angle value of the current position or the joint angle value of the target position until the joint angle value of the current position or the joint angle value of the target position of each axis is less than the upper limit value.
[0080] If the joint angle value of the current position or the joint angle value of the target position of any axis is less than the allowable lower limit, then add 2*M_PI to the joint angle value of the current position or the joint angle value of the target position until the joint angle value of the current position or the joint angle value of the target position of each axis is greater than or equal to the allowable lower limit.
[0081] Where M_PI is a preset angle value, such as M_PI = π.
[0082] S13, obtain the final joint angle values at the current position and the target position, and calculate the joint tangent vector from the current joint position to the target joint position. The calculation formula is as follows:
[0083] joint_tangent=goal_joint-current_joints.
[0084] S14, set the minimum distance for path node detection to S, and calculate the cardinality b of the Vanderkoppit sequence and the number of keypoints K on the path based on the joint tangent vectors. The distance between the keypoints K is not less than S. Specifically, step S14 includes:
[0085] S141. Let the joint tangent vector J = {j1,j2,j3,…,j n} represents joint_tangent, where j i It is the i-th element of vector J;
[0086] S142, calculate the absolute value of each element in the joint tangent vector J to obtain a new vector:
[0087] J′={|j1|,|j2|,|j3|,…,|j n |};
[0088] S143, find the maximum element value in the new vector J′, denoted as M = max(|j1|,|j2|,|j3|,…,|j…). n |);
[0089] S144, for Round up to obtain the base number.
[0090] S145, Calculate the number of key points K on the path based on the base number, K = 2 b .
[0091] In this embodiment, step 2 specifically includes the following steps:
[0092] S21, obtain the cardinality b and the number of key points K on the path of the van der Copeet sequence, obtain the sequence length n based on the number of key points K on the path, n = K, and use the cardinality b and sequence length n of the van der Copeet sequence as parameters of the van der Copeet sequence generation algorithm to generate the van der Copeet sequence.
[0093] S22, the joint path is sampled using the van der Coppit sequence to obtain the uniform sampling sequence V. i =(v i1 ,v i2 ,…,v in ), v i1 ,v i2 ,…,v in Represented as uniform sampling points, where n is the number of uniform sampling points, i is the number of joints on each axis of the robotic arm, and each sampling point element corresponds to a uniformly distributed random number;
[0094] S23, using the random number as a parameter for linear interpolation, the intermediate_state point of the path uniformity between the initial position and the target position is calculated using the linear interpolation method. The calculation formula is as follows:
[0095] intermediate_state=current_joints+joint_tangent*V i .
[0096] It's important to note that the van der Kopite sequence achieves a relatively uniform distribution within a unit interval, a crucial characteristic for collision detection sampling in robotic arms. Random sampling methods often result in clustered or sparse areas, leading to some potential collision zones not being adequately detected. The van der Kopite sequence avoids this by placing sampling points in a relatively regular pattern across the workspace (or path) to detect potential collisions. This uniform distribution ensures more comprehensive and thorough coverage of the workspace (or path), improving the accuracy and reliability of collision detection.
[0097] The van der Coppit sequence is defined as follows:
[0098] The base b of a positive integer k can be represented as:
[0099]
[0100] Where b is the base; i = 0, 1, ..., m-1; 0 i (k) <b,a i (k) is the i-th digit in the base b expansion of k.
[0101] The k-th number in the van der Coppit sequence can be represented as:
[0102]
[0103] When b = 2, then we have
[0104]
[0105] When generating a one-dimensional sequence of number n, the order of its detection points is calculated as follows:
[0106]
[0107]
[0108] By using the van der Koppet sequence to obtain n uniform sampling points for the robotic arm, each sampling point can maximize the coverage of the undetected area. Even if the obstacle is far behind, it can be detected in a short time, which improves both accuracy and detection efficiency.
[0109] In this embodiment, step S3 specifically includes the following steps:
[0110] Based on the three-dimensional features of the robotic arm, a geometric model of the robotic arm is established, and the position and orientation of each link of the robotic arm relative to the base coordinate system in the initial state are obtained.
[0111] Based on the kinematic model of the robotic arm, the position of each link in space under the intermediate_state posture at each uniform state point is calculated.
[0112] An environmental obstacle model is established based on the three-dimensional features of the obstacles and the three-dimensional features of the surrounding environment. Each obstacle in the environmental obstacle model is used as a static constraint, and each obstacle is described as its position (x, y, z) and orientation (roll, pitch, yaw) relative to the world coordinate system.
[0113] The geometric model of the robotic arm, the position and orientation of each link of the robotic arm relative to the base coordinate system in the initial state, the position of each link in space in the intermediate_state orientation at each uniform state point, and the obstacle model are saved to the configuration file. The resulting configuration file facilitates subsequent scene detection.
[0114] In this embodiment, step S4, which uses a collision detection library to process the path uniform state point intermediate_state, specifically includes the following steps:
[0115] Obtain the path uniform state point intermediate_state, and obtain the pose corresponding to the path uniform state point intermediate_state by inverse solving the path uniform state point intermediate_state.
[0116] The collision detection library analyzes the posture corresponding to the intermediate_state of the uniform state point on the path according to the set collision detection rules to determine whether the robotic arm collides with the robotic arm body or obstacles.
[0117] For example, MoveIt can implement collision detection by calling the FCL library. The targets of collision detection are the robot's body model and objects in the environment, which have been added to the configuration file through the 3D modeling steps described above. The FCL library uses the position, angle, bounding box, and surface mesh of the objects to determine whether collisions occur between multiple models, between the components of the model itself, or between models during movement by detecting whether the distance between the geometric shapes of the target structural surfaces is less than a certain threshold.
[0118] In this implementation, the collision risk of the robotic arm at different locations in the workspace will also be assessed based on the collision detection results. If collision detection results of sampling points in a certain area show frequent collisions, then the area is determined to be a high-collision-risk area, providing a reference for the path planning of the robotic arm.
[0119] In summary, the robotic arm collision detection method based on low-difference sequence uniform sampling of the present invention uniformly samples the planned robotic avoidance path using van der Kopite sequences. This results in sampling points that more comprehensively and completely cover the workspace, improving the accuracy and reliability of collision detection. Furthermore, the van der Kopite sequences can generate a sufficient number of sampling points in a short time, eliminating the need for powerful processors and reducing hardware requirements. This approach reduces computational load and improves detection efficiency while ensuring the accuracy and reliability of the detection results.
[0120] Example 2
[0121] This application provides a computer device including a processor and a memory. The memory stores at least one instruction or at least one program, which is loaded and executed by the processor to implement a robotic arm collision detection method based on low-difference sequence uniform sampling as provided in the above method embodiments.
[0122] Figure 2 This diagram illustrates a hardware structure of an apparatus for implementing a robotic arm collision detection method based on low-difference sequence uniform sampling provided in the embodiments of this application. The apparatus may constitute or include the device or system provided in the embodiments of this application. Figure 2 As shown, the computer device 10 may include one or more processors 1002 (the processor may include, but is not limited to, a microprocessor MCU or a programmable logic device FPGA, etc.), a memory 1004 for storing data, and a transmission device 1006 for communication functions. In addition, it may also include: a display, an input / output interface (I / O interface), a universal serial bus (USB) port (which may be included as one of the ports of the I / O interface), a network interface, a power supply, and / or a camera. Those skilled in the art will understand that... Figure 2 The structure shown is for illustrative purposes only and does not limit the structure of the aforementioned electronic device. For example, computer device 10 may also include... Figure 2 The more or fewer components shown, or having the same Figure 2 The different configurations shown.
[0123] It should be noted that the aforementioned one or more processors and / or other data processing circuits are generally referred to herein as "data processing circuits". These data processing circuits may be embodied, in whole or in part, in software, hardware, firmware, or any other combination thereof. Furthermore, the data processing circuit may be a single, independent processing module, or may be integrated, in whole or in part, into any other element within the computer device 10 (or mobile device). As involved in the embodiments of this application, the data processing circuit serves as a processor control mechanism (e.g., selection of a variable resistor termination path connected to an interface).
[0124] The memory 1004 can be used to store software programs and modules for application software, such as the program instructions / data storage device corresponding to a robotic arm collision detection method based on low-difference sequence uniform sampling in this embodiment of the application. The processor executes various functional applications and data processing by running the software programs and modules stored in the memory 1004, thereby implementing the aforementioned method. The memory 1004 may include high-speed random access memory, and may also include non-volatile memory, such as one or more magnetic storage devices, flash memory, or other non-volatile solid-state memory. In some instances, the memory 1004 may further include memory remotely located relative to the processor, and these remote memories can be connected to the computer device 10 via a network. Examples of such networks include, but are not limited to, the Internet, corporate intranets, local area networks, mobile communication networks, and combinations thereof.
[0125] The transmission device 1006 is used to receive or send data via a network. Specific examples of the network described above may include a wireless network provided by the communication provider of the computer device 10. In one example, the transmission device 1006 includes a Network Interface Controller (NIC), which can connect to other network devices via a base station to communicate with the Internet. In another example, the transmission device 1006 may be a Radio Frequency (RF) module, used for wireless communication with the Internet.
[0126] The display may be, for example, a touchscreen liquid crystal display (LCD) that allows the user to interact with the user interface of the computer device 10 (or mobile device).
[0127] Example 3
[0128] This application embodiment also provides a computer-readable storage medium, which can be disposed in a server to store at least one instruction or at least one program related to implementing a robotic arm collision detection method based on low-difference sequence uniform sampling in the method embodiment. The at least one instruction or the at least one program is loaded and executed by the processor to implement the robotic arm collision detection method based on low-difference sequence uniform sampling provided in the above method embodiment.
[0129] Optionally, in this embodiment, the storage medium may be located at at least one of the multiple network servers in a computer network. Optionally, in this embodiment, the storage medium may include, but is not limited to, various media capable of storing program code, such as USB flash drives, read-only memory (ROM), random access memory (RAM), portable hard drives, magnetic disks, or optical disks.
[0130] Example 4
[0131] This invention also provides a computer program product or computer program, which includes computer instructions stored in a computer-readable storage medium. A processor of a computer device reads the computer instructions from the computer-readable storage medium and executes the computer instructions, causing the computer device to perform a robotic arm collision detection method based on low-difference sequence uniform sampling provided in the various optional embodiments described above.
[0132] It should be noted that the order of the embodiments described above is merely for descriptive purposes and does not represent the superiority or inferiority of the embodiments. Furthermore, the above description focuses on specific embodiments of this application. Other embodiments are within the scope of the appended claims. In some cases, the actions or steps described in the claims can be performed in a different order than that shown in the embodiments and still achieve the desired results. Additionally, the processes depicted in the drawings do not necessarily require a specific or sequential order to achieve the desired results. In some implementations, multitasking and parallel processing are also possible or may be advantageous.
[0133] The various embodiments in this application are described in a progressive manner. Similar or identical parts between embodiments can be referred to mutually. Each embodiment focuses on describing the differences from other embodiments. In particular, the device, equipment, and storage medium embodiments are basically similar to the method embodiments, so the descriptions are relatively simple; relevant parts can be referred to the descriptions of the method embodiments.
[0134] Those skilled in the art will understand that all or part of the steps of the above embodiments can be implemented by hardware or by a program instructing related hardware. The program can be stored in a computer-readable storage medium, such as a read-only memory, a disk, or an optical disk.
[0135] Based on the above-described preferred embodiments of the present invention, and through the foregoing description, those skilled in the art can make various changes and modifications without departing from the inventive concept. The technical scope of this invention is not limited to the contents of the specification, but must be determined according to the scope of the claims.
Claims
1. A collision detection method for a robot arm based on low-discrepancy sequence uniform sampling, characterized in that, The method includes the following steps: S1, for planning the motion path of the robotic arm, includes: S11, Obtain the current joint position of the robotic arm, and generate a motion path from the current joint position to the target joint position using a robotic arm path planning algorithm. When time t is t, the vector representation of the motion path is: , wherein, is the joint position of the i-th joint of the robot arm at time t; The joint angle values of the current positions of the six axes of the robotic arm are expressed as follows: ; The joint angle value at the target position is expressed as: ; S12, based on the joint angle values of the current position and the joint angle values of the target position of the six axes of the robotic arm, check the validity of the motion path from the current position to the target joint position, and calculate the final joint angle values of the current position and the target position based on the validity results; S13, obtain the final joint angle values at the current position and the target position, and calculate the joint tangent vector from the current joint position to the target joint position. The calculation formula is as follows: joint_tangent = ; S14, set the minimum distance for path node detection to S, calculate the cardinality b of the Vanderkopit sequence and the number of key points K on the path based on the joint tangent vector, and the distance between the number of key points K is not less than S; S2, based on the van der Coppit sequence, uniformly sample the planned mechanical avoidance motion path to obtain the path uniform state points; S3, construct the geometric model of the robotic arm and the environmental obstacle model, and save the constructed geometric model of the robotic arm and the environmental obstacle model to the configuration file; S4, Input the configuration file into the collision detection library, and use the collision detection library to process the uniform state points of the path to achieve collision detection; Specifically, step S14 includes: S141, set joint tangent vector wherein, ; S142, Calculate the joint tangent vector The absolute value of each element in the vector is used to obtain a new vector: ; S143, Find the new vector The largest element value in the array is denoted as . ; S144, ; S145, calculate the number of key points K on the base number calculation path, K = 2 b .
2. The robotic arm collision detection method based on low-difference sequence uniform sampling as described in claim 1, characterized in that, Step 2 specifically includes the following steps: S21, obtain the cardinality b and the number of key points K on the path of the van der Copeet sequence, obtain the sequence length n based on the number of key points K on the path, n=K, use the cardinality b and sequence length n of the van der Copeet sequence as parameters of the van der Copeet sequence generation algorithm, and generate the van der Copeet sequence. S22, the joint path is sampled using the van der Coppit sequence to obtain the uniform sampling sequence. , Represented as uniform sampling points, n is the number of uniform sampling points, i is the number of joints on each axis of the robotic arm, and each sampling point element corresponds to a uniformly distributed random number; S23, using the random number as a parameter for linear interpolation, the intermediate_state point of the path uniformity between the initial position and the target position is calculated using the linear interpolation method. The calculation formula is as follows: 。 3. The robotic arm collision detection method based on low-difference sequence uniform sampling as described in claim 2, characterized in that, Step S3 specifically includes the following steps: Based on the three-dimensional features of the robotic arm, a geometric model of the robotic arm is established, and the position and orientation of each link of the robotic arm relative to the base coordinate system in the initial state are obtained. Based on the kinematic model of the robotic arm, calculate each uniform state point. The position of each link in space under the given attitude; An environmental obstacle model is established based on the three-dimensional features of the obstacles and the three-dimensional features of the surrounding environment. Each obstacle in the environmental obstacle model is used as a static constraint. Each obstacle is described as its position (x, y, z) and orientation (roll, pitch, yaw) relative to the world coordinate system. The geometric model of the robotic arm, the position and orientation of each link of the robotic arm relative to the base coordinate system in the initial state, and each uniform state point are included. The positions of each link in space under the given attitude, as well as the obstacle model, are saved to the configuration file.
4. The robotic arm collision detection method based on low-difference sequence uniform sampling as described in claim 1, characterized in that, In step S4, the collision detection library is used to process the uniform state points along the path to achieve collision detection. This specifically includes the following steps: Obtain path uniform state points By analyzing the uniform state points of the path Inverse solution, the uniform state points of the path are obtained. Corresponding posture; The collision detection library analyzes the path uniformity points according to the set collision detection rules. The corresponding posture is analyzed to determine whether the robotic arm collides with the robotic arm itself or an obstacle.
5. The robotic arm collision detection method based on low-difference sequence uniform sampling as described in claim 1, characterized in that, Step S12 specifically includes: Set the upper and lower limits of the allowable joint position; The joint angle values at the current position and the joint angle values at the target position of each axis of the robotic arm are compared with the upper and lower allowable values, respectively. If the joint angle value at the current position or the joint angle value at the target position of any axis is greater than the allowable upper limit, then subtract 2 from the joint angle value at the current position or the joint angle value at the target position. M_PI, until the joint angle value of the final current position or the joint angle value of the target position of each axis is less than the allowable upper limit value; If the joint angle value at the current position or the joint angle value at the target position of any axis is less than the allowable lower limit, then add 2 to the joint angle value at the current position or the joint angle value at the target position. M_PI, until the joint angle value of the current position or the joint angle value of the target position of each axis is greater than or equal to the allowable lower limit value; Where M_PI is the preset angle value.
6. The robotic arm collision detection method based on low-difference sequence uniform sampling as described in claim 1, characterized in that: The robotic arm path planning algorithm includes a Cartesian space planning algorithm or a joint space planning algorithm.
7. A computer device, characterized in that, include: processor; Memory, used to store executable instructions; The processor is configured to read the executable instructions from the memory and execute the executable instructions to implement the robotic arm collision detection method based on low-difference sequence uniform sampling as described in any one of claims 1 to 6.
8. A computer-readable storage medium, characterized in that, The computer-readable storage medium stores a computer program that, when executed by a processor, causes the processor to implement the robotic arm collision detection method based on uniform sampling of low-difference sequences as described in any one of claims 1 to 6.
Citation Information
Patent Citations
Mechanical arm path planning method integrating low-difference sequence and RRT algorithm
CN112356033A
