Methods for generating robot trajectories, storage media, and terminal devices for bevel scenarios

By constructing a local rotation matrix and superimposing process offset information, the robot beveling operation trajectory is generated, which solves the problems of low efficiency and insufficient trajectory accuracy in the existing technology and realizes efficient and accurate robot trajectory generation.

CN123067320APending Publication Date: 2026-11-10SPEEDBOT ROBOTICS CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611226329.9
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-08-13
Publication Date
2026-11-10

AI Technical Summary

Technical Problem

Existing technologies are inefficient in generating robot beveling operation programs, rely on manual operation, have difficulty guaranteeing trajectory accuracy under complex spatial curves, and lack perception and adaptive mechanisms for the global orientation of the workpiece, resulting in frequent tool posture errors.

Method used

By acquiring the position and orientation information from the planning request, a local rotation matrix is ​​constructed, and process offset information is superimposed to generate the robot's working trajectory, including the infeed, retraction, and safety avoidance trajectories. Combined with process parameters, the tool target pose is automatically generated, reducing manual intervention.

Benefits of technology

It improves the efficiency and accuracy of robot trajectory generation, reduces manual intervention, lowers on-site debugging costs, adapts to spatial orientation changes of complex workpieces, and avoids tool posture errors and flipping.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123067320A_ABST
    Figure CN123067320A_ABST
Patent Text Reader

Abstract

This application discloses a robot trajectory generation method, storage medium, and terminal device for beveling scenarios, relating to the field of robot control technology. By acquiring a planning request, a local rotation matrix is ​​constructed based on the position and orientation information of each point in the beveling point sequence to generate a basic pose set. A process offset determined by process parameters is superimposed on the basic pose to obtain the tool target pose. The approach and retraction points are generated according to the machining direction and merged into the tool target pose to form a machining pose set. Interpolation is performed on adjacent poses, and kinematics are solved using the robot's initial drive parameters as a starting reference to generate a drive parameter sequence. Finally, the robot's working trajectory data is output. This achieves automated generation from discrete beveling points and process parameters to the robot's executable trajectory, improving the efficiency and accuracy of robot trajectory generation.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of robot control technology, and in particular to robot trajectory generation methods, storage media, and terminal devices for beveling scenarios. Background Technology

[0002] In robotic automated machining scenarios such as beveling and grinding, robot program generation is a crucial step that determines machining efficiency and quality. With increasingly complex workpiece shapes and ever-increasing precision requirements, how to efficiently and accurately generate executable robot motion trajectories from beveling geometry has become a critical technical problem that urgently needs to be solved in this field.

[0003] Currently, robot beveling operation programs are mainly generated through the following methods. The manual teaching method involves the operator manually dragging the robot's end effector, recording the coordinates and process parameters point by point along the beveling path to form an executable program. However, this method is inefficient, highly dependent on the operator's experience, and struggles to guarantee trajectory accuracy under complex spatial curves. The offline programming method uses a 3D design model of the workpiece as input. The operator manually selects the beveling edges on the model and sets the tool posture and process parameters. After simulation, the program is output. However, this method relies on a complete and accurate 3D model and is insufficiently adaptable to scenarios where there is no model or where the model deviates from the actual workpiece.

[0004] However, the above solutions lack a global orientation perception and adaptive mechanism for the workpiece. In actual operation, the tool posture is prone to errors or flipping, requiring repeated manual intervention for confirmation. Furthermore, offline programming methods lack the ability to automatically generate parameters, relying solely on manual setting of offset values ​​one by one, resulting in low efficiency and accuracy of the solutions. Summary of the Invention

[0005] To address the aforementioned technical problems, this application provides a method for generating robot trajectories in a bevel scenario, comprising: Obtain a planning request, which includes a command type, robot initial drive parameters, bevel point sequence, and process parameters corresponding to the bevel point sequence. Each bevel point in the bevel point sequence includes position information and orientation information. When the command type is a beveling operation command, a corresponding local rotation matrix is ​​constructed based on the position and direction information of each beveling point in the beveling point sequence, and a basic pose set of the beveling point sequence is generated based on the local rotation matrix and the position information. The process offset information determined by the process parameters is superimposed on the basic pose set, and the tool target pose information of each bevel point is calculated and determined in combination with the process parameters. Based on the machining direction of the bevel point sequence, the tool entry point and the tool retraction point are generated, and the tool entry point and the tool retraction point are merged into the tool target pose information to generate a machining pose set; Interpolation is performed on adjacent poses in the processing pose set to obtain an interpolated pose sequence. Using the robot's initial drive parameters as the starting reference, kinematics are solved on the pose sequence to generate robot work trajectory data.

[0006] In one embodiment, the step of constructing a corresponding local rotation matrix based on the position and orientation information of each bevel point in the bevel point sequence, and generating a basic pose set of the bevel point sequence based on the local rotation matrix and the position information, includes: Based on the location and orientation information of each bevel point, determine the global reference direction; The local first axis of the bevel point is determined based on the direction information of the bevel point, and the local second axis and local third axis of the bevel point are constructed based on the local first axis and the global reference direction. A local rotation matrix of the bevel point is constructed using the local first axis, the local second axis, and the local third axis. Based on the local rotation matrix and the position information, the basic pose of the bevel point is generated to determine the set of basic poses of the bevel sequence.

[0007] In one embodiment, the step of determining the global reference direction based on the location and direction information of each bevel point includes: Select the first bevel point from the bevel point sequence, and generate a reference direction based on the direction information of the first bevel point; In the slope point sequence, candidate slope points are determined according to their positional distance from the first slope point. The unit direction vector corresponding to the candidate slope point is calculated, and the absolute value of the included angle is determined based on the unit direction vector and the reference direction. When there is a candidate bevel point whose absolute value of the included angle is within a preset angle range, the reference direction is cross-multiplied with the unit direction vector to obtain the intermediate direction vector, and the direction of the intermediate direction vector is adjusted to determine the global reference direction. Otherwise, the vertical downward direction of the robot's coordinate system is used as the global reference direction.

[0008] In one embodiment, the step of constructing the local rotation matrix of the bevel point includes: The direction information of the bevel point is normalized to obtain the local first axis of the bevel point; The local first axis is cross-multiplied with the global reference direction and then normalized to obtain the local second axis of the bevel point. The local third axis of the bevel point is obtained by cross-product of the local second axis and the local first axis and normalization. The local rotation matrix of the bevel point is formed by the local first axis, the local second axis, and the local third axis.

