WO2023000529A1 - Robot motion analysis method and device, readable storage medium, and robot - Google Patents

Robot motion analysis method and device, readable storage medium, and robot Download PDF

Info

Publication number
WO2023000529A1
WO2023000529A1 PCT/CN2021/126737 CN2021126737W WO2023000529A1 WO 2023000529 A1 WO2023000529 A1 WO 2023000529A1 CN 2021126737 W CN2021126737 W CN 2021126737W WO 2023000529 A1 WO2023000529 A1 WO 2023000529A1
Authority
WO
WIPO (PCT)
Prior art keywords
joint
training sample
model
training
robot
Prior art date
Application number
PCT/CN2021/126737
Other languages
French (fr)
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 WO2023000529A1 publication Critical patent/WO2023000529A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/163Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control

Definitions

  • the present application belongs to the technical field of robots, and in particular relates to a robot motion analysis method, device, computer readable storage medium and robot.
  • a key point in the research of humanoid robots is the control problem of parallel configurations.
  • the analytical solution of inverse kinematics can be directly derived relatively easily through geometry or DH method, but the normal Kinematics is generally calculated by numerical method, based on the Jacobian matrix, iteratively approximated by the Newton-Raphson method, and the computational complexity is relatively high.
  • embodiments of the present application provide a robot motion analysis method, device, computer-readable storage medium, and robot to solve the problem of high computational complexity in the existing forward kinematics analysis process.
  • the first aspect of the embodiment of the present application provides a robot motion analysis method, which may include:
  • the forward kinematics analysis model is the first training set by the preset
  • the deep learning model obtained by training the sample set, and the first training sample set is a set constructed according to the inverse kinematics analysis process.
  • the robot motion analysis method may further include:
  • the inverse dynamics analysis model is obtained by training a preset second training sample set A deep learning model, and the second training sample set is a set constructed according to a positive dynamics analysis process.
  • the robot motion analysis method may further include:
  • the first training sample set includes a first number of training samples, each training sample includes a set of series joint angles and corresponding parallel joint angles;
  • the first training sample set is used to train the deep learning model in the initial state, and the trained deep learning model is used as the forward kinematics analysis model.
  • the deep learning model may be a generation confrontation network model including a first generator and a first discriminator;
  • the training of the deep learning model of the initial state using the first training sample set may include:
  • the first discriminator is used to perform a model training process.
  • the robot motion analysis method may further include:
  • each movement trajectory point includes driving torque, joint velocity and joint acceleration;
  • the second training sample set includes a second number of training samples, each training sample includes a set of driving torque and corresponding joint motion parameters;
  • the joint motion parameters include joint angles, joint motion parameters velocity and joint acceleration;
  • the deep learning model in the initial state is trained by using the second training sample set, and the trained deep learning model is used as the inverse dynamics analysis model.
  • the deep learning model is a generation confrontation network model including a second generator and a second discriminator;
  • the training of the deep learning model of the initial state using the second training sample set may include:
  • the second discriminator is used to perform a model training process.
  • the processing of the first joint angle using a preset forward kinematics analysis model to obtain the second joint angle of the target joint in a serial configuration may include :
  • the first joint angle is input into the forward kinematics analysis model for processing, and the processed output of the forward kinematics analysis model is used as the second joint angle.
  • the second aspect of the embodiment of the present application provides a robot motion analysis device, which may include:
  • the first joint angle obtaining module is used to obtain the first joint angle of the target joint of the robot in the parallel configuration
  • a forward kinematics analysis module configured to use a preset forward kinematics analysis model to process the first joint angle to obtain a second joint angle of the target joint in a serial configuration;
  • the forward kinematics analysis model It is a deep learning model trained by a preset first training sample set, and the first training sample set is a set constructed according to an inverse kinematics analysis process.
  • the robot motion analysis device may further include:
  • a joint motion parameter acquisition module configured to acquire the joint motion parameters of the target joint
  • the inverse dynamics analysis module is used to use a preset inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint; the inverse dynamics analysis model is a preset
  • the second training sample set is a deep learning model obtained by training, and the second training sample set is a set constructed according to a positive dynamics analysis process.
  • the robot motion analysis device may further include:
  • a range of motion determination module configured to determine the range of motion of the target joint in a series configuration
  • a serial joint angle selection module configured to select a first number of serial joint angles in the range of motion
  • an inverse kinematics analysis module configured to calculate a parallel joint angle corresponding to each serial joint angle according to the inverse kinematics analysis process
  • the first training sample set construction module is used to construct the first training sample set;
  • the first training sample set includes a first number of training samples, and each training sample includes a set of series joint angles and corresponding parallel joint angles joint angle;
  • the forward kinematics analysis model training module is used to use the first training sample set to train the deep learning model in the initial state, and use the trained deep learning model as the forward kinematics analysis model.
  • the deep learning model is a generation confrontation network model including a first generator and a first discriminator;
  • the positive kinematics analysis model training module may include:
  • the first generator processing unit is configured to, for each training sample in the first training sample set, use the first generator to process the parallel joint angle of the sample to obtain a first generation result;
  • the first discriminator processing unit is configured to use the first discriminator to perform a model training process according to the first generation result of the sample and the series joint angle.
  • the robot motion analysis device may further include:
  • a movement track record acquisition module configured to acquire the movement track record of the target joint
  • a motion track point selection module configured to select a second number of motion track points in the motion track record, wherein each motion track point includes drive torque, joint velocity and joint acceleration;
  • a positive dynamics analysis module used to calculate joint angles corresponding to each motion track point according to the positive dynamics analysis process
  • the second training sample set construction module is used to construct the second training sample set;
  • the second training sample set includes a second number of training samples, and each training sample includes a set of driving torques and corresponding joint motions parameters; joint motion parameters include joint angle, joint velocity and joint acceleration;
  • the inverse dynamics analysis model training module is used to use the second training sample set to train the deep learning model in the initial state, and use the trained deep learning model as the inverse dynamics analysis model.
  • the deep learning model is a generation confrontation network model including a second generator and a second discriminator;
  • the inverse dynamics analysis model training module may include:
  • the second generator processing unit is configured to, for each training sample in the second training sample set, use the second generator to process the joint motion parameters of the sample to obtain a second generation result;
  • the second discriminator processing unit is configured to use the second discriminator to perform a model training process according to the second generation result of the sample and the driving torque.
  • the forward kinematics analysis module is specifically configured to input the first joint angle into the forward kinematics analysis model for processing, and convert the forward kinematics analysis model to The processed output is used as the second joint angle.
  • the third aspect of the embodiments of the present application provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of any one of the above robot motion analysis methods are implemented .
  • the fourth aspect of the embodiments of the present application provides a robot, including a memory, a processor, and a computer program stored in the memory and operable on the processor.
  • the processor executes the computer program, it realizes The steps of any one of the above robot motion analysis methods.
  • a fifth aspect of the embodiments of the present application provides a computer program product, which, when the computer program product is run on a robot, causes the robot to perform the steps of any one of the robot motion analysis methods described above.
  • the embodiment of the present application has the following beneficial effects: acquires the first joint angle of the target joint of the robot in the parallel configuration; uses the preset forward kinematics analysis model to analyze the first The joint angle is processed to obtain the second joint angle of the target joint in the series configuration; the forward kinematics analysis model is a deep learning model trained by the preset first training sample set, and the first The training sample set is a set constructed according to the inverse kinematics analysis process.
  • the forward kinematics analysis process is performed by using the deep learning model, which effectively reduces the computational complexity compared with the existing numerical calculation method.
  • Fig. 1 is the schematic diagram of the coordinate system used in the embodiment of the present application.
  • Fig. 2 is a corresponding relationship diagram between coordinate axes and directions of rotation
  • Fig. 3 is the schematic diagram of parallel mechanism
  • Fig. 4 is the schematic diagram of knee-ankle parallel mechanism
  • Fig. 5 is the schematic diagram of forward kinematics and inverse kinematics analysis process
  • Fig. 6 is a schematic diagram of generating an adversarial network model
  • Fig. 7 is a schematic flow chart of the construction process of the forward kinematics analysis model
  • Fig. 8 is a schematic flow chart of the forward kinematics analysis process
  • Fig. 9 is the schematic diagram of forward kinetics and inverse kinetics analysis process
  • Fig. 10 is a schematic flow chart of the construction process of the inverse dynamics analysis model
  • Figure 11 is a schematic flow chart of the inverse kinetic analysis process
  • FIG. 12 is a structural diagram of an embodiment of a robot motion analysis device in the embodiment of the present application.
  • Fig. 13 is a schematic block diagram of a robot in the embodiment of the present application.
  • the term “if” may be construed as “when” or “once” or “in response to determining” or “in response to detecting” depending on the context .
  • the phrase “if determined” or “if [the described condition or event] is detected” may be construed, depending on the context, to mean “once determined” or “in response to the determination” or “once detected [the described condition or event] ]” or “in response to detection of [described condition or event]”.
  • a global coordinate system ⁇ w as shown in FIG. 1 can be established first.
  • the forward direction of the robot is the x-axis
  • the lateral direction is the y-axis
  • the longitudinal direction is the z-axis.
  • Figure 2 shows the corresponding relationship between coordinate axes and rotation directions.
  • the direction of rotation around the x-axis is r x , which is recorded as the roll angle (roll angle);
  • the direction of rotation around the y-axis is r y , recorded as the pitch angle (pitch angle);
  • the direction of rotation around the z axis is r z , recorded as the yaw angle (yaw angle).
  • each leg of a robot may include a hip joint, a knee joint, and an ankle joint.
  • the hip joint H 1 of the left leg and the hip joint H 2 of the right leg have three degrees of freedom respectively, and can rotate around the x-axis, y-axis and z-axis of their local coordinate system through three rotating servos, respectively.
  • the knee joint K 1 of the leg and the knee joint K 2 of the right leg have one degree of freedom respectively, which can be rotated around the y-axis of their local coordinate system through a rotating servo, and the ankle joint A 1 of the left leg and the ankle joint A 2 of the right leg have two degrees of freedom respectively. degrees of freedom, and can be rotated around the x-axis and y-axis of its local coordinate system through two rotating steering gears.
  • a hip-knee parallel mechanism left figure or a knee-ankle parallel mechanism (right figure) can be set up as shown in Figure 3, where the numbers represent joint degrees of freedom, and the knee-ankle parallel mechanism is used in the following descriptions
  • the mechanism is taken as an example, and the situation of the hip-knee parallel mechanism is similar.
  • the hip and knee joints are the same as the series configuration, and a local coordinate system whose initial state is consistent with the global coordinate system is established at the ankle joint (O).
  • the joint angle in parallel configuration can be expressed as:
  • ⁇ 1 , ⁇ 2 , ⁇ 3 are the joint angles of the hip joint in three degrees of freedom
  • ⁇ 4 is the joint angle of the knee joint in one degree of freedom
  • ⁇ 5 , ⁇ 6 are the joint angles of the ankle joint in two degrees of freedom joint angle on .
  • q 1 , q 2 , q 3 are the joint angles of the hip joint in three degrees of freedom
  • q 4 are the joint angles of the knee joint in one degree of freedom
  • q 5 , q 6 are the joint angles of the ankle joint in two degrees of freedom joint angle on .
  • q can be calculated based on the waist position p torso , R torso and the foot position p foot , R foot .
  • the process of solving q 5 and q 6 according to ⁇ 5 and ⁇ 6 can be regarded as a forward kinematics analysis process, and the calculation of ⁇ 5 and ⁇ 6 according to q 5 and q 6 The process is analyzed as an inverse kinematics process.
  • the deep learning model can be used to carry out the forward kinematics analysis process.
  • the specific type of deep learning model can be set according to the actual situation.
  • Generative Adversarial Networks (GAN) is preferably used.
  • Model For the GAN model, given a batch of samples, a system can be trained to generate similar samples, which can solve the problem of insufficient training data.
  • Figure 6 is a schematic diagram of the generation confrontational network model, which can include a generator G and a discriminator D, where the generator G is used for training and learning from a low-dimensional latent vector z(z ⁇ p z (z) Independent and identical distribution), the mapping G(z) to the real data x; the discriminator D is used to train and learn to distinguish whether the data comes from the real data x(x ⁇ p data (x)) or the data G(z) generated by the generator;
  • the generation confrontation network model adjusts the generator G and the discriminator D through the optimization process, and its objective function is:
  • the construction process of the forward kinematics analysis model may include the following steps:
  • Step S701. Determine the range of motion of the target joint in the serial configuration.
  • the target joint as the ankle joint as an example, its range of motion can be recorded as: q 5 ⁇ [q 5min ,q 5max ], q 6 ⁇ [q 6min ,q 6max ], where, q 5min ,q 5max ,q 6min , q 6max are preset thresholds, and their specific values can be set according to actual conditions.
  • Step S702 selecting a first number of serial joint angles in the range of motion.
  • sampling different sampling methods can be adopted according to the actual situation, including but not limited to random sampling and uniform sampling.
  • Step S703 calculating the parallel joint angle corresponding to each series joint angle according to the inverse kinematics analysis process.
  • any inverse kinematics analysis method in the prior art can be selected according to the actual situation. No longer.
  • Step S704 constructing a first training sample set.
  • the first training sample set includes a first number of training samples, and each training sample includes a set of series joint angles and corresponding parallel joint angles.
  • Step S705 using the first training sample set to train the deep learning model in the initial state, and using the trained deep learning model as a forward kinematics analysis model.
  • the generation confrontation network model is preferably used, and the model may include a first generator and a first discriminator.
  • the first generator is used to process the parallel joint angle of the sample to obtain the first generated result, and then according to the first generated result of the sample and Connect the joint angles in series, use the first discriminator to carry out the model training process, and finally obtain the trained forward kinematics analysis model.
  • Step S801 acquiring the first joint angle of the target joint of the robot in the parallel configuration.
  • Step S802 using the forward kinematics analysis model to process the first joint angle to obtain the second joint angle of the target joint in the serial configuration.
  • the first joint angle may be input into the forward kinematics analysis model for processing, and the processed output of the forward kinematics analysis model may be used as the second joint angle.
  • the forward kinematics analysis process is performed by using the deep learning model, which effectively reduces the computational complexity compared with the existing numerical calculation method.
  • the drive torque ⁇ of the joint is regarded as a positive dynamics analysis process, which will be based on the joint angle ⁇ , joint velocity and joint acceleration
  • the process of solving the driving torque ⁇ of the joint is regarded as the inverse dynamics analysis process.
  • the inverse dynamics analysis process can be performed using a deep learning model.
  • the specific type of deep learning model can be set according to the actual situation.
  • the construction process of the inverse dynamics analysis model may include the following steps:
  • Step S1001. Obtain the motion track record of the target joint.
  • Step S1002 selecting a second number of motion track points in the motion track record.
  • each motion trajectory point includes driving torque, joint velocity and joint acceleration.
  • the specific value of the second number can be set according to the actual situation. Generally, in order to ensure the accuracy of the trained model, enough motion trajectory points should be collected as much as possible.
  • sampling different sampling methods can be adopted according to the actual situation, including but not limited to random sampling and uniform sampling.
  • Step S1003 calculating joint angles corresponding to each motion track point according to the forward dynamics analysis process.
  • any positive dynamics analysis method in the prior art may be selected according to the actual situation, which will not be described in this embodiment.
  • Step S1004 constructing a second training sample set.
  • the second training sample set includes a second number of training samples, and each training sample includes a set of driving torque and corresponding joint motion parameters, where the joint motion parameters include joint angle, joint velocity and joint acceleration.
  • Step S1005 use the second training sample set to train the deep learning model in the initial state, and use the trained deep learning model as an inverse dynamics analysis model.
  • the generation confrontation network model is preferred, and the model may include a second generator and a second discriminator.
  • the model may include a second generator and a second discriminator.
  • the training process for each training sample in the second training sample set, first use the second generator to process the joint motion parameters of the sample to obtain the second generation result, and then according to the second generation result of the sample and Drive torque, use the second discriminator to carry out the model training process, and finally get the trained inverse dynamics analysis model.
  • Step S1101 acquiring the joint motion parameters of the target joint.
  • Step S1102 using the inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint.
  • the joint motion parameters may be input into the inverse dynamics analysis model for processing, and the processed output of the inverse dynamics analysis model may be used as the driving torque.
  • the deep learning model is used to perform the inverse dynamics analysis process, which effectively reduces the computational complexity compared with the existing numerical calculation methods.
  • FIG. 12 shows a structural diagram of an embodiment of a robot motion analysis device provided in an embodiment of the present application.
  • a robot motion analysis device may include:
  • the first joint angle obtaining module 1201 is used to obtain the first joint angle of the target joint of the robot in the parallel configuration
  • the forward kinematics analysis module 1202 is configured to use a preset forward kinematics analysis model to process the first joint angle to obtain a second joint angle of the target joint in a serial configuration; the forward kinematics analysis
  • the model is a deep learning model trained from a preset first training sample set, and the first training sample set is a set constructed according to an inverse kinematics analysis process.
  • the robot motion analysis device may further include:
  • a joint motion parameter acquisition module configured to acquire the joint motion parameters of the target joint
  • the inverse dynamics analysis module is used to use a preset inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint; the inverse dynamics analysis model is a preset
  • the second training sample set is a deep learning model obtained by training, and the second training sample set is a set constructed according to a positive dynamics analysis process.
  • the robot motion analysis device may further include:
  • a range of motion determination module configured to determine the range of motion of the target joint in a series configuration
  • a serial joint angle selection module configured to select a first number of serial joint angles in the range of motion
  • an inverse kinematics analysis module configured to calculate a parallel joint angle corresponding to each serial joint angle according to the inverse kinematics analysis process
  • the first training sample set construction module is used to construct the first training sample set;
  • the first training sample set includes a first number of training samples, and each training sample includes a set of series joint angles and corresponding parallel joint angles joint angle;
  • the positive kinematics analysis model training module is used to use the first training sample set to train the deep learning model of the initial state, and use the trained deep learning model as the positive kinematics analysis model.
  • the deep learning model is a generative confrontation network model including a first generator and a first discriminator;
  • the positive kinematics analysis model training module may include:
  • the first generator processing unit is configured to, for each training sample in the first training sample set, use the first generator to process the parallel joint angle of the sample to obtain a first generation result;
  • the first discriminator processing unit is configured to use the first discriminator to perform a model training process according to the first generation result of the sample and the series joint angle.
  • the robot motion analysis device may further include:
  • a movement track record acquisition module configured to acquire the movement track record of the target joint
  • a motion track point selection module configured to select a second number of motion track points in the motion track record, wherein each motion track point includes drive torque, joint velocity and joint acceleration;
  • a positive dynamics analysis module used to calculate joint angles corresponding to each motion track point according to the positive dynamics analysis process
  • the second training sample set construction module is used to construct the second training sample set;
  • the second training sample set includes a second number of training samples, and each training sample includes a set of driving torques and corresponding joint motions parameters; joint motion parameters include joint angle, joint velocity and joint acceleration;
  • the inverse dynamics analysis model training module is used to use the second training sample set to train the deep learning model in the initial state, and use the trained deep learning model as the inverse dynamics analysis model.
  • the deep learning model is a generative confrontation network model including a second generator and a second discriminator;
  • the inverse dynamics analysis model training module may include:
  • the second generator processing unit is configured to, for each training sample in the second training sample set, use the second generator to process the joint motion parameters of the sample to obtain a second generation result;
  • the second discriminator processing unit is configured to use the second discriminator to perform a model training process according to the second generation result of the sample and the driving torque.
  • the forward kinematics analysis module is specifically configured to input the first joint angle into the forward kinematics analysis model for processing, and convert the forward kinematics analysis The output after model processing is used as the second joint angle.
  • FIG. 13 shows a schematic block diagram of a robot provided by the embodiment of the present application. For convenience of description, only parts related to the embodiment of the present application are shown.
  • the robot 13 of this embodiment includes: a processor 130 , a memory 131 , and a computer program 132 stored in the memory 131 and operable on the processor 130 .
  • the processor 130 executes the computer program 132, the steps in the above-mentioned embodiments of the robot motion analysis method are realized.
  • the processor 130 executes the computer program 132, the functions of the modules/units in the foregoing device embodiments are realized.
  • the computer program 132 can be divided into one or more modules/units, and the one or more modules/units are stored in the memory 131 and executed by the processor 130 to complete this application.
  • the one or more modules/units may be a series of computer program instruction segments capable of accomplishing specific functions, and the instruction segments are used to describe the execution process of the computer program 132 in the robot 13 .
  • FIG. 13 is only an example of the robot 13, and does not constitute a limitation to the robot 13. It may include more or less components than shown in the illustration, or combine certain components, or different components, such as The robot 13 may also include input and output devices, network access devices, buses, and the like.
  • the processor 130 can be a central processing unit (Central Processing Unit, CPU), and can also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC), Field-Programmable Gate Array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc.
  • a general-purpose processor may be a microprocessor, or the processor may be any conventional processor, or the like.
  • the storage 131 may be an internal storage unit of the robot 13 , such as a hard disk or memory of the robot 13 .
  • the memory 131 can also be an external storage device of the robot 13, such as a plug-in hard disk equipped on the robot 13, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, Flash card (Flash Card), etc. Further, the memory 131 may also include both an internal storage unit of the robot 13 and an external storage device.
  • the memory 131 is used to store the computer program and other programs and data required by the robot 13 .
  • the memory 131 can also be used to temporarily store data that has been output or will be output.
  • the disclosed devices/robots and methods may be implemented in other ways.
  • the device/robot embodiments described above are only illustrative.
  • the division of the modules or units is only a logical function division.
  • the mutual coupling or direct coupling or communication connection shown or discussed may be through some interfaces, and the indirect coupling or communication connection of devices or units may be in electrical, mechanical or other forms.
  • the units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place, or may be distributed to multiple network units. Part or all of the units can be selected according to actual needs to achieve the purpose of the solution of this embodiment.
  • each functional unit in each embodiment of the present application may be integrated into one processing unit, each unit may exist separately physically, or two or more units may be integrated into one unit.
  • the above-mentioned integrated units can be implemented in the form of hardware or in the form of software functional units.
  • the integrated module/unit is realized in the form of a software function unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, all or part of the processes in the methods of the above embodiments in the present application can also be completed by instructing related hardware through computer programs.
  • the computer programs can be stored in a computer-readable storage medium, and the computer When the program is executed by the processor, the steps in the above-mentioned various method embodiments can be realized.
  • the computer program includes computer program code, and the computer program code may be in the form of source code, object code, executable file or some intermediate form.
  • the computer-readable storage medium may include: any entity or device capable of carrying the computer program code, a recording medium, a USB flash drive, a removable hard disk, a magnetic disk, an optical disk, a computer memory, a read-only memory (ROM, Read-Only Memory) ), Random Access Memory (RAM, Random Access Memory), electrical carrier signal, telecommunication signal, and software distribution medium, etc.
  • ROM Read-Only Memory
  • RAM Random Access Memory
  • electrical carrier signal telecommunication signal
  • software distribution medium etc.
  • the content contained in the computer-readable storage medium can be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction.
  • computer-readable Storage media excludes electrical carrier signals and telecommunication signals.

