WO2023173677A1 - Procédé et appareil de fusion de trajectoires, et dispositif et support de stockage - Google Patents

Procédé et appareil de fusion de trajectoires, et dispositif et support de stockage Download PDF

Info

Publication number
WO2023173677A1
WO2023173677A1 PCT/CN2022/113053 CN2022113053W WO2023173677A1 WO 2023173677 A1 WO2023173677 A1 WO 2023173677A1 CN 2022113053 W CN2022113053 W CN 2022113053W WO 2023173677 A1 WO2023173677 A1 WO 2023173677A1
Authority
WO
WIPO (PCT)
Prior art keywords
trajectory
fusion
cartesian
motion information
space
Prior art date
Application number
PCT/CN2022/113053
Other languages
English (en)
Chinese (zh)
Inventor
杨跞
杨锋
汪宇星
李法设
Original Assignee
中科新松有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 中科新松有限公司 filed Critical 中科新松有限公司
Publication of WO2023173677A1 publication Critical patent/WO2023173677A1/fr

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning

Definitions

  • This application relates to the field of robot motion control technology, for example, to a trajectory fusion method, device, equipment and storage medium.
  • This application provides a trajectory fusion method, device, equipment and storage medium to improve the stability of the robot's operation when passing through the transition point between two trajectories.
  • the second trajectory and the first fusion radius determine the Cartesian motion information of the fusion end point in the Cartesian space; the space where the first trajectory is located and the space where the second trajectory is located are different;
  • a trajectory fusion device including:
  • the fusion segment trajectory planning module is configured to perform trajectory planning on the fusion segment between the first trajectory and the second trajectory based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point.
  • an electronic device including:
  • the memory stores a computer program that can be executed by the at least one processor, and the computer program is executed by the at least one processor, so that the at least one processor can execute the method described in any embodiment of the present application. Trajectory fusion method.
  • Figure 1b is a schematic diagram of Cartesian motion information for determining the starting point of fusion provided according to an embodiment of the present application
  • Figure 1c is a schematic diagram of Cartesian motion information for determining the fusion endpoint provided according to an embodiment of the present application
  • Figure 3 is a flow chart of a trajectory fusion method provided according to another embodiment of the present application.
  • Figure 4 is a flow chart of a trajectory fusion method provided according to another embodiment of the present application.
  • Figure 1a is a flow chart of a trajectory fusion method provided by an embodiment of the present application. This embodiment can be applied to trajectory fusion of trajectories in different spaces. This method can be executed by a trajectory fusion device.
  • the trajectory fusion device It can be implemented in the form of hardware and/or software, and the trajectory fusion device can be configured in a variety of general computing devices. As shown in Figure 1a, the method includes:
  • the user In order to control the robot to move along the trajectory desired by the user, the user needs to input one or more trajectories in advance to form a trajectory pool.
  • the trajectory planner will sequentially take out trajectories from the trajectory pool for speed planning according to the trajectory execution sequence, so that the robot moves along the trajectory pre-inputted by the user.
  • the robot needs to move along multiple trajectories in sequence.
  • the speed or acceleration In the transition section between the two trajectories, the speed or acceleration is prone to be unstable, which in turn causes the path of the transition section to be non-unique and affects The robot works normally.
  • the first trajectory is the trajectory that the robot needs to run input by the user.
  • the fusion radius associated with the first trajectory is used to determine the fusion segment between the first trajectory and a subsequent trajectory (second trajectory) adjacent to the first trajectory.
  • Cartesian motion information refers to posture, velocity and acceleration information in Cartesian space.
  • the motion information can be uniformly mapped to the Cartesian space to achieve trajectory fusion in different spaces.
  • the trajectory planner will perform motion planning on the first trajectory, and at the same time determine whether the trajectory pool contains the first fusion radius associated with the first trajectory. If the trajectory pool does not contain the first fusion radius associated with the first trajectory, it means that the first trajectory does not need to be fused with other trajectories and only needs to continue motion planning for the first trajectory.
  • the Cartesian motion information of the fusion starting point in the Cartesian space can be determined directly based on the first trajectory and the first fusion radius associated with the first trajectory, where, Cartesian motion information is the fusion of the position, velocity and acceleration information of the starting point in Cartesian space.
  • the joint motion information of the fusion starting point in the joint space can be determined in the first trajectory based on the first trajectory and the first fusion radius associated with the first trajectory, where the joint
  • the motion information is the pose, velocity and acceleration information of the fusion starting point in the joint space.
  • a set number of first trajectory points are obtained on both sides of the fusion starting point in the first trajectory, the fusion starting point and the acquired first trajectory points are mapped to Cartesian space, and The fusion starting point and the first trajectory point mapped to the Cartesian space are fitted with a spline curve to obtain a fitting curve in the Cartesian space.
  • Cartesian motion information of the fusion starting point in Cartesian space is determined, where the Cartesian motion information includes the posture, velocity and acceleration of the Cartesian space.
  • spline curve fitting can include but is not limited to quintic spline, B-spline, non-uniform relational B-spline (Non Uniform Relational B Spline, NURBS), etc.
  • the starting point of the first trajectory is A and the end point is B.
  • the second trajectory is the subsequent trajectory connected to the first trajectory, that is, after the robot finishes moving along the first trajectory, it enters the second trajectory and continues to move along the second trajectory.
  • the space where the first trajectory is located is different from the space where the second trajectory is located.
  • the first trajectory is a joint trajectory in joint space
  • the second trajectory is a Cartesian trajectory in Cartesian space.
  • the first trajectory is a Cartesian trajectory in Cartesian space
  • the second trajectory is in joint space. joint trajectories.
  • the next trajectory adjacent to the first trajectory can be obtained from the trajectory pool. That is the second trajectory.
  • Cartesian motion information of the fusion end point in Cartesian space is determined on the second trajectory based on the second trajectory and the first fusion radius.
  • Cartesian motion information of the fusion endpoint in Cartesian space is determined, where the Cartesian motion information includes the posture, velocity and acceleration of the Cartesian space.
  • spline curve fitting can include quintic spline, B-spline, and Non-Uniform Relational B-Spline (NURBS), etc.
  • the starting point of the second trajectory is B and the end point is C.
  • the Cartesian motion information of the fusion end point Y in the Cartesian space is determined directly based on the first fusion radius.
  • the starting point of the second trajectory is the end point B of the first trajectory, and the end point of the second trajectory is C.
  • the second trajectory is a joint trajectory in the joint space
  • second trajectory points M2, N2, P2, and Q2 are respectively determined on both sides of the fusion endpoint in the second trajectory.
  • the fusion end point Y and the second trajectory points M2, N2, P2 and Q2 can be mapped to the Cartesian space, and the above trajectory points mapped to the Cartesian space can be fitted with a spline curve to obtain a fitting of the Cartesian space. curve. Finally, and the obtained fitting curve, the Cartesian motion information of the fusion end point Y in Cartesian space is determined.
  • the planning of the first trajectory can be continued with the currently planned trajectory point in the first trajectory as the starting point and the fusion starting point as the end point.
  • the planning of the first trajectory that is, when the planning has reached the fusion section of the first trajectory and the second trajectory, you can continue to use the currently planned trajectory point (in the fusion section) as the starting point and the fusion end point as the end point, Carry out trajectory planning for the fusion segment until the trajectory planning for the fusion segment is completed.
  • trajectory planning of the second trajectory can be continued to achieve a smooth transition of the robot between the first trajectory and the second trajectory.
  • the technical solution of the embodiment of the present application determines the Cartesian motion information of the fusion starting point in Cartesian space based on the first trajectory and the first fusion radius associated with the first trajectory, and then determines the fusion end point based on the second trajectory and the first fusion radius.
  • the Cartesian motion information in Cartesian space is finally based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point, and the trajectory planning of the fusion segment between the first trajectory and the second trajectory is performed by combining the fusion starting point and the Cartesian motion information.
  • the fusion endpoints are all mapped to Cartesian space, which avoids the inability to smoothly transition trajectories in different spaces and improves the stability of the robot's operation when passing through the transition point between two trajectories.
  • Figure 2 is a flow chart of a trajectory fusion method provided by another embodiment of the present application. Based on the above embodiment, it is further refined and provides a method to determine the fusion based on the first trajectory and the first fusion radius associated with the first trajectory. Steps of Cartesian motion information starting in Cartesian space.
  • a trajectory fusion method provided by the embodiment of the present application will be described below with reference to Figure 2, including the following:
  • the joint motion information of the fusion starting point in the joint space is first determined based on the first trajectory and the first fusion radius associated with the first trajectory. Wherein, the fusion starting point is located on the first trajectory, and the straight-line distance between the fusion starting point and the first trajectory is equal to the first fusion radius.
  • the joint motion information of the fusion starting point includes the pose, velocity and acceleration information of the fusion starting point in the joint space.
  • the Cartesian motion information of the fusion starting point in the Cartesian space is obtained. First, with the fusion starting point as the center, select the first trajectory points of the set data on both sides of the fusion starting point in the first trajectory.
  • the starting point of the first trajectory is A and the end point is B
  • the fusion starting point is the trajectory point X located on the first trajectory and close to the end point B.
  • five trajectory points are obtained along the XA direction and the XB direction in the first trajectory as the first trajectory points.
  • the fusion starting point and a set number of first trajectory points are mapped to the Cartesian space to obtain the pose of the trajectory points in the Cartesian space. For example, perform spline fitting on the fusion starting point and the first trajectory point mapped to Cartesian space to obtain a fitting curve in Cartesian space.
  • map the first trajectory point and the fusion starting point are fitted to obtain a fitting curve in Cartesian space.
  • the Cartesian motion information includes the posture, velocity and acceleration of the Cartesian space.
  • the Cartesian motion information of the fusion starting point in the Cartesian space is determined. For example, based on the fitting curve, the velocity and acceleration information of the fusion starting point in the Cartesian space can be calculated. At this point, the pose, velocity and acceleration information of the fusion starting point in Cartesian space have been obtained.
  • the interpolation period in the trajectory planning process is adjusted based on the speed control information input by the user.
  • the trajectory planning process when the trajectory planning process enters the fusion section of the first trajectory and the second trajectory, if the speed control information input by the user is received, the trajectory of the fusion section may be deformed due to changes in speed.
  • the interpolation period during the trajectory planning process of the fusion segment needs to be adjusted based on the speed control information input by the user to ensure path consistency. For example, during the fusion segment trajectory planning process, the user adjusts the robot movement speed from 100% to 10%. At this time, the interpolation period can be adjusted to 1/10 of the original interpolation period.
  • adjusting the interpolation period in the trajectory planning process based on the speed control information input by the user includes:
  • At least one of the nonlinear interpolation algorithm, the proportional integral differential PID algorithm and the mean filter algorithm is used to adjust the interpolation period of the trajectory planning process.
  • a method of adjusting the interpolation period in the trajectory planning process based on the speed control information input by the user is provided: based on the speed control information input by the user, a nonlinear interpolation algorithm, a PID algorithm or a mean filter algorithm is used to adjust The interpolation period of the trajectory planning process is to ensure that the consistency of the fusion segment trajectory is maintained when the user adjusts the speed.
  • the user adjusts the robot movement speed from 100% to 10%.
  • the interpolation period can be adjusted to 1/10 of the original interpolation period through the PID algorithm.
  • the technical solution of the embodiment of the present application is to obtain the fitting curve of the fusion starting point in Cartesian space through spline curve fitting when the space where the first trajectory is located is joint space, and obtain the motion of the fusion end point in Cartesian space.
  • information performing trajectory planning on the fusion segment between the first trajectory and the second trajectory based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point.
  • the joint trajectories are mapped to Cartesian space through spline curve fitting, allowing the robot to fuse trajectories in different spaces.
  • the trajectory planning process the trajectory is adjusted based on the speed control information input by the user.
  • the interpolation cycle in the planning process can avoid path changes caused by speed adjustment.
  • Figure 3 is a flow chart of a trajectory fusion method provided by another embodiment of the present application. Based on the above embodiment, it is further refined to provide trajectory planning for the fusion segment between the first trajectory and the second trajectory. Previously and based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point, the step of trajectory planning is performed on the fusion segment between the first trajectory and the second trajectory.
  • a trajectory fusion method provided by the embodiment of the present application will be described below with reference to Figure 3, including the following:
  • pre-planning of the fusion road section can be performed after obtaining the Cartesian motion information of the fusion start point and the fusion end point. , to obtain the velocity and acceleration of multiple fusion trajectory points in the fusion segment.
  • Pre-forward planning means that before actually planning the trajectory of the fusion segment, in order to avoid speed exceeding the limit in direct motion planning, a trajectory planning is performed first. For example, if the first trajectory and/or the second trajectory belong to joint trajectories in joint space, you can use a fifth degree polynomial for pre-forward planning; if the first trajectory and the second trajectory do not involve joint space, they are both in Cartesian space. For Cartesian trajectories, you can use online trajectory planning (On-Line Trajectory Generation, OTG) trajectory planning or S-shaped trajectory planning for pre-forward planning.
  • OTG On-Line Trajectory Generation
  • the speed scaling factor is used to scale the speed during the actual trajectory fusion process to avoid speed exceeding the limit.
  • the speed scaling can be determined based on the speed and acceleration. factor.
  • the velocity threshold is Vmax and the acceleration threshold is Amax.
  • the speed v of one or more fusion trajectory points is greater than Vmax, which is called an overspeed trajectory point.
  • the difference between the speed v and Vmax of multiple overspeed trajectory points can be calculated separately, and based on the difference The value determines the speed scaling factor. For example, the difference values corresponding to multiple speeding trajectory points can be obtained, and the speed scaling factor can be calculated based on the maximum difference value.
  • S350 Perform trajectory planning for the fusion segment between the first trajectory and the second trajectory based on the Cartesian motion information of the fusion starting point, the Cartesian motion information of the fusion end point, and the speed scaling factor.
  • trajectory planning is performed on the fusion segment between the first trajectory and the second trajectory based on the Cartesian motion information of the fusion starting point, the Cartesian motion information of the fusion end point, and the speed scaling factor.
  • the planned trajectory point speed can be multiplied by the speed scaling factor to avoid robot task execution failure due to speed exceeding the limit.
  • trajectory planning for the fusion segment between the first trajectory and the second trajectory includes: when at least one of the first trajectory and the second trajectory is located in a joint space, using a polynomial to calculate the sum of the first trajectory and the second trajectory.
  • the fusion segment between the second trajectories is used for trajectory planning.
  • a method of trajectory planning for the fusion segment between the first trajectory and the second trajectory is provided: when the space where at least one of the first trajectory and the second trajectory is located is the joint space, A polynomial is used to perform trajectory planning on the fusion segment between the first trajectory and the second trajectory. As an example, a fifth-order polynomial is used for trajectory planning.
  • trajectory planning for the fusion segment between the first trajectory and the second trajectory also includes: when the spaces where the first trajectory and the second trajectory are located are both Cartesian spaces, using online trajectory planning OTG to map the first trajectory Trajectory planning is performed on the fusion segment between the second trajectory and the second trajectory.
  • a method of trajectory planning for the fusion segment between the first trajectory and the second trajectory is provided: when the spaces where the first trajectory and the second trajectory are located are both Cartesian spaces, OTG is used to Trajectory planning is performed on the fusion segment between the first trajectory and the second trajectory.
  • the technical solution of the embodiment of the present application first performs forward planning on the fusion path based on the Cartesian motion information of the fusion starting point and the fusion end point, determines the speed and acceleration of multiple fusion trajectory points in the fusion segment, and then fuses the Cartesian motion information of the starting point. , fuse the Cartesian motion information of the end point and the speed scaling factor, and perform trajectory planning for the fusion segment between the first trajectory and the second trajectory, which can avoid excessive speed in the fusion segment and improve the stability of the robot's motion.
  • Figure 4 is a flow chart of a trajectory fusion method provided by another embodiment of the present application.
  • the specific trajectory planning process includes the following:
  • S402. Determine whether the first trajectory is associated with the first fusion radius. Based on the determination result that the first trajectory is associated with the first fusion radius, execute S403. Based on the determination result that the first trajectory is not associated with the first fusion radius, continue to execute the The first trajectory performs trajectory planning operations.
  • S404 Determine whether the first trajectory is in the joint space. Based on the determination result that the first trajectory is in the joint space, execute S405. Based on the determination result that the first trajectory is not in the joint space, execute S406.
  • S407. Determine whether the first trajectory is more than half planned. Based on the determination result that the first trajectory is more than half planned, execute S408. Based on the determination result that the first trajectory is not planned more than half way, continue to perform the operation of determining whether the first trajectory is more than half planned.
  • S408 Obtain the second trajectory from the trajectory pool, and calculate the motion information of the fusion end point according to the second trajectory and the first fusion radius.
  • S409 Determine whether the second trajectory is in the joint space. Based on the determination result that the second trajectory is in the joint space, execute S410. Based on the determination result that the second trajectory is not in the joint space, execute S411.
  • S416 Determine whether S415 is executed successfully. Based on the judgment result that S415 is executed successfully, execute S417. Based on the judgment result that S415 is not executed successfully, cancel the trajectory fusion.
  • S418 Determine whether to enter the fusion segment. Based on the judgment result of entering the fusion segment, execute S419. Based on the judgment result of not entering the fusion segment, continue to execute S417.
  • the technical solution of the embodiment of the present application determines the Cartesian motion information of the fusion starting point in Cartesian space based on the first trajectory and the first fusion radius associated with the first trajectory, and then determines the fusion end point based on the second trajectory and the first fusion radius.
  • the Cartesian motion information in Cartesian space is finally based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point, and the trajectory planning of the fusion segment between the first trajectory and the second trajectory is performed by combining the fusion starting point and the Cartesian motion information.
  • the fusion endpoints are all mapped to Cartesian space, which avoids the inability to smoothly transition trajectories in different spaces and improves the stability of the robot's operation when passing through the transition point between two trajectories.
  • FIG. 5 is a schematic structural diagram of a trajectory fusion device provided by an embodiment of the present application. This embodiment can be applied to the case of trajectory fusion of robot trajectories, especially to the case of trajectory fusion of trajectories in different spaces.
  • the trajectory fusion device can be implemented in the form of hardware and/or software, and can be integrated into an electronic device carrying the trajectory fusion function, such as a server. As shown in Figure 5, the device includes:
  • the first motion information determination module 510 is configured to determine the Cartesian motion information with the fusion starting point in Cartesian space based on the first trajectory and the first fusion radius associated with the first trajectory;
  • the second motion information determination module 520 is configured to determine the Cartesian motion information of the fusion end point in Cartesian space based on the second trajectory and the first fusion radius; the space where the first trajectory is located is different from the space where the second trajectory is located;
  • the fusion segment trajectory planning module 530 is configured to perform trajectory planning on the fusion segment between the first trajectory and the second trajectory based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point.
  • the technical solution of the embodiment of the present application determines the Cartesian motion information of the fusion starting point in Cartesian space based on the first trajectory and the first fusion radius associated with the first trajectory, and then determines the fusion end point based on the second trajectory and the first fusion radius.
  • the Cartesian motion information in Cartesian space is finally based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point, and the trajectory planning of the fusion segment between the first trajectory and the second trajectory is performed by combining the fusion starting point and the Cartesian motion information.
  • the fusion endpoints are all mapped to Cartesian space, which avoids the inability to smoothly transition trajectories in different spaces and improves the stability of the robot's operation when passing through the transition point between two trajectories.
  • the first motion information determination module 510 is set to:
  • the space where the first trajectory is located is a joint space
  • the Cartesian motion information of the fusion starting point in the Cartesian space is determined; the Cartesian motion information includes the posture, velocity and acceleration of the Cartesian space.
  • trajectory fusion devices also include:
  • a pre-forward planning module is configured to perform pre-forward planning on the fusion road section based on the Cartesian motion information of the fusion starting point and the Cartesian motion information of the fusion end point, and determine the location of multiple fusion trajectory points in the fusion section. speed and acceleration;
  • a speed scaling factor determination module configured to determine speed scaling based on the speed and acceleration when the speed of at least one fused trajectory point in the fusion segment reaches a speed threshold and/or the acceleration of at least one trajectory point reaches an acceleration threshold. factor;
  • the fusion segment trajectory planning module 530 is set to:
  • Trajectory planning is performed on the fusion segment between the first trajectory and the second trajectory based on the Cartesian motion information of the fusion starting point, the Cartesian motion information of the fusion end point, and the speed scaling factor.
  • trajectory fusion devices also include:
  • the interpolation cycle adjustment module is set to adjust the interpolation cycle during the trajectory planning process based on the speed control information input by the user.
  • the interpolation cycle adjustment module is set to:
  • At least one of the nonlinear interpolation algorithm, the proportional integral differential PID algorithm and the mean filter algorithm is used to adjust the interpolation period of the trajectory planning process.
  • the fusion segment trajectory planning module 530 is also set to:
  • a polynomial is used to perform trajectory planning on the fusion segment between the first trajectory and the second trajectory.
  • the fusion segment trajectory planning module 530 is also set to:
  • online trajectory planning OTG is used to perform trajectory planning on the fusion section between the first trajectory and the second trajectory.
  • the trajectory fusion device provided by the embodiments of this application can execute the trajectory fusion method provided by any embodiment of this application, and has functional modules and beneficial effects corresponding to the execution method.
  • FIG. 6 shows a schematic structural diagram of an electronic device 10 that can be used to implement embodiments of the present application.
  • Electronic devices are intended to refer to various forms of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, mainframe computers, and other suitable computers.
  • Electronic devices may also represent various forms of mobile devices, such as personal digital assistants, cellular phones, smart phones, wearable devices (eg, helmets, glasses, watches, etc.), and other similar computing devices.
  • the components shown herein, their connections and relationships, and their functions are examples only and are not intended to limit the implementation of the present application as described and/or claimed herein.
  • the electronic device 10 includes at least one processor 11, and a memory communicatively connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores There is a computer program that can be executed by at least one processor.
  • the processor 11 can perform the operation according to the computer program stored in the read-only memory (ROM) 12 or loaded from the storage unit 18 into the random access memory (RAM) 13. Performs a variety of appropriate actions and processes.
  • RAM 13 various programs and data required for the operation of the electronic device 10 can also be stored.
  • the processor 11, the ROM 12 and the RAM 13 are connected to each other via the bus 14.
  • An input/output (I/O) interface 15 is also connected to bus 14 .
  • the I/O interface 15 Multiple components in the electronic device 10 are connected to the I/O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a magnetic disk, an optical disk, etc. etc.; and communication unit 19, such as network card, modem, wireless communication transceiver, etc.
  • the communication unit 19 allows the electronic device 10 to exchange information/data with other devices through a computer network such as the Internet and/or various telecommunications networks.
  • Processor 11 may be a variety of general and/or special purpose processing components having processing and computing capabilities. Some examples of processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various specialized artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, digital signal processing processor (DSP), and any appropriate processor, controller, microcontroller, etc.
  • CPU central processing unit
  • GPU graphics processing unit
  • AI artificial intelligence
  • DSP digital signal processing processor
  • the processor 11 performs a plurality of methods and processes described above, such as trajectory fusion methods.
  • the trajectory fusion method may be implemented as a computer program, which is tangibly embodied in a computer-readable storage medium, such as the storage unit 18 .
  • part or all of the computer program may be loaded and/or installed onto the electronic device 10 via the ROM 12 and/or the communication unit 19.
  • the processor 11 may be configured to perform the trajectory fusion method in any other suitable manner (eg, by means of firmware).
  • Various implementations of the systems and techniques described above may be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), systems on a chip implemented in a system (SOC), complex programmable logic device (CPLD), computer hardware, firmware, software, and/or combinations thereof.
  • FPGAs field programmable gate arrays
  • ASICs application specific integrated circuits
  • ASSPs application specific standard products
  • SOC system
  • CPLD complex programmable logic device
  • computer hardware firmware, software, and/or combinations thereof.
  • These various embodiments may include implementation in one or more computer programs executable and/or interpreted on a programmable system including at least one programmable processor, the programmable processor
  • the processor which may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
  • An output device may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
  • An output device may be a special purpose or general purpose programmable processor, may receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
  • Computer programs for implementing the methods of the present application may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, such that the computer program, when executed by the processor, causes the functions/operations specified in the flowcharts and/or block diagrams to be implemented.
  • a computer program may execute entirely on the machine, partly on the machine, as a stand-alone software package, partly on the machine and partly on a remote machine or entirely on the remote machine or server.
  • a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in connection with an instruction execution system, apparatus, or device.
  • Computer-readable storage media may include, but are not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or devices, or any suitable combination of the foregoing.
  • the computer-readable storage medium may be a machine-readable signal medium.
  • machine-readable storage media would include one or more wire-based electrical connections, laptop disks, hard drives, random access memory (RAM), read only memory (ROM), erasable programmable read only memory (EPROM or flash memory), optical fiber, portable compact disk read-only memory (CD-ROM), optical storage device, magnetic storage device, or any suitable combination of the above.
  • RAM random access memory
  • ROM read only memory
  • EPROM or flash memory erasable programmable read only memory
  • CD-ROM portable compact disk read-only memory
  • magnetic storage device or any suitable combination of the above.
  • the systems and techniques described herein may be implemented on an electronic device having a display device (eg, a CRT (cathode ray tube) or LCD (liquid crystal display)) for displaying information to the user monitor); and a keyboard and pointing device (e.g., a mouse or a trackball) through which a user can provide input to the electronic device.
  • a display device eg, a CRT (cathode ray tube) or LCD (liquid crystal display)
  • a keyboard and pointing device e.g., a mouse or a trackball
  • Other kinds of devices may also be used to provide interaction with the user; for example, the feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and may be provided in any form, including Acoustic input, voice input or tactile input) to receive input from the user.
  • the systems and techniques described herein may be implemented in a computing system that includes back-end components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes front-end components (e.g., A user's computer having a graphical user interface or web browser through which the user can interact with implementations of the systems and technologies described herein), or including such backend components, middleware components, or any combination of front-end components in a computing system.
  • the components of the system may be interconnected by any form or medium of digital data communication (eg, a communications network). Examples of communication networks include: local area network (LAN), wide area network (WAN), blockchain network, and the Internet.
  • Computing systems may include clients and servers.
  • Clients and servers are generally remote from each other and typically interact over a communications network.
  • the relationship of client and server is created by computer programs running on corresponding computers and having a client-server relationship with each other.
  • the server can be a cloud server, also known as a cloud computing server or cloud host. It is a host product in the cloud computing service system, which avoids the difficult management and weak business scalability of traditional physical hosts and VPS services. Condition.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

La présente invention concerne un procédé et un appareil de fusion de trajectoires, ainsi qu'un dispositif et un support de stockage. Le procédé consiste à : selon une première trajectoire et un premier rayon de fusion associé à la première trajectoire, déterminer des informations de mouvement cartésien d'un point de départ de fusion dans un espace cartésien ; selon une seconde trajectoire et le premier rayon de fusion, déterminer des informations de mouvement cartésien d'un point final de fusion dans l'espace cartésien, un espace où se trouve la première trajectoire étant différent d'un espace où se trouve la seconde trajectoire ; et, sur la base des informations de mouvement cartésien du point de départ de fusion et des informations de mouvement cartésien du point final de fusion, effectuer une planification de trajectoire sur une section de fusion entre la première trajectoire et la seconde trajectoire.
PCT/CN2022/113053 2022-03-18 2022-08-17 Procédé et appareil de fusion de trajectoires, et dispositif et support de stockage WO2023173677A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202210270671.4A CN114474072B (zh) 2022-03-18 2022-03-18 一种轨迹融合方法、装置、设备及存储介质
CN202210270671.4 2022-03-18

Publications (1)

Publication Number Publication Date
WO2023173677A1 true WO2023173677A1 (fr) 2023-09-21

Family

ID=81486159

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/113053 WO2023173677A1 (fr) 2022-03-18 2022-08-17 Procédé et appareil de fusion de trajectoires, et dispositif et support de stockage

Country Status (2)

Country Link
CN (1) CN114474072B (fr)
WO (1) WO2023173677A1 (fr)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114474072B (zh) * 2022-03-18 2023-07-04 中科新松有限公司 一种轨迹融合方法、装置、设备及存储介质
CN116512237B (zh) * 2022-11-28 2023-09-19 广东建石科技有限公司 工业机器人视觉伺服方法、装置、电子设备及存储介质

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105500354A (zh) * 2016-02-02 2016-04-20 南京埃斯顿机器人工程有限公司 一种工业机器人应用的过渡轨迹规划方法
CN106313047A (zh) * 2016-09-28 2017-01-11 华中科技大学 一种基于Bezier样条的机器人实时拐角过渡方法
US20210339390A1 (en) * 2020-05-04 2021-11-04 X Development Llc Trajectory planning for path-based applications
CN113741336A (zh) * 2021-09-10 2021-12-03 上海景吾智能科技有限公司 基于实时运动的笛卡尔空间轨迹规划方法和系统
CN114131612A (zh) * 2021-12-20 2022-03-04 中国科学院长春光学精密机械与物理研究所 基于nurbs曲线插补算法的冗余机械臂实时前瞻轨迹规划方法
CN114474072A (zh) * 2022-03-18 2022-05-13 中科新松有限公司 一种轨迹融合方法、装置、设备及存储介质

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100743143B1 (ko) * 2005-08-30 2007-07-27 주식회사 로보스타 로봇의 연속 모션 처리를 위한 연결경로 계획 장치
CN102091879B (zh) * 2011-01-04 2012-12-05 长沙红点自动化科技有限公司 一种焊接机器人过渡轨迹规划方法
DE102015109708B3 (de) * 2015-06-17 2016-01-21 Uwe Simon Verfahren zur Steuerung des Bewegungsablaufs einer motorisch angetriebenen Maschinen- oder Werkzeugkomponente
CN112077851B (zh) * 2020-09-17 2021-06-25 南京埃斯顿自动化股份有限公司 一种基于混合空间的工业机器人过渡轨迹规划方法
CN113442142B (zh) * 2021-07-14 2022-08-23 杭州泛海科技有限公司 六轴串联工业机器人的笛卡尔空间运动轨迹的平滑方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105500354A (zh) * 2016-02-02 2016-04-20 南京埃斯顿机器人工程有限公司 一种工业机器人应用的过渡轨迹规划方法
CN106313047A (zh) * 2016-09-28 2017-01-11 华中科技大学 一种基于Bezier样条的机器人实时拐角过渡方法
US20210339390A1 (en) * 2020-05-04 2021-11-04 X Development Llc Trajectory planning for path-based applications
CN113741336A (zh) * 2021-09-10 2021-12-03 上海景吾智能科技有限公司 基于实时运动的笛卡尔空间轨迹规划方法和系统
CN114131612A (zh) * 2021-12-20 2022-03-04 中国科学院长春光学精密机械与物理研究所 基于nurbs曲线插补算法的冗余机械臂实时前瞻轨迹规划方法
CN114474072A (zh) * 2022-03-18 2022-05-13 中科新松有限公司 一种轨迹融合方法、装置、设备及存储介质

Also Published As

Publication number Publication date
CN114474072A (zh) 2022-05-13
CN114474072B (zh) 2023-07-04

Similar Documents

Publication Publication Date Title
WO2023173677A1 (fr) Procédé et appareil de fusion de trajectoires, et dispositif et support de stockage
WO2022198994A1 (fr) Procédé et appareil de planification de mouvement de bras robotisé, ainsi que support de stockage lisible et bras robotisé
EP3822857A1 (fr) Procédé de poursuite de cible, dispositif, appareil électronique et support de mémoire
CN113223113B (zh) 车道线处理方法、装置、电子设备和云控平台
JP2021177191A (ja) レーダー校正方法、装置、電子デバイス、記憶媒体、プログラム、及び路側機
CN112927328A (zh) 表情迁移方法、装置、电子设备及存储介质
WO2023221963A1 (fr) Procédé et appareil de détermination d'erreur suivante, dispositif, et support de stockage
CN114987546A (zh) 轨迹预测模型的训练方法、装置、设备及存储介质
CN115344753A (zh) 联邦图计算方法、联邦图计算配置方法、装置及电子设备
JP6290029B2 (ja) 生産制御支援装置、生産制御支援方法およびプログラム
CN117261880A (zh) 一种车辆控制方法、装置、设备以及存储介质
WO2024016892A1 (fr) Procédé et appareil d'étalonnage de paramètres externes de capteurs, et dispositif électronique
WO2023241556A1 (fr) Procédé et appareil de commande de stationnement, et dispositif et support de stockage
CN112541464A (zh) 关联道路对象的确定方法、装置、路侧设备和云控平台
US20230123671A1 (en) Localization and mapping
CN116533990A (zh) 一种车辆控制方法、装置、电子设备和存储介质
CN114792125A (zh) 基于分布式训练的数据处理方法、装置、电子设备和介质
CN114274148B (zh) 一种轨迹规划方法、装置、电子设备以及存储介质
WO2021253666A1 (fr) Procédé, appareil et dispositif de visualisation de données de champ de flux, et support de stockage
CN114771518B (zh) 一种车道中心指引线的生成方法、装置、电子设备及介质
CN114954654B (zh) 车辆的方向盘零偏补偿角的计算方法、控制方法及装置
CN115056847B (zh) 车辆的方向盘零偏补偿角的计算方法、控制方法及装置
RU2756437C1 (ru) Способ и система планирования движения робота-манипулятора путем коррекции опорных траекторий
CN115586773B (zh) 移动机器人的路径规划方法、装置、设备和介质
CN116679573B (zh) 一种一致性跟踪控制方法、装置、电子设备及存储介质

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22931699

Country of ref document: EP

Kind code of ref document: A1