[0009] In one embodiment, the step of superimposing process offset information determined by the process parameters onto the basic pose set, and calculating and determining the tool target pose information for each bevel point in combination with the process parameters, includes: When the bevel side in the process parameters is the upper bevel, the basic pose of the bevel point is used as a reference, and the pose part of the basic pose is rotated around the local first axis by the bevel angle to obtain the offset first pose information. The offset of the basic pose is calculated based on the bevel width, kerf width, cutting height and bevel angle in the process parameters. The tool target pose information of the upper bevel is constructed by the first pose information after the offset and the offset amount.

[0010] In one embodiment, the step of superimposing the process offset information determined by the process parameters onto the basic pose set and calculating and determining the tool target pose information of each bevel point in combination with the process parameters further includes: When the bevel side is the lower bevel, the basic pose of the bevel point is used as a reference. The basic pose is rotated around the local third axis by a first preset angle and then rotated around the local first axis by a second preset angle to obtain the offset second pose information. Based on the bevel width, kerf width, cutting height, plate thickness, and bevel angle in the process parameters, calculate the target offset of the basic pose; The tool target pose information of the lower bevel is constructed by the offset second pose information and the target offset.

[0011] In one embodiment, the step of generating the tool entry point and the tool retraction point includes: Based on the processing direction of the bevel point sequence, determine the processing start point and processing end point; Using the machining start point as a reference, the infeed point is generated along the opposite direction of the machining direction, combined with the infeed angle and infeed distance in the process parameters; Using the machining termination point as a reference, the retraction point is generated along the opposite direction of the machining direction, combined with the retraction angle and retraction distance in the process parameters.

[0012] In one embodiment, after the step of obtaining the planning request, the method further includes: When the command type is a photo trajectory command, the initial reference direction is determined based on the direction information of the photo point, and a local rotation matrix of the camera is constructed based on the initial reference direction; Based on the local rotation matrix of the camera and the position information of the shooting point, the target pose of the camera in the robot base coordinate system is generated, and the target pose is converted into the flange target pose of the robot. Based on the target pose of the flange, a safe distance is added in the vertical upward direction along the coordinate system where the robot is located to obtain a safe pose for taking pictures; Using the robot's initial driving parameters as a starting reference, kinematic solutions are performed on the flange target pose and the safe photo pose to obtain the driving parameters of each photo point and the driving parameters corresponding to each safe photo pose. The driving parameters of each of the aforementioned photo-taking points and the driving parameters corresponding to each of the aforementioned photo-taking safe poses are encapsulated into photo-taking trajectory data and returned.

[0013] The robot trajectory generation method, storage medium, and terminal device for bevel scenarios provided in this application have at least the following technical effects: (1) It can generate precise positioning photography trajectory and beveling operation trajectory according to the command type. The vision system and related robot software do not need to embed the beveling trajectory algorithm, which facilitates independent upgrade of each module.

[0014] (2) The real bevel point sequence can be adapted to changes in spatial direction by being determined by the point normal, the workpiece global reference direction, the bevel side and the process angle. The upper and lower bevels adopt process offsets related to the bevel angle, bevel width, cutting height, kerf width and plate thickness, respectively, which can directly generate the tool target pose that conforms to the actual bevel geometry.

[0015] (3) Automatically generate infeed, operation, retraction, safety avoidance and cross-segment transition trajectories, and bind the trajectory segments with process parameter codes to reduce the workload of manually supplementing trajectory logic in robot software.

[0016] (4) By using pose interpolation, point-by-point inverse kinematics and joint continuity constraints, the risk of inverse kinematics branch jumps and wrist flips between adjacent trajectory points is reduced.

[0017] (5) For robot workstations with linear additional axes, the displacement of the additional axis and the target position of the six-axis robot can be automatically allocated according to the target position projection, thereby expanding the reachability of the bevel trajectory. The generated results are returned to the existing robot software via HTTP for offline virtual debugging, which can detect obvious unreachable, collision or unreasonable trajectory problems before using the real robot, reducing on-site debugging costs.

[0018] (6) Improved the efficiency of robot trajectory generation and the accuracy of the generated robot trajectory. Attached Figure Description

[0019] Figure 1 A flowchart illustrating an embodiment of the robot trajectory generation method for a bevel scenario in this application; Figure 2 This is a flowchart illustrating the overall process framework of the solution in this embodiment. Figure 3 This is a flowchart illustrating the calculation of the entry and exit points of the upper bevel in this embodiment. Figure 4 This is a flowchart illustrating the calculation of the entry and exit points of the bevel in this embodiment. Figure 5 This is a schematic diagram of the hardware operating environment of the terminal device involved in the embodiments of this application. Detailed Implementation

[0020] The technical solutions of the embodiments of this application will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only a part of the embodiments of this application, and not all of the embodiments. Based on the embodiments of this application, all other embodiments obtained by those of ordinary skill in the art without creative effort are within the scope of protection of this application.

[0021] It should be noted that if the embodiments of this application involve directional indicators, such as up, down, left, right, front, back, etc., these directional indicators are only used to explain the relative positional relationship and movement of the components in a specific posture. If the specific posture changes, the directional indicators will also change accordingly. Furthermore, if the embodiments of this application involve descriptions such as "first," "second," "S1," "S2," "step one," "step two," etc., these descriptions are for descriptive purposes only and should not be construed as indicating or implying their relative importance, or implicitly indicating the number of technical features indicated or the order of method execution. Those skilled in the art will understand that anything that does not violate the inventive concept should be included within the scope of protection of this application.

[0022] like Figure 1 and Figure 2 As shown, this application provides a method for generating robot trajectories in a bevel scenario, including: Step S10: Obtain the planning request. The planning request includes the command type, robot initial drive parameters, bevel point sequence, and process parameters corresponding to the bevel point sequence. Each bevel point in the bevel point sequence includes position information and orientation information.