Landscapes

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

Abstract

A robot motion analysis method, comprising: acquiring a first joint angle of a target joint of a robot in a parallel configuration; processing the first joint angle by means of a preset forward kinematics analysis model to obtain a second joint angle of the target joint in a series configuration, the forward kinematics analysis model being a deep learning model obtained by training using a preset first training sample set, and the first training sample set being a set constructed according to an inverse kinematics analysis process. Also provided are a robot motion analysis device, a computer readable storage medium, and a robot. By means of the method, a forward kinematics analysis process is performed by means of a deep learning model; compared with existing numerical computation methods, the computational complexity is effectively reduced.

Description

一种机器人运动分析方法、装置、可读存储介质及机器人A robot motion analysis method, device, readable storage medium and robot
本申请要求于2021年07月20日在中国专利局提交的、申请号为202110818134.4的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims priority to a Chinese patent application with application number 202110818134.4 filed at the China Patent Office on July 20, 2021, the entire contents of which are incorporated herein by reference.
技术领域technical field
本申请属于机器人技术领域,尤其涉及一种机器人运动分析方法、装置、计算机可读存储介质及机器人。The present application belongs to the technical field of robots, and in particular relates to a robot motion analysis method, device, computer readable storage medium and robot.
背景技术Background technique
仿人机器人研究中的一个关键重点是并联构型的控制问题,对于机器人中的并联构型,通过几何学或DH法能够比较容易地直接推导逆运动学的解析解,但是并联构型的正运动学一般会采用数值法计算,基于雅克比矩阵,通过牛顿-拉夫逊方法迭代逼近,计算复杂度较高。A key point in the research of humanoid robots is the control problem of parallel configurations. For parallel configurations in robots, the analytical solution of inverse kinematics can be directly derived relatively easily through geometry or DH method, but the normal Kinematics is generally calculated by numerical method, based on the Jacobian matrix, iteratively approximated by the Newton-Raphson method, and the computational complexity is relatively high.
技术问题technical problem
有鉴于此,本申请实施例提供了一种机器人运动分析方法、装置、计算机可读存储介质及机器人,以解决现有的正运动学分析过程计算复杂度较高的问题。In view of this, embodiments of the present application provide a robot motion analysis method, device, computer-readable storage medium, and robot to solve the problem of high computational complexity in the existing forward kinematics analysis process.
技术解决方案technical solution
本申请实施例的第一方面提供了一种机器人运动分析方法,可以包括:The first aspect of the embodiment of the present application provides a robot motion analysis method, which may include:
获取机器人的目标关节在并联构型下的第一关节角度;Obtain the first joint angle of the target joint of the robot in the parallel configuration;
使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度;所述正运动学分析模型为由预设的第一训练样本集合训练得到的深度学习模型,且所述第一训练样本集合为根据逆运动学分析过程所构建的集合。Use the preset positive kinematics analysis model to process the first joint angle to obtain the second joint angle of the target joint in the series configuration; the forward kinematics analysis model is the first training set by the preset The deep learning model obtained by training the sample set, and the first training sample set is a set constructed according to the inverse kinematics analysis process.
在第一方面的一种具体实现中,所述机器人运动分析方法还可以包括:In a specific implementation of the first aspect, the robot motion analysis method may further include:
获取所述目标关节的关节运动参数;Acquiring joint motion parameters of the target joint;
使用预设的逆动力学分析模型对所述目标关节的关节运动参数进行处理,得到所述目标关节的驱动力矩;所述逆动力学分析模型为由预设的第二训练样本集合训练得到的深度学习模型,且所述第二训练样本集合为根据正动力学分析过程所构建的集合。Using a preset inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint; the inverse dynamics analysis model is obtained by training a preset second training sample set A deep learning model, and the second training sample set is a set constructed according to a positive dynamics analysis process.
在第一方面的一种具体实现中,在使用预设的正运动学分析模型对所述第一关节角度进行处理之前,所述机器人运动分析方法还可以包括:In a specific implementation of the first aspect, before using a preset forward kinematics analysis model to process the first joint angle, the robot motion analysis method may further include:
确定所述目标关节在串联构型下的运动范围;determining a range of motion of the target joint in a tandem configuration;
在所述运动范围中选取第一数目的串联关节角度;selecting a first number of serial joint angles in the range of motion;
根据所述逆运动学分析过程计算与每个串联关节角度分别对应的并联关节角度;calculating parallel joint angles corresponding to each series joint angle according to the inverse kinematics analysis process;
构建所述第一训练样本集合;所述第一训练样本集合中包括第一数目的训练样本,每个训练样本均包括一组串联关节角度和对应的并联关节角度;Constructing the first training sample set; the first training sample set includes a first number of training samples, each training sample includes a set of series joint angles and corresponding parallel joint angles;
使用所述第一训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述正运动学分析模型。The first training sample set is used to train the deep learning model in the initial state, and the trained deep learning model is used as the forward kinematics analysis model.
在第一方面的一种具体实现中,所述深度学习模型可以为包括第一生成器和第一判别器的生成对抗网络模型;In a specific implementation of the first aspect, the deep learning model may be a generation confrontation network model including a first generator and a first discriminator;
所述使用所述第一训练样本集合对初始状态的深度学习模型进行训练,可以包括:The training of the deep learning model of the initial state using the first training sample set may include:
对于所述第一训练样本集合中的每个训练样本,使用所述第一生成器对该样本的并联关节角度进行处理,得到第一生成结果;For each training sample in the first training sample set, use the first generator to process the parallel joint angle of the sample to obtain a first generation result;
根据该样本的第一生成结果和串联关节角度,使用所述第一判别器进行模型训练过程。According to the first generation result of the sample and the joint angles in series, the first discriminator is used to perform a model training process.
在第一方面的一种具体实现中,在使用预设的逆动力学分析模型对所述目标关节的关节运动参数进行处理之前,所述机器人运动分析方法还可以包括:In a specific implementation of the first aspect, before using a preset inverse dynamics analysis model to process the joint motion parameters of the target joint, the robot motion analysis method may further include:
获取所述目标关节的运动轨迹记录;Acquiring the motion trajectory record of the target joint;
在所述运动轨迹记录中选取第二数目的运动轨迹点,其中,每个运动轨迹点均包括驱动力矩、关节速度和关节加速度;Selecting a second number of movement trajectory points in the movement trajectory record, wherein each movement trajectory point includes driving torque, joint velocity and joint acceleration;
根据所述正动力学分析过程计算与每个运动轨迹点分别对应的关节角度;Calculating joint angles corresponding to each motion track point according to the positive dynamics analysis process;
构建所述第二训练样本集合;所述第二训练样本集合中包括第二数目的训练样本,每个训练样本均包括一组驱动力矩和对应的关节运动参数;关节运动参数包括关节角度、关节速度和关节加速度;Constructing the second training sample set; the second training sample set includes a second number of training samples, each training sample includes a set of driving torque and corresponding joint motion parameters; the joint motion parameters include joint angles, joint motion parameters velocity and joint acceleration;
使用所述第二训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述逆动力学分析模型。The deep learning model in the initial state is trained by using the second training sample set, and the trained deep learning model is used as the inverse dynamics analysis model.
在第一方面的一种具体实现中,所述深度学习模型为包括第二生成器和第二判别器的生成对抗网络模型;In a specific implementation of the first aspect, the deep learning model is a generation confrontation network model including a second generator and a second discriminator;
所述使用所述第二训练样本集合对初始状态的深度学习模型进行训练,可以包括:The training of the deep learning model of the initial state using the second training sample set may include:
对于所述第二训练样本集合中的每个训练样本,使用所述第二生成器对该样本的关节运动参数进行处理,得到第二生成结果;For each training sample in the second training sample set, use the second generator to process the joint motion parameters of the sample to obtain a second generation result;
根据该样本的第二生成结果和驱动力矩,使用所述第二判别器进行模型训练过程。According to the second generation result of the sample and the driving torque, the second discriminator is used to perform a model training process.
在第一方面的一种具体实现中,所述使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度,可以包括:In a specific implementation of the first aspect, the processing of the first joint angle using a preset forward kinematics analysis model to obtain the second joint angle of the target joint in a serial configuration may include :
将所述第一关节角度输入至所述正运动学分析模型中进行处理,并将所述正运动学分析模型处理后的输出作为所述第二关节角度。The first joint angle is input into the forward kinematics analysis model for processing, and the processed output of the forward kinematics analysis model is used as the second joint angle.
本申请实施例的第二方面提供了一种机器人运动分析装置,可以包括:The second aspect of the embodiment of the present application provides a robot motion analysis device, which may include:
第一关节角度获取模块,用于获取机器人的目标关节在并联构型下的第一关节角度;The first joint angle obtaining module is used to obtain the first joint angle of the target joint of the robot in the parallel configuration;
正运动学分析模块,用于使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度;所述正运动学分析模型为由预设的第一训练样本集合训练得到的深度学习模型,且所述第一训练样本集合为根据逆运动学分析过程所构建的集合。A forward kinematics analysis module, configured to use a preset forward kinematics analysis model to process the first joint angle to obtain a second joint angle of the target joint in a serial configuration; the forward kinematics analysis model It is a deep learning model trained by a preset first training sample set, and the first training sample set is a set constructed according to an inverse kinematics analysis process.
在第二方面的一种具体实现中,所述机器人运动分析装置还可以包括:In a specific implementation of the second aspect, the robot motion analysis device may further include:
关节运动参数获取模块,用于获取所述目标关节的关节运动参数;A joint motion parameter acquisition module, configured to acquire the joint motion parameters of the target joint;
逆动力学分析模块,用于使用预设的逆动力学分析模型对所述目标关节的关节运动参数进行处理,得到所述目标关节的驱动力矩;所述逆动力学分析模型为由预设的第二训练样本集合训练得到的深度学习模型,且所述第二训练样本集合为根据正动力学分析过程所构建的集合。The inverse dynamics analysis module is used to use a preset inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint; the inverse dynamics analysis model is a preset The second training sample set is a deep learning model obtained by training, and the second training sample set is a set constructed according to a positive dynamics analysis process.
在第二方面的一种具体实现中,所述机器人运动分析装置还可以包括:In a specific implementation of the second aspect, the robot motion analysis device may further include:
运动范围确定模块,用于确定所述目标关节在串联构型下的运动范围;a range of motion determination module, configured to determine the range of motion of the target joint in a series configuration;
串联关节角度选取模块,用于在所述运动范围中选取第一数目的串联关节角度;A serial joint angle selection module, configured to select a first number of serial joint angles in the range of motion;
逆运动学分析模块,用于根据所述逆运动学分析过程计算与每个串联关节角度分别对应的并联关节角度;an inverse kinematics analysis module, configured to calculate a parallel joint angle corresponding to each serial joint angle according to the inverse kinematics analysis process;
第一训练样本集合构建模块,用于构建所述第一训练样本集合;所述第一训练样本集合中包括第一数目的训练样本,每个训练样本均包括一组串联关节角度和对应的并联关节角度;The first training sample set construction module is used to construct the first training sample set; the first training sample set includes a first number of training samples, and each training sample includes a set of series joint angles and corresponding parallel joint angles joint angle;
正运动学分析模型训练模块,用于使用所述第一训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述正运动学分析模型。The forward kinematics analysis model training module is used to use the first training sample set to train the deep learning model in the initial state, and use the trained deep learning model as the forward kinematics analysis model.
在第二方面的一种具体实现中,所述深度学习模型为包括第一生成器和第一判别器的生成对抗网络模型;In a specific implementation of the second aspect, the deep learning model is a generation confrontation network model including a first generator and a first discriminator;
所述正运动学分析模型训练模块可以包括:The positive kinematics analysis model training module may include:
第一生成器处理单元,用于对于所述第一训练样本集合中的每个训练样本,使用所述第一生成器对该样本的并联关节角度进行处理,得到第一生成结果;The first generator processing unit is configured to, for each training sample in the first training sample set, use the first generator to process the parallel joint angle of the sample to obtain a first generation result;
第一判别器处理单元,用于根据该样本的第一生成结果和串联关节角度,使用所述第一判别器进行模型训练过程。The first discriminator processing unit is configured to use the first discriminator to perform a model training process according to the first generation result of the sample and the series joint angle.
在第二方面的一种具体实现中,所述机器人运动分析装置还可以包括:In a specific implementation of the second aspect, the robot motion analysis device may further include:
运动轨迹记录获取模块,用于获取所述目标关节的运动轨迹记录;A movement track record acquisition module, configured to acquire the movement track record of the target joint;
运动轨迹点选取模块,用于在所述运动轨迹记录中选取第二数目的运动轨迹点,其中,每个运动轨迹点均包括驱动力矩、关节速度和关节加速度;A motion track point selection module, configured to select a second number of motion track points in the motion track record, wherein each motion track point includes drive torque, joint velocity and joint acceleration;
正动力学分析模块,用于根据所述正动力学分析过程计算与每个运动轨迹点分别对应的关节角度;A positive dynamics analysis module, used to calculate joint angles corresponding to each motion track point according to the positive dynamics analysis process;
第二训练样本集合构建模块,用于构建所述第二训练样本集合;所述第二训练样本集合中包括第二数目的训练样本,每个训练样本均包括一组驱动力矩和对应的关节运动参数;关节运动参数包括关节角度、关节速度和关节加速度;The second training sample set construction module is used to construct the second training sample set; the second training sample set includes a second number of training samples, and each training sample includes a set of driving torques and corresponding joint motions parameters; joint motion parameters include joint angle, joint velocity and joint acceleration;
逆动力学分析模型训练模块,用于使用所述第二训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述逆动力学分析模型。The inverse dynamics analysis model training module is used to use the second training sample set to train the deep learning model in the initial state, and use the trained deep learning model as the inverse dynamics analysis model.
在第二方面的一种具体实现中,所述深度学习模型为包括第二生成器和第二判别器的生成对抗网络模型;In a specific implementation of the second aspect, the deep learning model is a generation confrontation network model including a second generator and a second discriminator;
所述逆动力学分析模型训练模块可以包括:The inverse dynamics analysis model training module may include:
第二生成器处理单元,用于对于所述第二训练样本集合中的每个训练样本,使用所述第二生成器对该样本的关节运动参数进行处理,得到第二生成结果;The second generator processing unit is configured to, for each training sample in the second training sample set, use the second generator to process the joint motion parameters of the sample to obtain a second generation result;
第二判别器处理单元,用于根据该样本的第二生成结果和驱动力矩,使用所述第二判别器进行模型训练过程。The second discriminator processing unit is configured to use the second discriminator to perform a model training process according to the second generation result of the sample and the driving torque.
在第二方面的一种具体实现中,所述正运动学分析模块具体用于将所述第一关节角度输入至所述正运动学分析模型中进行处理,并将所述正运动学分析模型处理后的输出作为所述第二关节角度。In a specific implementation of the second aspect, the forward kinematics analysis module is specifically configured to input the first joint angle into the forward kinematics analysis model for processing, and convert the forward kinematics analysis model to The processed output is used as the second joint angle.
本申请实施例的第三方面提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述任一种机器人运动分析方法的步骤。The third aspect of the embodiments of the present application provides a computer-readable storage medium, the computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of any one of the above robot motion analysis methods are implemented .
本申请实施例的第四方面提供了一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述任一种机器人运动分析方法的步骤。The fourth aspect of the embodiments of the present application provides a robot, including a memory, a processor, and a computer program stored in the memory and operable on the processor. When the processor executes the computer program, it realizes The steps of any one of the above robot motion analysis methods.
本申请实施例的第五方面提供了一种计算机程序产品,当计算机程序产品在机器人上运行时,使得机器人执行上述任一种机器人运动分析方法的步骤。A fifth aspect of the embodiments of the present application provides a computer program product, which, when the computer program product is run on a robot, causes the robot to perform the steps of any one of the robot motion analysis methods described above.
有益效果Beneficial effect
本申请实施例与现有技术相比存在的有益效果是:本申请实施例获取机器人的目标关节在并联构型下的第一关节角度;使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度;所述正运动学分析模型为由预设的第一训练样本集合训练得到的深度学习模型,且所述第一训练样本集合为根据逆运动学分析过程所构建的集合。通过本申请实施例,使用深度学习模型来进行正运动学分析过程,相比于现有的数值法计算方法,有效降低了计算复杂度。Compared with the prior art, the embodiment of the present application has the following beneficial effects: the embodiment of the present application acquires the first joint angle of the target joint of the robot in the parallel configuration; uses the preset forward kinematics analysis model to analyze the first The joint angle is processed to obtain the second joint angle of the target joint in the series configuration; the forward kinematics analysis model is a deep learning model trained by the preset first training sample set, and the first The training sample set is a set constructed according to the inverse kinematics analysis process. Through the embodiment of the present application, the forward kinematics analysis process is performed by using the deep learning model, which effectively reduces the computational complexity compared with the existing numerical calculation method.
附图说明Description of drawings
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。In order to more clearly illustrate the technical solutions in the embodiments of the present application, the accompanying drawings that need to be used in the descriptions of the embodiments or the prior art will be briefly introduced below. Obviously, the accompanying drawings in the following description are only for the present application For some embodiments, those skilled in the art can also obtain other drawings based on these drawings without creative efforts.
图1为本申请实施例中所使用的坐标系的示意图;Fig. 1 is the schematic diagram of the coordinate system used in the embodiment of the present application;
图2为坐标轴与旋转方向的对应关系图;Fig. 2 is a corresponding relationship diagram between coordinate axes and directions of rotation;
图3为并联机构的示意图;Fig. 3 is the schematic diagram of parallel mechanism;
图4为膝-踝并联机构的示意图;Fig. 4 is the schematic diagram of knee-ankle parallel mechanism;
图5为正运动学和逆运动学分析过程的示意图;Fig. 5 is the schematic diagram of forward kinematics and inverse kinematics analysis process;
图6为生成对抗网络模型的示意图;Fig. 6 is a schematic diagram of generating an adversarial network model;
图7为正运动学分析模型的构建过程的示意流程图;Fig. 7 is a schematic flow chart of the construction process of the forward kinematics analysis model;
图8为正运动学分析过程的示意流程图;Fig. 8 is a schematic flow chart of the forward kinematics analysis process;
图9为正动力学和逆动力学分析过程的示意图;Fig. 9 is the schematic diagram of forward kinetics and inverse kinetics analysis process;
图10为逆动力学分析模型的构建过程的示意流程图;Fig. 10 is a schematic flow chart of the construction process of the inverse dynamics analysis model;
图11为逆动力学分析过程的示意流程图;Figure 11 is a schematic flow chart of the inverse kinetic analysis process;
图12为本申请实施例中一种机器人运动分析装置的一个实施例结构图;FIG. 12 is a structural diagram of an embodiment of a robot motion analysis device in the embodiment of the present application;
图13为本申请实施例中一种机器人的示意框图。Fig. 13 is a schematic block diagram of a robot in the embodiment of the present application.
本发明的实施方式Embodiments of the present invention
为使得本申请的发明目的、特征、优点能够更加的明显和易懂,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,下面所描述的实施例仅仅是本申请一部分实施例,而非全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本申请保护的范围。In order to make the purpose, features and advantages of the present application more obvious and understandable, the technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the following The described embodiments are only some of the embodiments of the present application, but not all of them. Based on the embodiments in this application, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the scope of protection of this application.
应当理解,当在本说明书和所附权利要求书中使用时,术语“包括”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。It should be understood that when used in this specification and the appended claims, the term "comprising" indicates the presence of described features, integers, steps, operations, elements and/or components, but does not exclude one or more other features. , whole, step, operation, element, component and/or the presence or addition of a collection thereof.
还应当理解,在此本申请说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本申请。如在本申请说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。It should also be understood that the terminology used in the specification of this application is for the purpose of describing particular embodiments only and is not intended to limit the application. As used in this specification and the appended claims, the singular forms "a", "an" and "the" are intended to include plural referents unless the context clearly dictates otherwise.
还应当进一步理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。It should also be further understood that the term "and/or" used in the description of the present application and the appended claims refers to any combination and all possible combinations of one or more of the associated listed items, and includes these combinations .
如在本说明书和所附权利要求书中所使用的那样,术语“如果”可以依据上下文被解释为“当...时”或“一旦”或“响应于确定”或“响应于检测到”。类似地,短语“如果确定”或“如果检测到[所描述条件或事件]”可以依据上下文被解释为意指“一旦确定”或“响应于确定”或“一旦检测到[所描述条件或事件]”或“响应于检测到[所描述条件或事件]”。As used in this specification and the appended claims, the term "if" may be construed as "when" or "once" or "in response to determining" or "in response to detecting" depending on the context . Similarly, the phrase "if determined" or "if [the described condition or event] is detected" may be construed, depending on the context, to mean "once determined" or "in response to the determination" or "once detected [the described condition or event] ]” or “in response to detection of [described condition or event]”.
另外,在本申请的描述中,术语“第一”、“第二”、“第三”等仅用于区分描述,而不能理解为指示或暗示相对重要性。In addition, in the description of the present application, terms such as "first", "second", and "third" are only used to distinguish descriptions, and cannot be understood as indicating or implying relative importance.
在本申请实施例中,可以首先建立如图1所示的全局坐标系Σ w,在该坐标系下,机器人的前向为x轴,侧向为y轴,纵向为z轴。 In the embodiment of the present application, a global coordinate system Σ w as shown in FIG. 1 can be established first. In this coordinate system, the forward direction of the robot is the x-axis, the lateral direction is the y-axis, and the longitudinal direction is the z-axis.
图2所示为坐标轴与旋转方向的对应关系图,如图所示,绕着x轴旋转的方向为r x,记为翻滚角(roll角);绕着y轴旋转的方向为r y,记为俯仰角(pitch角);绕着z轴旋转的方向为r z,记为偏航角(yaw角)。 Figure 2 shows the corresponding relationship between coordinate axes and rotation directions. As shown in the figure, the direction of rotation around the x-axis is r x , which is recorded as the roll angle (roll angle); the direction of rotation around the y-axis is r y , recorded as the pitch angle (pitch angle); the direction of rotation around the z axis is r z , recorded as the yaw angle (yaw angle).
一般地,机器人的每条腿可以包括髋关节、膝关节和踝关节。在每个关节处都有一个局部坐标系,局部坐标系的初始状态跟全局坐标系是一致的。在串联构型下,左腿髋关节H 1和右腿髋关节H 2分别有三个自由度,通过三个旋转舵机分别可绕其局部坐标系的x轴、y轴和z轴旋转,左腿膝关节K 1和右腿膝关节K 2分别有一个自由度,通过一个旋转舵机可绕其局部坐标系的y轴旋转,左腿踝关节A 1和右腿踝关节A 2分别有两个自由度,通过两个旋转舵机分别可绕其局部坐标系的x轴和y轴旋转。 Generally, each leg of a robot may include a hip joint, a knee joint, and an ankle joint. There is a local coordinate system at each joint, and the initial state of the local coordinate system is consistent with the global coordinate system. In the series configuration, the hip joint H 1 of the left leg and the hip joint H 2 of the right leg have three degrees of freedom respectively, and can rotate around the x-axis, y-axis and z-axis of their local coordinate system through three rotating servos, respectively. The knee joint K 1 of the leg and the knee joint K 2 of the right leg have one degree of freedom respectively, which can be rotated around the y-axis of their local coordinate system through a rotating servo, and the ankle joint A 1 of the left leg and the ankle joint A 2 of the right leg have two degrees of freedom respectively. degrees of freedom, and can be rotated around the x-axis and y-axis of its local coordinate system through two rotating steering gears.
在并联构型下,可以设置如图3所示的髋-膝并联机构(左图)或膝-踝并联机构(右图),其中的数字表示关节自由度,以下叙述中以膝-踝并联机构为例进行说明,髋-膝并联机构的情况与之类似。在图4所示的膝-踝并联机构中,髋关节和膝关节与串联构型的情况相同,在踝关节(O)处建立初始状态跟全局坐标系一致的局部坐标系。In the parallel configuration, a hip-knee parallel mechanism (left figure) or a knee-ankle parallel mechanism (right figure) can be set up as shown in Figure 3, where the numbers represent joint degrees of freedom, and the knee-ankle parallel mechanism is used in the following descriptions The mechanism is taken as an example, and the situation of the hip-knee parallel mechanism is similar. In the knee-ankle parallel mechanism shown in Fig. 4, the hip and knee joints are the same as the series configuration, and a local coordinate system whose initial state is consistent with the global coordinate system is established at the ankle joint (O).
目前一般使用的机器人模型是基于并联构型的,但是控制算法都是基于串联构型的,因此,在本申请实施例中可以首先建立从并联构型到串联构型之间的等价关系。Currently commonly used robot models are based on parallel configurations, but control algorithms are based on series configurations. Therefore, in the embodiment of the present application, an equivalence relationship from parallel configurations to series configurations can be established first.
以单条腿为例,并联构型下的关节角度可表示为:Taking a single leg as an example, the joint angle in parallel configuration can be expressed as:
θ=(θ 123456) T θ=(θ 123456 ) T
其中,θ 123为髋关节在三个自由度上的关节角度,θ 4为膝关节在一个自由度上的关节角度,θ 56为踝关节在两个自由度上的关节角度。 Among them, θ 1 , θ 2 , θ 3 are the joint angles of the hip joint in three degrees of freedom, θ 4 is the joint angle of the knee joint in one degree of freedom, θ 5 , θ 6 are the joint angles of the ankle joint in two degrees of freedom joint angle on .
相应地,串联构型下的关节角度可表示为:Correspondingly, the joint angles in the series configuration can be expressed as:
q=(q 1,q 2,q 3,q 4,q 5,q 6) T q=(q 1 ,q 2 ,q 3 ,q 4 ,q 5 ,q 6 ) T
其中,q 1,q 2,q 3为髋关节在三个自由度上的关节角度,q 4为膝关节在一个自由度上的关节角度,q 5,q 6为踝关节在两个自由度上的关节角度。在现有的机器人控制算法中,可以基于腰部位姿p torso、R torso和足部位姿p foot、R foot计算得到q。 Among them, q 1 , q 2 , q 3 are the joint angles of the hip joint in three degrees of freedom, q 4 are the joint angles of the knee joint in one degree of freedom, q 5 , q 6 are the joint angles of the ankle joint in two degrees of freedom joint angle on . In the existing robot control algorithm, q can be calculated based on the waist position p torso , R torso and the foot position p foot , R foot .
事实上,对于髋关节,θ 1=q 1,θ 2=q 2,θ 3=q 3;对于膝关节,θ 4=q 4;而对于踝关节,θ 56与q 5,q 6并不相同。 In fact, for the hip joint, θ 1 =q 1 , θ 2 =q 2 , θ 3 =q 3 ; for the knee joint, θ 4 =q 4 ; and for the ankle joint, θ 56 and q 5 ,q 6 is not the same.
在本申请实施例中,如图5所示,可以将根据θ 56求解q 5,q 6的过程作为正运动学分析过程,将根据q 5,q 6求解θ 56的过程作为逆运动学分析过程。 In the embodiment of this application, as shown in Figure 5, the process of solving q 5 and q 6 according to θ 5 and θ 6 can be regarded as a forward kinematics analysis process, and the calculation of θ 5 and θ 6 according to q 5 and q 6 The process is analyzed as an inverse kinematics process.
在本申请实施例中,可以使用深度学习模型来进行正运动学分析过程,具体采用何种类型的深度学习模型可以根据实际情况进行设置,此处优选采用生成对抗网络(Generative Adversarial Networks,GAN)模型。对于生成对抗网络模型,给定一批样本,可以训练一个系统能够生成类似的样本,从而能够解决训练数据不足的问题。In the embodiment of this application, the deep learning model can be used to carry out the forward kinematics analysis process. The specific type of deep learning model can be set according to the actual situation. Here, Generative Adversarial Networks (GAN) is preferably used. Model. For the GAN model, given a batch of samples, a system can be trained to generate similar samples, which can solve the problem of insufficient training data.
图6所示为生成对抗网络模型的示意图,生成对抗网络模型可以包括生成器G和判别器D,其中,生成器G用于训练学习从一个低维潜在向量z(z~p z(z)独立同分布),到真实数据x的映射G(z);判别器D用于训练学习区分数据来源于真实数据x(x~p data(x))还是生成器生成的数据G(z);生成对抗网络模型通过优化过程来调整生成器G与判别器D,其目标函数为: Figure 6 is a schematic diagram of the generation confrontational network model, which can include a generator G and a discriminator D, where the generator G is used for training and learning from a low-dimensional latent vector z(z~p z (z) Independent and identical distribution), the mapping G(z) to the real data x; the discriminator D is used to train and learn to distinguish whether the data comes from the real data x(x~p data (x)) or the data G(z) generated by the generator; The generation confrontation network model adjusts the generator G and the discriminator D through the optimization process, and its objective function is:
Figure PCTCN2021126737-appb-000001
Figure PCTCN2021126737-appb-000001
如图7所示,在本申请实施例的一种具体实现中,正运动学分析模型的构建过程可以包括如下步骤:As shown in Figure 7, in a specific implementation of the embodiment of the present application, the construction process of the forward kinematics analysis model may include the following steps:
步骤S701、确定目标关节在串联构型下的运动范围。Step S701. Determine the range of motion of the target joint in the serial configuration.
以目标关节为踝关节为例,可以将其运动范围记为:q 5∈[q 5min,q 5max],q 6∈[q 6min,q 6max],其中,q 5min,q 5max,q 6min,q 6max分别为预设的阈值,其具体取值可以根据实际情况进行设置。 Taking the target joint as the ankle joint as an example, its range of motion can be recorded as: q 5 ∈[q 5min ,q 5max ], q 6 ∈[q 6min ,q 6max ], where, q 5min ,q 5max ,q 6min , q 6max are preset thresholds, and their specific values can be set according to actual conditions.
步骤S702、在运动范围中选取第一数目的串联关节角度。Step S702, selecting a first number of serial joint angles in the range of motion.
在运动范围中选取一个q 5的取值以及一个q 6的取值,两者即可构成一个串联关节角度。第一数目的具体取值可以根据实际情况进行设置,一般地,为了保证训练得到的模型的精 准度,应尽量采集足够多的串联关节角度。 Select a value of q 5 and a value of q 6 in the range of motion, and the two can form a series joint angle. The specific value of the first number can be set according to the actual situation. Generally, in order to ensure the accuracy of the model obtained through training, enough series joint angles should be collected as much as possible.
在进行采样时,可以根据实际情况采取不同的采样方式,包括但不限于随机采样以及均匀采样等等。When sampling, different sampling methods can be adopted according to the actual situation, including but not limited to random sampling and uniform sampling.
步骤S703、根据逆运动学分析过程计算与每个串联关节角度分别对应的并联关节角度。Step S703 , calculating the parallel joint angle corresponding to each series joint angle according to the inverse kinematics analysis process.
对于根据串联关节角度q 5,q 6求解并联关节角度θ 56的逆运动学分析过程,可以根据实际情况选取现有技术中的任意一种逆运动学分析方法,本实施例对此不再赘述。 For the inverse kinematics analysis process of solving the parallel joint angles θ 5 , θ 6 according to the series joint angles q 5 , q 6 , any inverse kinematics analysis method in the prior art can be selected according to the actual situation. No longer.
步骤S704、构建第一训练样本集合。Step S704, constructing a first training sample set.
第一训练样本集合中包括第一数目的训练样本,每个训练样本均包括一组串联关节角度和对应的并联关节角度。The first training sample set includes a first number of training samples, and each training sample includes a set of series joint angles and corresponding parallel joint angles.
步骤S705、使用第一训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为正运动学分析模型。Step S705, using the first training sample set to train the deep learning model in the initial state, and using the trained deep learning model as a forward kinematics analysis model.
此处优先采用生成对抗网络模型,该模型可以包括第一生成器和第一判别器。在训练过程中,对于第一训练样本集合中的每个训练样本,首先使用第一生成器对该样本的并联关节角度进行处理,得到第一生成结果,然后根据该样本的第一生成结果和串联关节角度,使用第一判别器进行模型训练过程,最终得到已训练的正运动学分析模型。Here, the generation confrontation network model is preferably used, and the model may include a first generator and a first discriminator. During the training process, for each training sample in the first training sample set, the first generator is used to process the parallel joint angle of the sample to obtain the first generated result, and then according to the first generated result of the sample and Connect the joint angles in series, use the first discriminator to carry out the model training process, and finally obtain the trained forward kinematics analysis model.
在训练得到正运动学分析模型之后,则可以通过如图8所示的过程进行机器人正运动学分析:After training the positive kinematics analysis model, the forward kinematics analysis of the robot can be performed through the process shown in Figure 8:
步骤S801、获取机器人的目标关节在并联构型下的第一关节角度。Step S801, acquiring the first joint angle of the target joint of the robot in the parallel configuration.
步骤S802、使用正运动学分析模型对第一关节角度进行处理,得到目标关节在串联构型下的第二关节角度。Step S802, using the forward kinematics analysis model to process the first joint angle to obtain the second joint angle of the target joint in the serial configuration.
具体地,可以将第一关节角度输入至正运动学分析模型中进行处理,并将正运动学分析模型处理后的输出作为第二关节角度。Specifically, the first joint angle may be input into the forward kinematics analysis model for processing, and the processed output of the forward kinematics analysis model may be used as the second joint angle.
在本申请实施例中,使用深度学习模型来进行正运动学分析过程,相比于现有的数值法计算方法,有效降低了计算复杂度。In the embodiment of the present application, the forward kinematics analysis process is performed by using the deep learning model, which effectively reduces the computational complexity compared with the existing numerical calculation method.
如图9所示,在本申请实施例的一种具体实现中,还可以将根据关节的驱动力矩τ、关节速度
Figure PCTCN2021126737-appb-000002
和关节加速度
Figure PCTCN2021126737-appb-000003
求解关节角度θ的过程作为正动力学分析过程,将根据关节角度θ、关节速度
Figure PCTCN2021126737-appb-000004
与关节加速度
Figure PCTCN2021126737-appb-000005
求解关节的驱动力矩τ的过程作为逆动力学分析过程。
As shown in Fig. 9, in a specific implementation of the embodiment of the present application, the drive torque τ of the joint, the joint speed
Figure PCTCN2021126737-appb-000002
and joint acceleration
Figure PCTCN2021126737-appb-000003
The process of solving the joint angle θ is regarded as a positive dynamics analysis process, which will be based on the joint angle θ, joint velocity
Figure PCTCN2021126737-appb-000004
and joint acceleration
Figure PCTCN2021126737-appb-000005
The process of solving the driving torque τ of the joint is regarded as the inverse dynamics analysis process.
在本申请实施例中,可以使用深度学习模型来进行逆动力学分析过程,具体采用何种类型的深度学习模型可以根据实际情况进行设置,此处优选采用生成对抗网络模型,以解决训练数据不足的问题。In the embodiment of the present application, the inverse dynamics analysis process can be performed using a deep learning model. The specific type of deep learning model can be set according to the actual situation. Here, it is preferable to use a generative confrontation network model to solve the lack of training data. The problem.
如图10所示,在本申请实施例的一种具体实现中,逆动力学分析模型的构建过程可以包括如下步骤:As shown in Figure 10, in a specific implementation of the embodiment of the present application, the construction process of the inverse dynamics analysis model may include the following steps:
步骤S1001、获取目标关节的运动轨迹记录。Step S1001. Obtain the motion track record of the target joint.
步骤S1002、在运动轨迹记录中选取第二数目的运动轨迹点。Step S1002, selecting a second number of motion track points in the motion track record.
其中,每个运动轨迹点均包括驱动力矩、关节速度和关节加速度。Among them, each motion trajectory point includes driving torque, joint velocity and joint acceleration.
第二数目的具体取值可以根据实际情况进行设置,一般地,为了保证训练得到的模型的精准度,应尽量采集足够多的运动轨迹点。The specific value of the second number can be set according to the actual situation. Generally, in order to ensure the accuracy of the trained model, enough motion trajectory points should be collected as much as possible.
在进行采样时,可以根据实际情况采取不同的采样方式,包括但不限于随机采样以及均匀采样等等。When sampling, different sampling methods can be adopted according to the actual situation, including but not limited to random sampling and uniform sampling.
步骤S1003、根据正动力学分析过程计算与每个运动轨迹点分别对应的关节角度。Step S1003 , calculating joint angles corresponding to each motion track point according to the forward dynamics analysis process.
对于根据驱动力矩τ、关节速度
Figure PCTCN2021126737-appb-000006
和关节加速度
Figure PCTCN2021126737-appb-000007
求解关节角度θ的正动力学分析过 程,可以根据实际情况选取现有技术中的任意一种正动力学分析方法,本实施例对此不再赘述。
For the drive torque τ, joint velocity
Figure PCTCN2021126737-appb-000006
and joint acceleration
Figure PCTCN2021126737-appb-000007
For the positive dynamics analysis process of solving the joint angle θ, any positive dynamics analysis method in the prior art may be selected according to the actual situation, which will not be described in this embodiment.
步骤S1004、构建第二训练样本集合。Step S1004, constructing a second training sample set.
第二训练样本集合中包括第二数目的训练样本,每个训练样本均包括一组驱动力矩和对应的关节运动参数,关节运动参数包括关节角度、关节速度和关节加速度。The second training sample set includes a second number of training samples, and each training sample includes a set of driving torque and corresponding joint motion parameters, where the joint motion parameters include joint angle, joint velocity and joint acceleration.
步骤S1005、使用第二训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为逆动力学分析模型。Step S1005, use the second training sample set to train the deep learning model in the initial state, and use the trained deep learning model as an inverse dynamics analysis model.
此处优先采用生成对抗网络模型,该模型可以包括第二生成器和第二判别器。在训练过程中,对于第二训练样本集合中的每个训练样本,首先使用第二生成器对该样本的关节运动参数进行处理,得到第二生成结果,然后根据该样本的第二生成结果和驱动力矩,使用第二判别器进行模型训练过程,最终得到已训练的逆动力学分析模型。Here, the generation confrontation network model is preferred, and the model may include a second generator and a second discriminator. During the training process, for each training sample in the second training sample set, first use the second generator to process the joint motion parameters of the sample to obtain the second generation result, and then according to the second generation result of the sample and Drive torque, use the second discriminator to carry out the model training process, and finally get the trained inverse dynamics analysis model.
在训练得到逆动力学分析模型之后,则可以通过如图11所示的过程进行机器人逆动力学分析:After training the inverse dynamics analysis model, the inverse dynamics analysis of the robot can be performed through the process shown in Figure 11:
步骤S1101、获取目标关节的关节运动参数。Step S1101, acquiring the joint motion parameters of the target joint.
步骤S1102、使用逆动力学分析模型对目标关节的关节运动参数进行处理,得到目标关节的驱动力矩。Step S1102, using the inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint.
具体地,可以将关节运动参数输入至逆动力学分析模型中进行处理,并将逆动力学分析模型处理后的输出作为驱动力矩。Specifically, the joint motion parameters may be input into the inverse dynamics analysis model for processing, and the processed output of the inverse dynamics analysis model may be used as the driving torque.
在本申请实施例中,使用深度学习模型来进行逆动力学分析过程,相比于现有的数值法计算方法,有效降低了计算复杂度。In the embodiment of the present application, the deep learning model is used to perform the inverse dynamics analysis process, which effectively reduces the computational complexity compared with the existing numerical calculation methods.
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本申请实施例的实施过程构成任何限定。It should be understood that the sequence numbers of the steps in the above embodiments do not mean the order of execution, and the execution order of each process should be determined by its function and internal logic, and should not constitute any limitation to the implementation process of the embodiment of the present application.
对应于上文实施例所述的一种机器人运动分析方法,图12示出了本申请实施例提供的一种机器人运动分析装置的一个实施例结构图。Corresponding to a robot motion analysis method described in the above embodiments, FIG. 12 shows a structural diagram of an embodiment of a robot motion analysis device provided in an embodiment of the present application.
本实施例中,一种机器人运动分析装置可以包括:In this embodiment, a robot motion analysis device may include:
第一关节角度获取模块1201,用于获取机器人的目标关节在并联构型下的第一关节角度;The first joint angle obtaining module 1201 is used to obtain the first joint angle of the target joint of the robot in the parallel configuration;
正运动学分析模块1202,用于使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度;所述正运动学分析模型为由预设的第一训练样本集合训练得到的深度学习模型,且所述第一训练样本集合为根据逆运动学分析过程所构建的集合。The forward kinematics analysis module 1202 is configured to use a preset forward kinematics analysis model to process the first joint angle to obtain a second joint angle of the target joint in a serial configuration; the forward kinematics analysis The model is a deep learning model trained from a preset first training sample set, and the first training sample set is a set constructed according to an inverse kinematics analysis process.
在本申请实施例的一种具体实现中,所述机器人运动分析装置还可以包括:In a specific implementation of the embodiment of the present application, the robot motion analysis device may further include:
关节运动参数获取模块,用于获取所述目标关节的关节运动参数;A joint motion parameter acquisition module, configured to acquire the joint motion parameters of the target joint;
逆动力学分析模块,用于使用预设的逆动力学分析模型对所述目标关节的关节运动参数进行处理,得到所述目标关节的驱动力矩;所述逆动力学分析模型为由预设的第二训练样本集合训练得到的深度学习模型,且所述第二训练样本集合为根据正动力学分析过程所构建的集合。The inverse dynamics analysis module is used to use a preset inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint; the inverse dynamics analysis model is a preset The second training sample set is a deep learning model obtained by training, and the second training sample set is a set constructed according to a positive dynamics analysis process.
在本申请实施例的一种具体实现中,所述机器人运动分析装置还可以包括:In a specific implementation of the embodiment of the present application, the robot motion analysis device may further include:
运动范围确定模块,用于确定所述目标关节在串联构型下的运动范围;a range of motion determination module, configured to determine the range of motion of the target joint in a series configuration;
串联关节角度选取模块,用于在所述运动范围中选取第一数目的串联关节角度;A serial joint angle selection module, configured to select a first number of serial joint angles in the range of motion;
逆运动学分析模块,用于根据所述逆运动学分析过程计算与每个串联关节角度分别对应的并联关节角度;an inverse kinematics analysis module, configured to calculate a parallel joint angle corresponding to each serial joint angle according to the inverse kinematics analysis process;
第一训练样本集合构建模块,用于构建所述第一训练样本集合;所述第一训练样本集合中包括第一数目的训练样本,每个训练样本均包括一组串联关节角度和对应的并联关节角度;The first training sample set construction module is used to construct the first training sample set; the first training sample set includes a first number of training samples, and each training sample includes a set of series joint angles and corresponding parallel joint angles joint angle;
正运动学分析模型训练模块,用于使用所述第一训练样本集合对初始状态的深度学习 模型进行训练,并将训练后的深度学习模型作为所述正运动学分析模型。The positive kinematics analysis model training module is used to use the first training sample set to train the deep learning model of the initial state, and use the trained deep learning model as the positive kinematics analysis model.
在本申请实施例的一种具体实现中,所述深度学习模型为包括第一生成器和第一判别器的生成对抗网络模型;In a specific implementation of the embodiment of the present application, the deep learning model is a generative confrontation network model including a first generator and a first discriminator;
所述正运动学分析模型训练模块可以包括:The positive kinematics analysis model training module may include:
第一生成器处理单元,用于对于所述第一训练样本集合中的每个训练样本,使用所述第一生成器对该样本的并联关节角度进行处理,得到第一生成结果;The first generator processing unit is configured to, for each training sample in the first training sample set, use the first generator to process the parallel joint angle of the sample to obtain a first generation result;
第一判别器处理单元,用于根据该样本的第一生成结果和串联关节角度,使用所述第一判别器进行模型训练过程。The first discriminator processing unit is configured to use the first discriminator to perform a model training process according to the first generation result of the sample and the series joint angle.
在本申请实施例的一种具体实现中,所述机器人运动分析装置还可以包括:In a specific implementation of the embodiment of the present application, the robot motion analysis device may further include:
运动轨迹记录获取模块,用于获取所述目标关节的运动轨迹记录;A movement track record acquisition module, configured to acquire the movement track record of the target joint;
运动轨迹点选取模块,用于在所述运动轨迹记录中选取第二数目的运动轨迹点,其中,每个运动轨迹点均包括驱动力矩、关节速度和关节加速度;A motion track point selection module, configured to select a second number of motion track points in the motion track record, wherein each motion track point includes drive torque, joint velocity and joint acceleration;
正动力学分析模块,用于根据所述正动力学分析过程计算与每个运动轨迹点分别对应的关节角度;A positive dynamics analysis module, used to calculate joint angles corresponding to each motion track point according to the positive dynamics analysis process;
第二训练样本集合构建模块,用于构建所述第二训练样本集合;所述第二训练样本集合中包括第二数目的训练样本,每个训练样本均包括一组驱动力矩和对应的关节运动参数;关节运动参数包括关节角度、关节速度和关节加速度;The second training sample set construction module is used to construct the second training sample set; the second training sample set includes a second number of training samples, and each training sample includes a set of driving torques and corresponding joint motions parameters; joint motion parameters include joint angle, joint velocity and joint acceleration;
逆动力学分析模型训练模块,用于使用所述第二训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述逆动力学分析模型。The inverse dynamics analysis model training module is used to use the second training sample set to train the deep learning model in the initial state, and use the trained deep learning model as the inverse dynamics analysis model.
在本申请实施例的一种具体实现中,所述深度学习模型为包括第二生成器和第二判别器的生成对抗网络模型;In a specific implementation of the embodiment of the present application, the deep learning model is a generative confrontation network model including a second generator and a second discriminator;
所述逆动力学分析模型训练模块可以包括:The inverse dynamics analysis model training module may include:
第二生成器处理单元,用于对于所述第二训练样本集合中的每个训练样本,使用所述第二生成器对该样本的关节运动参数进行处理,得到第二生成结果;The second generator processing unit is configured to, for each training sample in the second training sample set, use the second generator to process the joint motion parameters of the sample to obtain a second generation result;
第二判别器处理单元,用于根据该样本的第二生成结果和驱动力矩,使用所述第二判别器进行模型训练过程。The second discriminator processing unit is configured to use the second discriminator to perform a model training process according to the second generation result of the sample and the driving torque.
在本申请实施例的一种具体实现中,所述正运动学分析模块具体用于将所述第一关节角度输入至所述正运动学分析模型中进行处理,并将所述正运动学分析模型处理后的输出作为所述第二关节角度。In a specific implementation of the embodiment of the present application, the forward kinematics analysis module is specifically configured to input the first joint angle into the forward kinematics analysis model for processing, and convert the forward kinematics analysis The output after model processing is used as the second joint angle.
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的装置,模块和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that for the convenience and brevity of the description, the specific working process of the above-described devices, modules and units can refer to the corresponding process in the foregoing method embodiments, which will not be repeated here.
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。In the above-mentioned embodiments, the descriptions of each embodiment have their own emphases, and for parts that are not detailed or recorded in a certain embodiment, refer to the relevant descriptions of other embodiments.
图13示出了本申请实施例提供的一种机器人的示意框图,为了便于说明,仅示出了与本申请实施例相关的部分。FIG. 13 shows a schematic block diagram of a robot provided by the embodiment of the present application. For convenience of description, only parts related to the embodiment of the present application are shown.
如图13所示,该实施例的机器人13包括:处理器130、存储器131以及存储在所述存储器131中并可在所述处理器130上运行的计算机程序132。所述处理器130执行所述计算机程序132时实现上述各个机器人运动分析方法实施例中的步骤。或者,所述处理器130执行所述计算机程序132时实现上述各装置实施例中各模块/单元的功能。As shown in FIG. 13 , the robot 13 of this embodiment includes: a processor 130 , a memory 131 , and a computer program 132 stored in the memory 131 and operable on the processor 130 . When the processor 130 executes the computer program 132, the steps in the above-mentioned embodiments of the robot motion analysis method are realized. Alternatively, when the processor 130 executes the computer program 132, the functions of the modules/units in the foregoing device embodiments are realized.
示例性的,所述计算机程序132可以被分割成一个或多个模块/单元,所述一个或者多个模块/单元被存储在所述存储器131中,并由所述处理器130执行,以完成本申请。所述一个或多个模块/单元可以是能够完成特定功能的一系列计算机程序指令段,该指令段用于描述所述计算机程序132在所述机器人13中的执行过程。Exemplarily, the computer program 132 can be divided into one or more modules/units, and the one or more modules/units are stored in the memory 131 and executed by the processor 130 to complete this application. The one or more modules/units may be a series of computer program instruction segments capable of accomplishing specific functions, and the instruction segments are used to describe the execution process of the computer program 132 in the robot 13 .
本领域技术人员可以理解,图13仅仅是机器人13的示例,并不构成对机器人13的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件,例如所述机器人13还可以包括输入输出设备、网络接入设备、总线等。Those skilled in the art can understand that FIG. 13 is only an example of the robot 13, and does not constitute a limitation to the robot 13. It may include more or less components than shown in the illustration, or combine certain components, or different components, such as The robot 13 may also include input and output devices, network access devices, buses, and the like.
所述处理器130可以是中央处理单元(Central Processing Unit,CPU),还可以是其它通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其它可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The processor 130 can be a central processing unit (Central Processing Unit, CPU), and can also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC), Field-Programmable Gate Array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor, or the processor may be any conventional processor, or the like.
所述存储器131可以是所述机器人13的内部存储单元,例如机器人13的硬盘或内存。所述存储器131也可以是所述机器人13的外部存储设备,例如所述机器人13上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,所述存储器131还可以既包括所述机器人13的内部存储单元也包括外部存储设备。所述存储器131用于存储所述计算机程序以及所述机器人13所需的其它程序和数据。所述存储器131还可以用于暂时地存储已经输出或者将要输出的数据。The storage 131 may be an internal storage unit of the robot 13 , such as a hard disk or memory of the robot 13 . The memory 131 can also be an external storage device of the robot 13, such as a plug-in hard disk equipped on the robot 13, a smart memory card (Smart Media Card, SMC), a secure digital (Secure Digital, SD) card, Flash card (Flash Card), etc. Further, the memory 131 may also include both an internal storage unit of the robot 13 and an external storage device. The memory 131 is used to store the computer program and other programs and data required by the robot 13 . The memory 131 can also be used to temporarily store data that has been output or will be output.
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。实施例中的各功能单元、模块可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中,上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。另外,各功能单元、模块的具体名称也只是为了便于相互区分,并不用于限制本申请的保护范围。上述系统中单元、模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that for the convenience and brevity of description, only the division of the above-mentioned functional units and modules is used for illustration. In practical applications, the above-mentioned functions can be assigned to different functional units, Completion of modules means that the internal structure of the device is divided into different functional units or modules to complete all or part of the functions described above. Each functional unit and module in the embodiment may be integrated into one processing unit, or each unit may exist separately physically, or two or more units may be integrated into one unit, and the above-mentioned integrated units may adopt hardware It can also be implemented in the form of software functional units. In addition, the specific names of the functional units and modules are only for the convenience of distinguishing each other, and are not used to limit the protection scope of the present application. For the specific working process of the units and modules in the above system, reference may be made to the corresponding process in the foregoing method embodiments, and details will not be repeated here.
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。In the above-mentioned embodiments, the descriptions of each embodiment have their own emphases, and for parts that are not detailed or recorded in a certain embodiment, refer to the relevant descriptions of other embodiments.
本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。Those skilled in the art can appreciate that the units and algorithm steps of the examples described in conjunction with the embodiments disclosed herein can be implemented by electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are executed by hardware or software depends on the specific application and design constraints of the technical solution. Those skilled in the art may use different methods to implement the described functions for each specific application, but such implementation should not be regarded as exceeding the scope of the present application.
在本申请所提供的实施例中,应该理解到,所揭露的装置/机器人和方法,可以通过其它的方式实现。例如,以上所描述的装置/机器人实施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通讯连接可以是通过一些接口,装置或单元的间接耦合或通讯连接,可以是电性,机械或其它的形式。In the embodiments provided in this application, it should be understood that the disclosed devices/robots and methods may be implemented in other ways. For example, the device/robot embodiments described above are only illustrative. For example, the division of the modules or units is only a logical function division. In actual implementation, there may be other division methods, such as multiple units or Components may be combined or integrated into another system, or some features may be omitted, or not implemented. In another point, the mutual coupling or direct coupling or communication connection shown or discussed may be through some interfaces, and the indirect coupling or communication connection of devices or units may be in electrical, mechanical or other forms.
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place, or may be distributed to multiple network units. Part or all of the units can be selected according to actual needs to achieve the purpose of the solution of this embodiment.
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, each unit may exist separately physically, or two or more units may be integrated into one unit. The above-mentioned integrated units can be implemented in the form of hardware or in the form of software functional units.
所述集成的模块/单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读存储介质中。基于这样的理解,本申请实现上述实施例方法中的全部或部分流程,也可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法实施例的步骤。其中,所述计算机程序包括计算机程序代码,所述计算机程序代码 可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。所述计算机可读存储介质可以包括:能够携带所述计算机程序代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存储器、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、电载波信号、电信信号以及软件分发介质等。需要说明的是,所述计算机可读存储介质包含的内容可以根据司法管辖区内立法和专利实践的要求进行适当的增减,例如在某些司法管辖区,根据立法和专利实践,计算机可读存储介质不包括电载波信号和电信信号。If the integrated module/unit is realized in the form of a software function unit and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, all or part of the processes in the methods of the above embodiments in the present application can also be completed by instructing related hardware through computer programs. The computer programs can be stored in a computer-readable storage medium, and the computer When the program is executed by the processor, the steps in the above-mentioned various method embodiments can be realized. Wherein, the computer program includes computer program code, and the computer program code may be in the form of source code, object code, executable file or some intermediate form. The computer-readable storage medium may include: any entity or device capable of carrying the computer program code, a recording medium, a USB flash drive, a removable hard disk, a magnetic disk, an optical disk, a computer memory, a read-only memory (ROM, Read-Only Memory) ), Random Access Memory (RAM, Random Access Memory), electrical carrier signal, telecommunication signal, and software distribution medium, etc. It should be noted that the content contained in the computer-readable storage medium can be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction. For example, in some jurisdictions, according to legislation and patent practice, computer-readable Storage media excludes electrical carrier signals and telecommunication signals.
以上所述实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围,均应包含在本申请的保护范围之内。The above-described embodiments are only used to illustrate the technical solutions of the present application, rather than to limit them; although the present application has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: it can still implement the foregoing embodiments Modifications to the technical solutions described in the examples, or equivalent replacements for some of the technical features; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the various embodiments of the application, and should be included in the Within the protection scope of this application.