[0023] In this embodiment, the trajectory generation system performs the processing actions. The planning request refers to the data call instruction sent by the robot control software or other upper-level system to the trajectory generation system. This instruction can also be used to trigger the trajectory generation process. The planning request adopts a structured data format and includes a command type field. The command type is an identifier field used to distinguish different planning task categories, including at least two values: beveling operation command and image trajectory command. The robot's initial drive parameters include the joint angle values ​​or drive values ​​of each drive axis of the robot before executing the current planned trajectory. The robot's initial drive parameters serve as the starting reference for kinematic solution and are used to ensure the continuity between the planning results and the actual robot. The beveling point sequence refers to the set of discrete points arranged sequentially along the beveling processing path. Each beveling point contains position information and orientation information. This beveling point sequence can be obtained by the vision system through three-dimensional perception of the workpiece beveling, or it can be obtained by offline programming software from the three-dimensional model. The position information is the three-dimensional spatial coordinate of the beveling point in the robot's base coordinate system. The orientation information is the unit normal vector pointing outward from the workpiece contour at the beveling point. Process parameters are a set of parameters that describe the requirements of beveling, including bevel side, bevel angle, bevel width, cutting height, kerf width, and plate thickness. These parameters are predetermined by the processing procedure and are entered in the planning request.

[0024] Furthermore, the trajectory generation algorithm runs as a standalone HTTP planning service, receiving planning requests from existing robot software or vision systems. The planning request includes at least the command type, initial joint states of the robot, workbench identifiers, discrete bevel points, and corresponding process parameters.

[0025] Specifically, after the planning service starts, it opens a communication port to wait for external requests. When an external system needs to generate a robot trajectory, it constructs a planning request according to the agreed data format and sends it to the trajectory generation system. Upon receiving the planning request, the trajectory generation system first parses the command type field in the request and determines the branch of the subsequent execution process based on the value of this field. If the command type is a beveling operation command, the planning service extracts the robot's initial drive parameters, beveling point sequence, and corresponding process parameters from the request, storing this data in an internal data structure for use in subsequent steps. If the command type is a photographic trajectory command, it proceeds to the photographic trajectory generation process.

[0026] As an optional implementation, each bevel point is defined as an ordered pair: ;

[0027] in, For the input information of the i-th bevel point, These represent the position of the bevel point and the normal vector pointing outwards from the profile, respectively. This is the xyz information in Cartesian space. The normal vector is expressed in Cartesian coordinates, with position coordinates input in millimeters and converted to meters when constructing the robot pose. The normal vector is used to determine the orientation of the camera or tooling. Process parameters are provided in the planning request, including bevel profile and bevel angle. bevel width Cutting height kerf width , plate thickness Preheating bias, infeed angle feed distance Retraction angle Retraction distance Forward tilt angle Processing direction and process parameters, etc. It is understandable that the bevel type does not need to be re-identified within the trajectory generation system.

[0028] Furthermore, after step S10, the following steps are also included: When the command type is a photo trajectory command, the initial reference direction is determined based on the direction information of the photo point, and the local rotation matrix of the camera is constructed based on the initial reference direction; Based on the local rotation matrix of the camera and the position information of the shooting point, the target pose of the camera in the robot's base coordinate system is generated, and the target pose is converted into the flange target pose of the robot. Based on the target pose of the flange, a safe distance is added in the vertical upward direction along the coordinate system where the robot is located to obtain the safe pose for taking pictures; Using the robot's initial driving parameters as the starting reference, the kinematics of the flange target pose and the safe pose for taking pictures are solved respectively to obtain the driving parameters of each picture point and the driving parameters corresponding to each safe pose for taking pictures. The driving parameters of each shooting point and the driving parameters corresponding to each safe shooting pose are encapsulated into shooting trajectory data and returned.

[0029] Specifically, upon receiving a command to capture the photographic trajectory, the planning service reads the coarse positioning point sequence and the robot's initial joint state to generate a precise positioning and photographing trajectory for the end-effector camera. It's important to note that the coarse positioning point sequence is a series of approximate location points (i.e., photographing points) used to guide the robot's camera to the vicinity of the workpiece before performing the precise positioning and photographing. It is typically provided by a fixed camera or similar device, and its purpose is to quickly bring the robot's end-effector camera to the approximate area of ​​the workpiece, preparing for subsequent acquisition of high-precision bevel points. The specific steps are as follows: (1) Establishment of the local coordinate system of the camera, for the first... There are several camera points, with the positive direction of the input normal vector as the local Y-axis of the camera, and the coordinate system of the robot. The direction is the initial reference direction. Construct an orthogonal coordinate system: .

[0030] in, , Let (x, y, z) be the direction vectors of the camera's orthogonal coordinate system, then the local rotation matrix of the camera is obtained. .

[0031] (2) Camera target pose calculation: Let the camera's tilt angle around the local X-axis be . along the local The shooting distance in the direction is Then the local compensation transformation of the camera is ;

[0032] in, Let be the rotation matrix for local compensation, rotating the camera around the x-axis by an angle βc, where tc is the local compensation displacement. Target pose of camera in base coordinate system for ;

[0033] Suppose the known fixed transformation from the camera coordinate system to the robot flange coordinate system is: Then the flange photograph target pose for ;

[0034] The robot's current photographing position is raised along the z-axis of the world coordinate system to obtain the robot's safe transition pose, thus obtaining the complete robot photographing trajectory. After the camera calculates the precise positioning trajectory of the workpiece, it is transmitted to the planning algorithm to obtain the robot's actual bevel trajectory.

[0035] (3) Trajectory encapsulation and return: The generated photo joint sequence is encapsulated into a photo trajectory, marked as the corresponding trajectory segment type, and returned.

[0036] Step S20: When the command type is a beveling operation command, construct the corresponding local rotation matrix based on the position and orientation information of each beveling point in the beveling point sequence, and generate the basic pose set of the beveling point sequence based on the local rotation matrix and position information.

[0037] In this embodiment, the local rotation matrix is ​​a mathematical expression describing the local coordinate system of the tool corresponding to each bevel point. It is an orthogonal matrix composed of three mutually orthogonal axial vectors. The position information and the local rotation matrix together constitute a complete pose expression. The position information determines the origin of the tool coordinate system, and the local rotation matrix determines the orientation of the tool coordinate system. The basic pose is the initial pose determined by the geometric information of the bevel points, namely their position and orientation information. This initial pose does not include offsets related to process parameters, such as the bevel angle. The basic pose set is a data set formed by generating the basic pose for each bevel point in the bevel point sequence using the same method. This set maintains the same order as the input bevel point sequence.

[0038] Optionally, in this embodiment, step S20 includes: Determine the global reference direction based on the location and direction information of each bevel point; The local first axis of the bevel point is determined based on the direction information of the bevel point, and the local second axis and local third axis of the bevel point are constructed based on the local first axis and the global reference direction. A local rotation matrix for the bevel point is constructed using the local first axis, local second axis, and local third axis. Based on the local rotation matrix and position information, the basic pose of the bevel point is generated to determine the basic pose set of the bevel sequence.

[0039] As an optional implementation, the step of determining the global reference direction based on the location and direction information of each bevel point includes: Select the first bevel point from the bevel point sequence, and generate a reference direction based on the direction information of the first bevel point; In the slope point sequence, candidate slope points are determined according to their positional distance from the first slope point. The unit direction vector of the candidate slope point corresponding to the first slope point is calculated, and the absolute value of the corresponding included angle is determined based on the unit direction vector and the reference direction. When there are candidate bevel points with an absolute angle value within a preset angle range, the reference direction is cross-multiplied with the unit direction vector to obtain the intermediate direction vector, and the direction of the intermediate direction vector is adjusted to determine the global reference direction. Otherwise, the vertical downward direction of the robot's coordinate system is used as the global reference direction.

[0040] Specifically, after obtaining the bevel point sequence, the direction information of the first bevel point is extracted from the sequence and normalized to obtain the reference direction. Then, the remaining bevel points are traversed in order of increasing distance from the first bevel point. For each candidate bevel point, the unit direction vector pointing from the first bevel point to that candidate bevel point is calculated, and the absolute value of the angle between this unit direction vector and the reference direction vector is calculated. The preset angle range can be selected between 40 degrees and 90 degrees. A lower limit of 40 degrees can exclude points that are too close to the normal vector direction of the first point. If the angle is too small, the candidate point and the first point are basically located in the same plane, which cannot provide effective "perpendicular" information to determine the global attitude of the workpiece. An upper limit of 90 degrees represents that the two vectors are completely perpendicular, which is the ideal case with the most information. The closer the angle is to 90 degrees, the clearer the "perpendicular" relationship between the normal vector and the direction vector.

[0041] When there are candidate bevel points with an angle between 40 and 90 degrees, the reference direction is cross-multiplied with the unit direction vector to obtain an intermediate direction vector, which is then adjusted to point downwards in the robot's coordinate system. The adjusted direction vector is used as the global reference direction. When there are no candidate points that meet the above angle conditions, the vertical downward direction of the robot's coordinate system is directly used as the global reference direction.

[0042] For example, to avoid orientation errors on tilted workpieces, the global reference orientation of the workpiece is first determined based on all bevel points. Take the unit normal vector of the first bevel point. : ;

[0043] Search other candidate points in descending order of distance from the first point, and calculate the unit direction from the first point to the candidate points. and the direction and the normal vector of the first point The included angle between them: ;

[0044] in, Let this be the position vector of the first bevel point. Let j be the position vector of the j-th bevel point, i.e., the candidate point. Let be the angle between the unit direction and the normal vector of the first point, when there exists a condition that satisfies... When selecting candidate points, take ,

[0045] in This indicates that if the obtained vector is in the robot coordinate system If the dot product of directions is less than zero, then the vector is reversed to ensure... Point downwards from the robot. If no candidate point meets the conditions, then set... .

[0046] For the For each bevel point, the input normal vector is reversed and normalized to serve as the local Y-axis: ;

[0047] Construct orthogonal local axes by combining global reference directions shaft and axis: ;

[0048] This yields the local rotation matrix of the bevel point. and basic pose : ;

[0049] Furthermore, in this embodiment, the step of constructing the local rotation matrix of the bevel point includes: Normalize the direction information of the bevel point to obtain the local first axis of the bevel point; The local second axis is obtained by cross-productting the local first axis with the global reference direction and normalizing it. By performing a cross product between the local second axis and the local first axis and normalizing the result, the local third axis of the bevel point is obtained. The local rotation matrix of the bevel point is formed by the local first axis, the local second axis, and the local third axis.

[0050] Specifically, after determining the global reference direction, each bevel point in the bevel point sequence is processed sequentially as follows: the direction information of the bevel point is reversed and normalized to obtain the local first axis; the local first axis is cross-multiplied with the global reference direction and normalized to obtain the local second axis; the local second axis is cross-multiplied with the local first axis and normalized to obtain the local third axis; the local first axis, local second axis, and local third axis together constitute the local rotation matrix of the bevel point; the coordinate values ​​in the position information are converted from millimeters to meters and combined with the local rotation matrix to generate the basic pose of the bevel point. After completing the above processing for all bevel points, all basic poses are organized into a basic pose set according to the original order.

[0051] By using an adaptive determination mechanism for the global reference direction and a point-by-point construction method for the local rotation matrix, even if the workpiece as a whole has a spatial tilt, the local attitude of each bevel point can maintain a consistent spatial orientation reference. This effectively avoids tool attitude errors or flipping problems caused by the lack of global orientation awareness in existing solutions, and provides a reliable attitude basis for the accurate superposition of subsequent process offsets.

[0052] Step S30: Superimpose the process offset information determined by the process parameters onto the basic pose set, and calculate and determine the tool target pose information of each bevel point in combination with the process parameters.

[0053] In this embodiment, the process offset information is the additional position offset and attitude rotation that need to be applied on top of the basic pose to ensure that the tool can be correctly positioned at the beveling machining location according to the beveling process requirements. The tool target pose is the target pose that the tool end needs to reach during the actual machining process, obtained by fusing beveling geometry information and beveling process parameters. Beveling side distinction is a process attribute that distinguishes whether the beveling is located on the upper or lower side of the workpiece. Different beveling side distinctions determine from which side of the workpiece the tool approaches the beveling, thus the corresponding offset direction and attitude adjustment method are completely different.

[0054] Optionally, in this embodiment, the step of superimposing process offset information determined by process parameters onto the basic pose set, and calculating and determining the tool target pose information for each bevel point in combination with the process parameters, includes: When the bevel side in the process parameters is the upper bevel, the basic pose of the bevel point is used as the reference, and the pose part of the basic pose is rotated around the local first axis by the bevel angle to obtain the first pose information after offset. Calculate the offset of the basic pose based on the bevel width, kerf width, cutting height and bevel angle in the process parameters; The tool target pose information at the upper bevel is constructed using the first pose information after offset and the offset.