Claims (10)

  1. 一种机器人运动分析方法,其特征在于,包括:A method for robot motion analysis, characterized in that, comprising:
    获取机器人的目标关节在并联构型下的第一关节角度;Obtain the first joint angle of the target joint of the robot in the parallel configuration;
    使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度;所述正运动学分析模型为由预设的第一训练样本集合训练得到的深度学习模型,且所述第一训练样本集合为根据逆运动学分析过程所构建的集合。Use the preset positive kinematics analysis model to process the first joint angle to obtain the second joint angle of the target joint in the series configuration; the forward kinematics analysis model is the first training set by the preset The deep learning model obtained by training the sample set, and the first training sample set is a set constructed according to the inverse kinematics analysis process.
  2. 根据权利要求1所述的机器人运动分析方法,其特征在于,还包括:The robot motion analysis method according to claim 1, further comprising:
    获取所述目标关节的关节运动参数;Acquiring joint motion parameters of the target joint;
    使用预设的逆动力学分析模型对所述目标关节的关节运动参数进行处理,得到所述目标关节的驱动力矩;所述逆动力学分析模型为由预设的第二训练样本集合训练得到的深度学习模型,且所述第二训练样本集合为根据正动力学分析过程所构建的集合。Using a preset inverse dynamics analysis model to process the joint motion parameters of the target joint to obtain the driving torque of the target joint; the inverse dynamics analysis model is obtained by training a preset second training sample set A deep learning model, and the second training sample set is a set constructed according to a positive dynamics analysis process.
  3. 根据权利要求1所述的机器人运动分析方法,其特征在于,在使用预设的正运动学分析模型对所述第一关节角度进行处理之前,还包括:The robot motion analysis method according to claim 1, further comprising: before using a preset forward kinematics analysis model to process the first joint angle:
    确定所述目标关节在串联构型下的运动范围;determining a range of motion of the target joint in a tandem configuration;
    在所述运动范围中选取第一数目的串联关节角度;selecting a first number of serial joint angles in the range of motion;
    根据所述逆运动学分析过程计算与每个串联关节角度分别对应的并联关节角度;calculating parallel joint angles corresponding to each series joint angle according to the inverse kinematics analysis process;
    构建所述第一训练样本集合;所述第一训练样本集合中包括第一数目的训练样本,每个训练样本均包括一组串联关节角度和对应的并联关节角度;Constructing the first training sample set; the first training sample set includes a first number of training samples, each training sample includes a set of series joint angles and corresponding parallel joint angles;
    使用所述第一训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述正运动学分析模型。The first training sample set is used to train the deep learning model in the initial state, and the trained deep learning model is used as the forward kinematics analysis model.
  4. 根据权利要求3所述的机器人运动分析方法,其特征在于,所述深度学习模型为包括第一生成器和第一判别器的生成对抗网络模型;The robot motion analysis method according to claim 3, wherein the deep learning model is a generation confrontation network model comprising a first generator and a first discriminator;
    所述使用所述第一训练样本集合对初始状态的深度学习模型进行训练,包括:The training of the deep learning model of the initial state using the first training sample set includes:
    对于所述第一训练样本集合中的每个训练样本,使用所述第一生成器对该样本的并联关节角度进行处理,得到第一生成结果;For each training sample in the first training sample set, use the first generator to process the parallel joint angle of the sample to obtain a first generation result;
    根据该样本的第一生成结果和串联关节角度,使用所述第一判别器进行模型训练过程。According to the first generation result of the sample and the joint angles in series, the first discriminator is used to perform a model training process.
  5. 根据权利要求2所述的机器人运动分析方法,其特征在于,在使用预设的逆动力学分析模型对所述目标关节的关节运动参数进行处理之前,还包括:The robot motion analysis method according to claim 2, wherein, before using a preset inverse dynamics analysis model to process the joint motion parameters of the target joint, further comprising:
    获取所述目标关节的运动轨迹记录;Acquiring the motion trajectory record of the target joint;
    在所述运动轨迹记录中选取第二数目的运动轨迹点,其中,每个运动轨迹点均包括驱动力矩、关节速度和关节加速度;Selecting a second number of movement trajectory points in the movement trajectory record, wherein each movement trajectory point includes driving torque, joint velocity and joint acceleration;
    根据所述正动力学分析过程计算与每个运动轨迹点分别对应的关节角度;Calculating joint angles corresponding to each motion track point according to the positive dynamics analysis process;
    构建所述第二训练样本集合;所述第二训练样本集合中包括第二数目的训练样本,每个训练样本均包括一组驱动力矩和对应的关节运动参数;关节运动参数包括关节角度、关节速度和关节加速度;Constructing the second training sample set; the second training sample set includes a second number of training samples, each training sample includes a set of driving torque and corresponding joint motion parameters; the joint motion parameters include joint angles, joint motion parameters velocity and joint acceleration;
    使用所述第二训练样本集合对初始状态的深度学习模型进行训练,并将训练后的深度学习模型作为所述逆动力学分析模型。The deep learning model in the initial state is trained by using the second training sample set, and the trained deep learning model is used as the inverse dynamics analysis model.
  6. 根据权利要求5所述的机器人运动分析方法,其特征在于,所述深度学习模型为包括第二生成器和第二判别器的生成对抗网络模型;The robot motion analysis method according to claim 5, wherein the deep learning model is a generation confrontation network model comprising a second generator and a second discriminator;
    所述使用所述第二训练样本集合对初始状态的深度学习模型进行训练,包括:The training of the deep learning model of the initial state using the second training sample set includes:
    对于所述第二训练样本集合中的每个训练样本,使用所述第二生成器对该样本的关节运动参数进行处理,得到第二生成结果;For each training sample in the second training sample set, use the second generator to process the joint motion parameters of the sample to obtain a second generation result;
    根据该样本的第二生成结果和驱动力矩,使用所述第二判别器进行模型训练过程。According to the second generation result of the sample and the driving torque, the second discriminator is used to perform a model training process.
  7. 根据权利要求1至6中任一项所述的机器人运动分析方法,其特征在于,所述使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下 的第二关节角度,包括:The robot motion analysis method according to any one of claims 1 to 6, characterized in that the use of the preset forward kinematics analysis model is used to process the first joint angle to obtain the target joint in series The second joint angle in configuration, including:
    将所述第一关节角度输入至所述正运动学分析模型中进行处理,并将所述正运动学分析模型处理后的输出作为所述第二关节角度。The first joint angle is input into the forward kinematics analysis model for processing, and the processed output of the forward kinematics analysis model is used as the second joint angle.
  8. 一种机器人运动分析装置,其特征在于,包括:A robot motion analysis device is characterized in that it comprises:
    第一关节角度获取模块,用于获取机器人的目标关节在并联构型下的第一关节角度;The first joint angle obtaining module is used to obtain the first joint angle of the target joint of the robot in the parallel configuration;
    正运动学分析模块,用于使用预设的正运动学分析模型对所述第一关节角度进行处理,得到所述目标关节在串联构型下的第二关节角度;所述正运动学分析模型为由预设的第一训练样本集合训练得到的深度学习模型,且所述第一训练样本集合为根据逆运动学分析过程所构建的集合。A forward kinematics analysis module, configured to use a preset forward kinematics analysis model to process the first joint angle to obtain a second joint angle of the target joint in a serial configuration; the forward kinematics analysis model It is a deep learning model trained by a preset first training sample set, and the first training sample set is a set constructed according to an inverse kinematics analysis process.
  9. 一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至7中任一项所述的机器人运动分析方法的步骤。A computer-readable storage medium, the computer-readable storage medium stores a computer program, characterized in that, when the computer program is executed by a processor, the robot motion analysis according to any one of claims 1 to 7 is realized method steps.
  10. 一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至7中任一项所述的机器人运动分析方法的步骤。A robot, comprising a memory, a processor, and a computer program stored in the memory and operable on the processor, characterized in that, when the processor executes the computer program, the computer program according to claims 1 to 7 is realized. The steps of the robot motion analysis method described in any one.