[0055] Specifically, after obtaining the basic pose set, for each basic pose in the set, different process offset calculation methods are selected based on the bevel side corresponding to that bevel point. When the bevel side is the upper bevel, the planning service uses the attitude part of the basic pose as a reference and rotates it around the local first axis by the bevel angle to obtain the offset first pose information; at the same time, the offset is calculated based on the bevel width, kerf width, cutting height, and bevel angle. The offset in the local second axis is determined by subtracting the kerf width from the bevel width, dividing by twice the cosine of the bevel angle, and adding the cutting height multiplied by the tangent of the bevel angle. The offset in the local third axis is the negative value of the cutting height. The calculated attitude rotation and position offset are applied to the basic pose to obtain the tool target pose of that bevel point. Finally, after performing the above offset superposition on all basic poses, a set of tool target pose information corresponding one-to-one with the bevel point sequence is obtained.

[0056] Based on the bevel orientation, the bevel angle is superimposed on the base pose. bevel width Cutting height kerf width and plate thickness The process bias is determined jointly.

[0057] For the local rotation transformation of the upper (outer) bevel Local translation transformation rotx represents rotation around x: ;

[0058] in, This is the first pose information obtained from the local rotation transformation. The offset is obtained by local translation transformation. For bevel angle, For bevel width, For cutting height, This refers to the kerf width.

[0059] Furthermore, in this embodiment, the step of superimposing process offset information determined by process parameters onto the basic pose set, and calculating and determining the tool target pose information of each bevel point in combination with the process parameters, further includes: When the bevel side is the lower bevel, the basic pose of the bevel point is used as the reference. The basic pose is rotated by a first preset angle around the local third axis and then rotated by a second preset angle around the local first axis to obtain the offset second pose information. Calculate the target offset of the base pose based on the bevel width, kerf width, cutting height, plate thickness and bevel angle in the process parameters; The tool target pose information of the lower bevel is constructed using the offset second pose information and the target offset.

[0060] Specifically, the first preset angle is preferably 180 degrees, and the second preset angle is preferably the difference between 90 degrees and the bevel angle. For the lower bevel, the tool needs to approach the bevel from below the workpiece, with its orientation completely opposite to that of the upper bevel along the third axis (Z-axis) of the local coordinate system. To flip the tool from the upper to the lower posture, it needs to rotate 180 degrees around the local third axis (Z-axis) to reverse the tool's orientation towards the lower side of the workpiece. This is a fundamental geometric relationship in rigid body posture transformation—rotating 180 degrees around the Z-axis completely reverses the orientation of a coordinate system. Therefore, the first preset angle needs to be set to 180 degrees. The first and second preset angles together constitute the complete posture offset of the lower bevel. After their combination, the tool changes from a basic posture pointing outwards from the workpiece to a machining posture pointing downwards towards the bevel's inclined surface. Therefore, the second preset angle needs to be rotated in the opposite direction around the X-axis, i.e., the difference between 90 degrees and the bevel angle, to ensure that the tool target pose of the lower bevel conforms to the actual bevel geometry.

[0061] When the bevel side is the lower bevel, the planning service uses the attitude portion of the basic pose as a reference. It first rotates the basic pose by 180 degrees around the local third axis, then by 90 degrees around the local first axis. The difference between this rotation and the bevel angle is used to obtain the offset second pose information. Simultaneously, the offset in the local second axis is the negative value of the cutting height, and the offset in the local third axis is determined by subtracting the bevel width from the plate thickness, adding the kerf width divided by twice the cosine of the bevel angle, and then subtracting the cutting height multiplied by the tangent of the bevel angle. The calculated attitude rotation and position offset are applied to the basic pose to obtain the tool target pose at that bevel point. After performing the above offset superposition on all basic poses, a set of tool target pose information corresponding one-to-one with the bevel point sequence is obtained.

[0062] For the local rotation transformation of the lower (inner) bevel Local translation transformation rotx represents rotation around x: ;

[0063] in, The second pose information is obtained from the local rotation transformation. The target offset is obtained by local translation transformation. For plate thickness, This is a rotation about the z-axis of the local coordinate system. Furthermore, all length parameters are converted to meters before the homogeneous transformation. The tool target pose information is: ;

[0064] in, For the target pose information of the tool, Let the tool target pose be from 0 to the i-th bevel point. This refers to the first or second pose information corresponding to the upper or lower bevel. This refers to the offset or target offset corresponding to the upper or lower bevel.

[0065] Through the adaptive process offset superposition mechanism of bevel side, multiple process parameters such as bevel angle, bevel width, cutting height, kerf width and plate thickness are automatically mapped to the position offset and attitude rotation of the tool target pose, eliminating the need for manual setting of offset values ​​for each item and greatly improving the efficiency of trajectory generation.

[0066] Step S40: Generate the tool entry point and tool retraction point according to the machining direction of the bevel point sequence, and merge the tool entry point and tool retraction point into the tool target pose information to generate a machining pose set.

[0067] In this embodiment, the machining direction refers to the overall direction along the bevel point sequence from the machining start point to the machining end point, determined by the positions of the first and last points of the bevel point sequence. The entry point is a transition point located before the machining start point, used to guide the tool from a safe position to the bevel machining start position. The retraction point is a transition point located after the machining end point, used to guide the tool from the bevel machining end position to a safe position. The machining pose set is a complete pose sequence obtained by merging the tool target pose corresponding to the entry point, the original machining point, and the retraction point according to the machining sequence.

[0068] Specifically, after obtaining the tool target pose information, the machining direction unit vector is first calculated based on the first and last points of the original bevel point sequence. Then, using the pose corresponding to the machining start point in the tool target pose information as a reference, the tool is extended in the opposite direction of the machining direction according to the feed angle and feed distance in the process parameters to generate the feed point; using the pose corresponding to the machining end point as a reference, the tool is extended in the opposite direction of the machining direction according to the retraction angle and retraction distance in the process parameters to generate the retraction point. The poses of the feed point and the retraction point are inherited from the poses of the tool target pose at the machining start point and the tool target pose at the machining end point, respectively. Finally, a complete set of machining poses is constructed according to the feed points, all tool target poses in their original order, and the retraction points, with the feed points at the beginning of the sequence and the retraction points at the end of the sequence.

[0069] Through the automatic generation and merging mechanism of the tool entry point and retraction point, auxiliary process parameters such as entry angle, entry distance, retraction angle, and retraction distance are automatically converted into a complete machining pose sequence. Operators do not need to manually set the entry and exit trajectories point by point in the robot control software, avoiding the risk of machining point drift caused by process parameter modification, while ensuring the continuity and smoothness of the tool trajectory from entry to machining to retraction.

[0070] Optionally, in this embodiment, the steps of generating the tool entry point and tool retraction point include: Determine the starting and ending points of processing based on the processing direction of the bevel point sequence; Using the machining start point as a reference, the infeed point is generated along the opposite direction of the machining direction, combined with the infeed angle and infeed distance in the process parameters; Using the machining termination point as a reference, the retraction point is generated along the opposite direction of the machining direction, combined with the retraction angle and retraction distance in the process parameters.

[0071] Specifically, the approach angle refers to the angle between the approach direction and the bevel point sequence, and the approach distance refers to the spatial distance extended outward from the machining start point along the approach direction. The retraction angle refers to the angle between the retraction direction and the bevel point sequence, and the retraction distance refers to the spatial distance extended outward from the machining end point along the retraction direction.

[0072] First, the position information of the first and last bevel points is extracted from the bevel point sequence. The unit direction vector from the first to the last point is calculated; this unit direction vector is the machining direction. Once the machining direction is determined, the tool target pose corresponding to the first bevel point is the pose corresponding to the machining start point, and the tool target pose corresponding to the last bevel point is the pose corresponding to the machining end point. The planning service marks these two poses as the start pose and end pose, respectively, as the reference for generating subsequent tool approach and retraction points. The bevel point sequence is arranged according to the actual machining path order; therefore, the first and last points of the sequence naturally correspond to the two endpoints of the machining path. Using these two endpoints as the reference for tool approach and retraction conforms to the actual machining process requirements.

[0073] To ensure a smooth transition from a safe state to a machining state before entering the beveling area, a transition point needs to be pre-set before the machining start point. This transition point extends outward in the opposite direction of the machining direction, and the tool gradually cuts into the workpiece from this point. In practice, the planning service first obtains the position and orientation information of the machining start point, as well as the beveling direction before the start point, to determine the cutting direction of the tool entry. The position of the entry point is determined by deflecting the tool at an angle in the opposite direction of the machining direction from the position of the machining start point, and then moving the tool a certain distance in the deflected direction. The planning service directly assigns the orientation information of the tool target pose at the machining start point to the entry point, ensuring that the orientation of the entry point is consistent with that of the machining start point.

[0074] A transition point is set after the machining termination point. After completing the beveling, the tool moves from the machining termination point to this retraction point, and then safely leaves the workpiece area from the retraction point. The position and orientation information of the machining termination point, as well as the beveling direction after the machining termination point, are obtained to determine the cutting direction of the retraction. The position of the retraction point is the spatial position reached by deflecting the tool at a retraction angle in the opposite direction of the machining direction from the position of the machining termination point, and then moving the tool a distance in the direction of the deflection. The orientation of the retraction point is also inherited from the tool target pose at the machining termination point to ensure that the tool's orientation is continuous and without abrupt changes during the retraction process from the machining termination point to the retraction point.

[0075] Calculate the unit direction along the outside of the trajectory at the start and end points. , : ;

[0076] in, The processing start point is located in the unit direction outside the trajectory. The processing termination point is located in the unit direction outside the trajectory. The first point, i.e., the starting point of processing. For the bevel point adjacent to the processing start point, This is the processing termination point; the upper bevel is... The cross product of the bevel plane normal and the axis of rotation is the lower bevel. With robots The cross product of the directions forms the rotation axis, and the entry point is generated by combining the feed distance and angle. Similarly, the retraction point is generated by combining the retraction distance and retraction angle. .

[0077] like Figure 3 and Figure 4 The robot's entry point at the uphill slope and retraction point The calculation formula is as follows: ; ;

[0078] Wherein, the symbol rot represents the rotation matrix around the rotation axis by an angle θ. and Let these represent the normal vectors of the first bevel point and the tail point. and Indicates the unit direction along the outer edge of the trajectory at the start and end points. and Indicates the advance distance and retraction distance. and This indicates the infeed angle and retraction angle; the infeed distance and retraction distance are given by the process parameters. Similarly, the entry point of the downhill robot and retraction point The calculation formula is as follows: ; ;

[0079] The symbol rot represents the rotation matrix around the rotation axis by an angle θ. and The feed distance and retraction distance are represented by z, and z represents the downward workpiece plane vector.

[0080] By generating the entry and exit points in the opposite direction of the machining direction and combining the entry angle, entry distance, retraction angle, and retraction distance, auxiliary process parameters such as the entry angle, entry distance, retraction angle, and retraction distance are automatically converted into the spatial positions of the entry and retraction points. Furthermore, the postures of the entry and retraction points are smoothly connected to the machining trajectory by inheriting the postures of the corresponding machining endpoints. Based on this, by incorporating the entry and retraction points generated in this embodiment into the tool target pose information to generate a machining pose set, a continuous and smooth motion transition can be achieved between the entry and retraction trajectories and the machining trajectory. This mechanism allows operators to automatically generate complete entry and retraction trajectories simply by setting four values ​​at the process parameter level: entry angle, entry distance, retraction angle, and retraction distance. This eliminates the need to manually set the entry and exit paths point by point in the robot control software, while also avoiding the risk of machining point drift caused by process parameter modifications. This significantly reduces the burden of manual operation and the probability of errors, and improves the automation and efficiency of trajectory generation.

[0081] Step S50: Interpolate adjacent poses in the processing pose set to obtain the interpolated pose sequence, and use the robot's initial drive parameters as the starting reference to solve the kinematics of the pose sequence to generate robot working trajectory data.

[0082] In this embodiment, interpolation refers to the process of generating several intermediate poses between two adjacent known poses according to certain rules. Its purpose is to make the tool's motion trajectory smoother and more continuous, avoiding abrupt changes in motion caused by excessive distances between adjacent poses. The pose sequence is a sequence of all poses obtained by interpolating adjacent poses in the processing pose set, arranged in order. The driving parameter sequence is a sequence of all driving parameter values ​​obtained by kinematic solving for each pose in the pose sequence, arranged in order.