PCT/CN2021/126737 2021-07-20 2021-10-27 Robot motion analysis method and device, readable storage medium, and robot WO2023000529A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110818134.4 2021-07-20
CN202110818134.4A CN113618730B (en) 2021-07-20 2021-07-20 Robot motion analysis method and device, readable storage medium and robot

Publications (1)

Publication Number Publication Date
WO2023000529A1 true WO2023000529A1 (en) 2023-01-26

Family

ID=78380321

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/126737 WO2023000529A1 (en) 2021-07-20 2021-10-27 Robot motion analysis method and device, readable storage medium, and robot

Country Status (2)

Country Link
CN (1) CN113618730B (en)
WO (1) WO2023000529A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116945124A (en) * 2022-04-20 2023-10-27 深圳市普渡科技有限公司 Robot and control method, equipment and medium thereof
CN114770510B (en) * 2022-05-09 2024-02-23 杭州景业智能科技股份有限公司 Kinematic analysis and selection method, device, computer equipment and storage medium

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150094855A1 (en) * 2012-05-04 2015-04-02 Leoni Cia Cable Systems Sas Imitation learning method for a multi-axis manipulator
CN110682273A (en) * 2019-10-09 2020-01-14 中科新松有限公司 Multi-foot support walking robot motion control frame based on parallel mechanism thinking
CN110900598A (en) * 2019-10-15 2020-03-24 合肥工业大学 Robot three-dimensional motion space action simulation learning method and system
CN112959326A (en) * 2021-03-29 2021-06-15 深圳市优必选科技股份有限公司 Method and device for solving positive kinematics of robot, readable storage medium and robot

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102968665B (en) * 2012-12-05 2015-11-25 苏州大学 The positive kinematics method for solving of parallel robot
US10414042B2 (en) * 2015-02-26 2019-09-17 Khalifa University of Science and Technology Parallel mechanism based automated fiber placement system
CN110039548B (en) * 2019-05-31 2021-07-09 中国铁建重工集团股份有限公司 Control method, device and equipment for assembling machine
CN112507474B (en) * 2020-10-29 2023-07-14 北京控制工程研究所 Precision analysis method for space two-degree-of-freedom parallel vector adjustment mechanism

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150094855A1 (en) * 2012-05-04 2015-04-02 Leoni Cia Cable Systems Sas Imitation learning method for a multi-axis manipulator
CN110682273A (en) * 2019-10-09 2020-01-14 中科新松有限公司 Multi-foot support walking robot motion control frame based on parallel mechanism thinking
CN110900598A (en) * 2019-10-15 2020-03-24 合肥工业大学 Robot three-dimensional motion space action simulation learning method and system
CN112959326A (en) * 2021-03-29 2021-06-15 深圳市优必选科技股份有限公司 Method and device for solving positive kinematics of robot, readable storage medium and robot