[0083] Specifically, after obtaining the processing pose set, interpolation is first performed sequentially on adjacent poses within the set. For each pair of adjacent poses, the spatial straight-line distance between their positional portions is calculated, and the number of interpolation segments is determined based on this distance. The larger the distance, the more interpolation segments are used to ensure that the spacing between adjacent interpolation points does not exceed a preset threshold. After determining the number of interpolation segments, the planning service uses linear interpolation for the positional portion, evenly distributing the position coordinates of each interpolation point between the start and end positions according to the interpolation progress. For the pose portion, spherical linear interpolation is used. Before interpolation, the dot product between the quaternion representations of the two poses is determined. If the dot product is negative, it indicates that the angle between the two poses is greater than 180 degrees. In this case, one of the pose quaternions is inverted before interpolation to ensure the shortest interpolation path. After the planning service completes interpolation for all adjacent poses, the interpolated pose sequence is obtained. Then, using the robot's initial drive parameters as a starting reference, kinematics are solved for the first pose in the pose sequence to obtain the first drive parameters. Next, using the first drive parameters as a reference, kinematics are solved for the second pose, ensuring that the difference between the solution and the first drive parameters does not exceed a preset range and that the wrist configuration remains consistent. This process is repeated until all poses in the pose sequence have been processed, resulting in the drive parameter sequence. If the solution for a certain position fails or the solution violates continuity constraints, the planning service attempts to adjust the initial reference values ​​and resolve. If this still fails, trajectory generation is deemed a failure, and the process terminates.

[0084] After obtaining the complete drive parameter sequence, the trajectory segment type is determined based on the pose source corresponding to each drive parameter. The trajectory segment type is a category identifier that classifies the drive parameter sequence according to its motion function; different trajectory segment types correspond to the robot's actions at different stages or for different process requirements during machining. The entire drive parameter sequence is divided into a start segment, an approach segment, a working segment, a retraction segment, and an end segment. The start and end segments correspond to the safe transition actions at the beginning and end of the trajectory, respectively. The approach segment corresponds to the process of approaching the workpiece from a safe position, the working segment corresponds to the actual beveling process, and the retraction segment corresponds to the process of the tool leaving the workpiece. After the division, the planning service binds the corresponding process parameter codes to the working segment, approach segment, and retraction segment. Finally, the planning service organizes all trajectory segments sequentially into structured trajectory data, which is returned to the requester as the final output of this method.

[0085] Specifically, position linear interpolation and quaternion spherical linear interpolation (Slerp) are performed between adjacent target poses (including safe pose, approach point, working point, and retraction point). The number of interpolation segments... : ;

[0086] in, The direction vector of the starting point. The direction vector of the endpoint. The interpolation progress is represented by k, which is the segment number where the current interpolation is performed.

[0087] Position interpolation: .

[0088] Attitude interpolation: take If it is negative, then reverse. To ensure the shortest path, Let be the quaternion representing the robot's initial pose. The quaternion for the robot's final pose ;

[0089] For each interpolated pose, the state of the previous joint For reference, solve the inverse kinematics: ;

[0090] T is the robot pose matrix in the current state, Qk is the robot's driving parameters in the current state, and continuity constraints are applied: ;

[0091] If a point has no solution or violates constraints, the current trajectory generation fails. The planning service can attempt to change the initial sixth joint angle or remove the additional axis fixing constraint to regenerate; if this also fails, it returns a planning failure message.

[0092] By employing a kinematic solution mechanism based on pose interpolation and continuity constraints, the smoothness of tool motion is ensured through pose interpolation, avoiding motion jumps caused by excessively large intervals between adjacent poses. On the other hand, by using the previous driving parameter as a reference for continuity solution, the risk of inverse solution branch jumps and wrist flips between adjacent trajectory points is effectively reduced, ensuring that the planning results are executable and the motion is continuous on the actual robot.

[0093] In summary, this embodiment acquires a planning request, then constructs a corresponding local rotation matrix based on the position and orientation information of each bevel point in the bevel point sequence. Based on the local rotation matrix and position information, a basic pose set for the bevel point sequence is generated. Next, process offset information determined by process parameters is superimposed on the basic pose set, and the tool target pose information for each bevel point is calculated using the process parameters. Subsequently, the tool approach and retraction points are generated according to the machining direction of the bevel point sequence, and these points are merged into the tool target pose information to generate a machining pose set. Finally, adjacent poses in the machining pose set are interpolated to obtain an interpolated pose sequence. Using the robot's initial drive parameters as a starting reference, kinematics are solved on the pose sequence to generate robot work trajectory data. This achieves automated generation from discrete bevel points and process parameters to the robot's executable trajectory, thereby improving the efficiency and accuracy of robot trajectory generation.

[0094] On the other hand, this application also provides a computer storage medium storing executable program code; the executable program code is used to execute the robot trajectory generation method for the above-mentioned arbitrary bevel scenario.

[0095] On the other hand, this application also provides a terminal device, including a memory and a processor; the memory stores program code that can be executed by the processor; the program code is used to execute the robot trajectory generation method for any of the above-mentioned bevel scenarios.

[0096] For example, the program code can be divided into one or more modules / units, which are stored in the memory and executed by the processor to complete this application. The one or more modules / units can be a series of computer program instruction segments capable of performing a specific function, which describe the execution process of the program code in a terminal device.

[0097] like Figure 5 As shown, the terminal device can be a desktop computer, laptop, handheld computer, or cloud server, etc. The terminal device may include, but is not limited to, a processor and memory. Those skilled in the art will understand that the terminal device may also include input / output devices, network access devices, buses, etc.

[0098] The processor can be a Central Processing Unit (CPU), or other general-purpose processors, digital signal processors (DSPs), application-specific integrated circuits (ASICs), field-programmable gate arrays (FPGAs), or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor can be a microprocessor or any conventional processor.

[0099] The memory can be an internal storage unit of the terminal device, such as a hard drive or RAM. The memory can also be an external storage device of the terminal device, such as a plug-in hard drive, SmartMedia Card (SMC), Secure Digital (SD) card, or Flash Card. Furthermore, the memory can include both internal and external storage units of the terminal device. The memory is used to store the program code and other programs and data required by the terminal device. The memory can also be used to temporarily store data that has been output or will be output.

[0100] The aforementioned terminal device is created based on the robot trajectory generation method for the aforementioned bevel scenario. Its technical function and beneficial effects will not be elaborated here. The technical features of the above embodiments can be combined arbitrarily. For the sake of brevity, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0101] The embodiments described above are merely illustrative of several implementation methods of this application, and while the descriptions are relatively specific and detailed, they should not be construed as limiting the scope of the invention patent. It should be noted that those skilled in the art can make various modifications and improvements without departing from the concept of this application, and these all fall within the protection scope of this application. Therefore, the protection scope of this patent application should be determined by the appended claims.

Claims

1. A method for generating robot trajectories in a bevel scenario, characterized in that, include: Obtain a planning request, which includes a command type, robot initial drive parameters, bevel point sequence, and process parameters corresponding to the bevel point sequence. Each bevel point in the bevel point sequence includes position information and orientation information. When the command type is a beveling operation command, a corresponding local rotation matrix is ​​constructed based on the position and direction information of each beveling point in the beveling point sequence, and a basic pose set of the beveling point sequence is generated based on the local rotation matrix and the position information. The process offset information determined by the process parameters is superimposed on the basic pose set, and the tool target pose information of each bevel point is calculated and determined in combination with the process parameters. Based on the machining direction of the bevel point sequence, the tool entry point and the tool retraction point are generated, and the tool entry point and the tool retraction point are merged into the tool target pose information to generate a machining pose set; Interpolation is performed on adjacent poses in the processing pose set to obtain an interpolated pose sequence. Using the robot's initial drive parameters as the starting reference, kinematics are solved on the pose sequence to generate robot work trajectory data.

2. The method according to claim 1, characterized in that, The step of constructing a corresponding local rotation matrix based on the position and orientation information of each bevel point in the bevel point sequence, and generating a basic pose set of the bevel point sequence based on the local rotation matrix and the position information, includes: Based on the location and orientation information of each bevel point, determine the global reference direction; The local first axis of the bevel point is determined based on the direction information of the bevel point, and the local second axis and local third axis of the bevel point are constructed based on the local first axis and the global reference direction. A local rotation matrix of the bevel point is constructed using the local first axis, the local second axis, and the local third axis. Based on the local rotation matrix and the position information, the basic pose of the bevel point is generated to determine the basic pose set of the bevel sequence.

3. The method according to claim 2, characterized in that, The step of determining the global reference direction based on the location and direction information of each bevel point includes: Select the first bevel point from the bevel point sequence, and generate a reference direction based on the direction information of the first bevel point; In the slope point sequence, candidate slope points are determined according to their positional distance from the first slope point. The unit direction vector corresponding to the candidate slope point is calculated, and the absolute value of the included angle is determined based on the unit direction vector and the reference direction. When there is a candidate bevel point whose absolute value of the included angle is within a preset angle range, the reference direction is cross-multiplied with the unit direction vector to obtain the intermediate direction vector, and the direction of the intermediate direction vector is adjusted to determine the global reference direction. Otherwise, the vertical downward direction of the robot's coordinate system is used as the global reference direction.

4. The method according to claim 2, characterized in that, The steps for constructing the local rotation matrix of the bevel point include: The direction information of the bevel point is normalized to obtain the local first axis of the bevel point; The local first axis is cross-multiplied with the global reference direction and then normalized to obtain the local second axis of the bevel point. The local third axis of the bevel point is obtained by cross-product of the local second axis and the local first axis and normalization. The local rotation matrix of the bevel point is formed by the local first axis, the local second axis, and the local third axis.

5. The method according to claim 1, characterized in that, The step of superimposing the process offset information determined by the process parameters onto the basic pose set, and calculating and determining the tool target pose information for each bevel point in combination with the process parameters, includes: When the bevel side in the process parameters is the upper bevel, the basic pose of the bevel point is used as a reference, and the pose part of the basic pose is rotated around the local first axis by the bevel angle to obtain the offset first pose information. The offset of the basic pose is calculated based on the bevel width, kerf width, cutting height and bevel angle in the process parameters. The tool target pose information of the upper bevel is constructed by the first pose information after the offset and the offset amount.

6. The method according to claim 1, characterized in that, The step of superimposing the process offset information determined by the process parameters onto the basic pose set, and calculating and determining the tool target pose information of each bevel point in combination with the process parameters, further includes: When the bevel side is the lower bevel, the basic pose of the bevel point is used as a reference. The basic pose is rotated around the local third axis by a first preset angle and then rotated around the local first axis by a second preset angle to obtain the offset second pose information. Based on the bevel width, kerf width, cutting height, plate thickness, and bevel angle in the process parameters, calculate the target offset of the basic pose; The tool target pose information of the lower bevel is constructed by the offset second pose information and the target offset.

7. The method according to claim 1, characterized in that, The steps of generating the tool entry point and the tool retraction point include: Based on the processing direction of the bevel point sequence, determine the processing start point and processing end point; Using the machining start point as a reference, the infeed point is generated along the opposite direction of the machining direction, combined with the infeed angle and infeed distance in the process parameters; Using the machining termination point as a reference, the retraction point is generated along the opposite direction of the machining direction, combined with the retraction angle and retraction distance in the process parameters.

8. The method according to claim 1, characterized in that, Following the step of obtaining the planning request, the method further includes: When the command type is a photo trajectory command, the initial reference direction is determined based on the direction information of the photo point, and a local rotation matrix of the camera is constructed based on the initial reference direction; Based on the local rotation matrix of the camera and the position information of the shooting point, the target pose of the camera in the robot base coordinate system is generated, and the target pose is converted into the flange target pose of the robot. Based on the target pose of the flange, a safe distance is added in the vertical upward direction along the coordinate system where the robot is located to obtain a safe pose for taking pictures; Using the robot's initial driving parameters as a starting reference, kinematic solutions are performed on the flange target pose and the safe photo pose to obtain the driving parameters of each photo point and the driving parameters corresponding to each safe photo pose. The driving parameters of each of the aforementioned photo-taking points and the driving parameters corresponding to each of the aforementioned photo-taking safe poses are encapsulated into photo-taking trajectory data and returned.

9. A computer storage medium, characterized in that, It stores executable program code; the executable program code is used to execute the robot trajectory generation method for the bevel scene according to any one of claims 1 to 8.

10. A terminal device, characterized in that, It includes a memory and a processor; the memory stores program code that can be executed by the processor; the program code is used to execute the robot trajectory method for the bevel scenario as described in any one of claims 1 to 8.