Also Published As

Publication number Publication date
CN113618730B (en) 2022-09-16
CN113618730A (en) 2021-11-09

Similar Documents

Publication Publication Date Title
Liu et al. Grasping posture of humanoid manipulator based on target shape analysis and force closure
WO2023000529A1 (en) Robot motion analysis method and device, readable storage medium, and robot
Qi et al. Multi-sensor guided hand gesture recognition for a teleoperated robot using a recurrent neural network
US11565407B2 (en) Learning device, learning method, learning model, detection device and grasping system
CN107256284B (en) Real-time interactive multi-gait dynamics modeling method and system for quadruped robot
US10471594B2 (en) Systems, devices, and methods for the distribution and collection of multimodal data associated with robots
CN112070207A (en) Model training method and device
EP3281072A1 (en) Automated collection and labeling of object data
EP3862830A1 (en) Learning device, control device, learning method, and learning program
CN112633059B (en) Fall remote monitoring system based on LabVIEW and MATLAB
WO2024094227A1 (en) Gesture pose estimation method based on kalman filtering and deep learning
CN114417738B (en) Sparse IMU real-time human body motion capture and joint stress prediction method and system
Zhao et al. A learning-based multiscale modelling approach to real-time serial manipulator kinematics simulation
WO2022105023A1 (en) Robot control method and apparatus, and computer readable storage medium, and robot
Zheng et al. An object recognition grasping approach using proximal policy optimization with yolov5
Akande et al. A Review of Generative Models for 3D Vehicle Wheel Generation and Synthesis
CN115620082B (en) Model training method, head posture estimation method, electronic device, and storage medium
Li et al. 3D hand reconstruction from a single image based on biomechanical constraints
CN116206728A (en) Rehabilitation training method and system based on sensor fusion and transfer learning
Wang et al. Design and implementation of virtual reality interactive product software based on artificial intelligence deep learning algorithm
CN114536351A (en) Redundant double-arm robot teaching method and device, electronic equipment and system
Sun Dance training movement depth information recognition based on artificial intelligence
Nasri et al. ROS-based autonomous navigation wheelchair using omnidirectional sensor
CN114025153B (en) LiDAR assisted wheel encoder to camera calibration
CN112129272A (en) Method and device for realizing visual odometer

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: 21950767

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE