CN113103239A - Robot attitude trajectory generation method and device and storage medium - Google Patents

Robot attitude trajectory generation method and device and storage medium Download PDF

Info

Publication number
CN113103239A
CN113103239A CN202110472860.5A CN202110472860A CN113103239A CN 113103239 A CN113103239 A CN 113103239A CN 202110472860 A CN202110472860 A CN 202110472860A CN 113103239 A CN113103239 A CN 113103239A
Authority
CN
China
Prior art keywords
quaternion
robot
curve
postures
sampling
Prior art date
Legal status (The legal status 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 status listed.)
Granted
Application number
CN202110472860.5A
Other languages
Chinese (zh)
Other versions
CN113103239B (en
Inventor
闵康
倪风雷
舒鑫
张国军
刘宏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN202110472860.5A priority Critical patent/CN113103239B/en
Publication of CN113103239A publication Critical patent/CN113103239A/en
Application granted granted Critical
Publication of CN113103239B publication Critical patent/CN113103239B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)

Abstract

The invention provides a robot gesture track generation method, a device and a storage medium, wherein the method comprises the following steps: acquiring a plurality of quaternion postures in the robot motion process, and grouping all the postures; determining a first quaternion corresponding to each group of quaternion postures according to the grouping result; converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier curve to obtain an interpolation curve; sampling the interpolation curve to obtain a plurality of sampling points; and fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track. The technical scheme of the invention can generate the gesture track of the whole C2 continuous robot, and reduce the track fluctuation among the gestures of the robot.

Description

Robot attitude trajectory generation method and device and storage medium
Technical Field
The invention relates to the technical field of intelligent control, in particular to a robot posture trajectory generation method and device and a storage medium.
Background
When the tail end gesture track of the robot is sufficiently smooth, the track tracking performance of the robot can be improved. At present, the attitude of the robot is often described by a rotation matrix, an Euler angle, an RPY (Roll-Pitch-Yaw), a quaternion and the like, wherein when the attitude planning is carried out by utilizing the rotation matrix, the data redundancy is high, and the orthogonality of the data is directly damaged; the singularity exists when the posture is expressed by an RPY method; when the attitude is expressed by the Euler angle, the phenomenon of dead locking of the universal joint can occur, interpolation is difficult, and the requirements on smoothness and continuity in robot attitude planning cannot be well met.
The quaternion is widely applied due to the advantages of simple and visual description, small calculated amount and the like, when the robot posture is described, the problem of dead locking of a universal joint generated when an Euler angle rotates can be effectively solved, and the posture interpolation efficiency is higher than that based on the Euler angle and a rotation matrix. When the robot attitude is described by using quaternions, the quaternion attitude interpolation method mainly comprises quaternion linear interpolation, spherical linear interpolation and spherical spline interpolation.
However, the spherical linear interpolation has only C0 continuity, and the spherical spline interpolation also has only C1 continuity, and thus cannot meet the actual requirement. In order to obtain a quaternion spline curve with higher continuity, the prior art provides a quaternion spline curve with C2 continuity, which can meet the requirement of C2 continuity, but the adopted model is too complex, the track fluctuation is large, the mathematical model is complex, and the understanding is difficult.
Disclosure of Invention
The invention solves the problem of reducing the track fluctuation among the postures of the robot when the posture track of the robot meets the continuous requirement of C2.
In order to solve the above problems, the present invention provides a method, an apparatus, and a storage medium for generating a robot gesture trajectory.
In a first aspect, the present invention provides a method for generating a robot pose trajectory, including:
acquiring a plurality of quaternion postures in the robot motion process, and grouping all the quaternion postures;
determining a first quaternion corresponding to each group of quaternion postures according to grouping results;
converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier curve to obtain an interpolation curve;
sampling the interpolation curve for multiple times to obtain multiple sampling points;
and fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track.
Optionally, the grouping all the quaternion poses comprises:
and sequentially grouping every three quaternion postures into one group according to the action sequence of the robot, wherein every two adjacent groups comprise the same quaternion posture, and when the number of the remaining quaternion postures is less than three, dividing every two remaining quaternion postures into one group.
Optionally, the determining, according to the grouping result, a first quaternion corresponding to each group of quaternion attitudes includes:
for a group of three quaternion attitudes, determining a transformation matrix between two adjacent quaternion attitudes, and respectively converting the two obtained transformation matrices into the first quaternion;
and for the two quaternion attitudes which are in a group, keeping the quaternion attitudes unchanged, wherein the two quaternion attitudes respectively correspond to one first quaternion.
Optionally, the converting the first quaternion corresponding to each group into a plurality of vectors in three-dimensional space, and interpolating each vector by using a cubic bezier curve includes:
converting the two quaternions corresponding to each set of quaternion attitudes into three first unit vectors of a three-dimensional space, wherein each unit vector corresponds to a first data point;
and for each group of three first data points, performing interpolation by using a cubic Bezier curve, wherein the interpolation curve between the first data points is generated by solving two middle control points of the cubic Bezier curve, wherein the first data point in the motion direction of the robot in the three first data points is a first control point of the cubic Bezier curve, the third first data point is a last control point of the cubic Bezier curve, and the second first data point is a point on the cubic Bezier curve.
Optionally, the sampling the interpolation curve multiple times, and obtaining multiple sampling points includes:
and sequentially sampling the interpolation curve for multiple times, and converting each sampling point obtained by sampling into a second quaternion respectively.
Optionally, the fitting all the sampling points by using a cubic B-spline curve comprises:
for the second quaternion corresponding to each sampling point, establishing a mapping relation between the second quaternion and a second unit vector, and converting the second quaternion into the second unit vector according to the mapping relation, wherein each second unit vector corresponds to one second data point;
and fitting all the second data points by adopting a cubic B-spline curve to generate the robot posture track.
In a second aspect, the present invention provides a robot posture trajectory generation apparatus, including:
the acquisition module is used for acquiring a plurality of quaternion postures in the motion process of the robot and grouping all the quaternion postures;
the grouping module is used for determining a first quaternion corresponding to each group of quaternion postures according to the grouping result;
the interpolation module is used for converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier curve to obtain an interpolation curve;
the sampling module is used for sampling the interpolation curve for multiple times to obtain multiple sampling points;
and the fitting module is used for fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track.
In a third aspect, the present invention provides an electronic device, including a memory and a processor;
the memory for storing a computer program;
the processor is configured to implement the robot pose trajectory generation method as described above when executing the computer program.
In a fourth aspect, the present invention provides a computer-readable storage medium having stored thereon a computer program, which, when executed by a processor, implements the robot pose trajectory generation method as described above.
The robot posture track generation method, the robot posture track generation device and the storage medium have the beneficial effects that: the method comprises the steps of obtaining a plurality of quaternion postures in the robot motion process, grouping the quaternion postures, calculating quaternion corresponding to each group of quaternion postures according to grouping results, and ensuring that each group corresponds to two quaternion. And then interpolating by adopting a cubic Bezier curve interpolation algorithm to generate an interpolation curve between quaternion postures, sampling for multiple times on the interpolation curve to obtain multiple sampling points, and fitting all the sampling points by adopting a cubic B spline curve fitting algorithm to generate a continuous robot posture track of the whole C2. Meanwhile, the technical scheme of the invention can reduce the track fluctuation among the postures of the robot and improve the smoothness of the track.
Drawings
Fig. 1 is a schematic flow chart of a robot posture trajectory generation method according to an embodiment of the present invention;
FIG. 2 is a schematic diagram of a cubic Bezier curve according to another embodiment of the present invention;
fig. 3 is a schematic structural diagram of a robot pose trajectory generation device according to an embodiment of the present invention.
Detailed Description
In order to make the aforementioned objects, features and advantages of the present invention comprehensible, embodiments accompanied with figures are described in detail below.
It should be noted that the terms "first," "second," and the like in the description and claims of the present invention and in the drawings described above are used for distinguishing between similar elements and not necessarily for describing a particular sequential or chronological order. It is to be understood that the data so used is interchangeable under appropriate circumstances such that the embodiments of the invention described herein are capable of operation in sequences other than those illustrated or described herein.
As shown in fig. 1, an embodiment of the present invention provides a robot pose trajectory generation method, including:
and step S110, acquiring a plurality of quaternion postures in the motion process of the robot, and grouping all the quaternion postures.
In particular, the quaternion pose represents a quaternion representation of the robot pose.
Step S120, determining quaternions corresponding to the quaternion postures of each group according to grouping results;
step S130, converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier (Bezier) curve to obtain an interpolation curve;
step S140, sampling the interpolation curve for multiple times to obtain multiple sampling points;
and S150, fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track.
In this embodiment, a plurality of quaternion attitudes in the robot motion process are obtained, the quaternion attitudes are grouped, quaternion corresponding to each group of quaternion attitudes is calculated according to the grouping result, and it is ensured that each group corresponds to two quaternion. And then interpolating by adopting a cubic Bezier curve interpolation algorithm to generate an interpolation curve between quaternion postures, sampling for multiple times on the interpolation curve to obtain multiple sampling points, and fitting all the sampling points by adopting a cubic B spline curve fitting algorithm to generate a continuous robot posture track of the whole C2. Meanwhile, the technical scheme of the invention can reduce the track fluctuation among the postures of the robot and improve the smoothness of the posture track. The gesture track has more definite physical significance and is beneficial to popularization and application.
Optionally, the grouping all the quaternion poses comprises:
and sequentially grouping every three quaternion postures into one group according to the action sequence of the robot, wherein every two adjacent groups comprise the same quaternion posture, and when the number of the remaining quaternion postures is less than three, dividing every two remaining quaternion postures into one group.
Specifically, assuming that the quaternion postures are A, B, C, D and E respectively in sequence according to the motion sequence of the robot, the quaternion postures can be divided into two groups, one group is A, B, C, the other group is C, D, E, the two groups include the same quaternion posture C, if the quaternion postures are A, B, C and D respectively in sequence, after A, B and C are first divided into one group, only one D is left, and the common C is added, and only two quaternion postures are left, the two quaternion postures C and D are used as one group.
Optionally, the determining, according to the grouping result, a first quaternion corresponding to each group of quaternion attitudes includes:
and determining a transformation matrix between two adjacent quaternion attitudes for a group of three quaternion attitudes, and then converting the two transformation matrices into the first quaternion respectively.
Specifically, the quaternion posture is a posture in the robot action process, when three quaternion postures are in a group, the three quaternion postures are firstly converted into three posture matrixes respectively, and if the three posture matrixes are R respectivelyi-1,,Ri,,Ri+1Then determining a transformation matrix between two adjacent attitude matrices and finally converting the transformation matrix into a first quaternion, e.g.
Figure BDA0003046171510000061
Wherein R isi+1Ri -1Is an attitude matrix Ri,Ri+1F denotes a transformation matrix to a first quaternionOf a mapping relationship, QiRepresenting a first quaternion. Respectively converting the two transformation matrixes into first quaternions to obtain two first quaternions Qi,Qi+1
And for the two quaternion attitudes which are in a group, keeping the quaternion attitudes unchanged, wherein the quaternion corresponding to the two quaternion attitudes is the first quaternion.
In this optional embodiment, when each group includes three quaternion attitudes, the first quaternion represents a transformation relationship between attitude matrices corresponding to the three quaternion attitudes, and when each group includes two quaternion attitudes, the first quaternion represents a transformation relationship between two quaternion attitudes from the base coordinate system.
Optionally, the converting the first quaternion corresponding to each group into a plurality of vectors in three-dimensional space, and interpolating each vector by using a cubic bezier curve includes:
converting the two first quaternions corresponding to each set of quaternion attitudes into three first unit vectors of a three-dimensional space, wherein each first unit vector corresponds to a first data point;
and for each group of three first data points, performing interpolation by using a cubic Bezier curve, wherein the interpolation curve between the quaternion attitudes is generated by solving two middle control points of the cubic Bezier curve, wherein the first data point in the motion direction of the robot in the three first data points is a first control point of the cubic Bezier curve, the third first data point is a last control point of the cubic Bezier curve, and the second first data point is positioned on the cubic Bezier curve.
In particular, since the unit quaternion can be expressed as the product of two three-dimensional unit vectors, and the two vectors follow the quaternion multiplication law, assume two first quaternions Q corresponding to an arbitrary set of quaternion posesi-1,QiTwo first quaternions Q are expressed by a first formulai-1,QiThe first formula includes:
Figure BDA0003046171510000062
Figure BDA0003046171510000063
then the process of the first step is carried out,
Figure BDA0003046171510000071
and the combination of (a) and (b),
Figure BDA0003046171510000072
where there are 9 unknowns and 9 equations, a unique set of first unit vectors can be found
Figure BDA0003046171510000073
Figure BDA0003046171510000074
Each first unit vector corresponds to a data point.
As shown in fig. 2, a cubic bezier curve is then used for interpolation:
defining a cubic Bezier curve over the interval [0,1] using a second formula comprising:
Figure BDA0003046171510000075
wherein, B0,3(t)=(1-t)3,B1,3(t)=3t(1-t)2,
B2,3(t)=3t2(1-t),B3,3(t)=t3
Figure BDA0003046171510000076
For 4 control points, assume
Figure BDA0003046171510000077
The starting point of the cubic Bezier curve is s0I.e. b0=s0End point is s2I.e. b3=s2And the cubic Bezier curve passes through s1
Then s is determined using a third formula1Corresponding parameter t1The third formula includes:
Figure BDA0003046171510000078
a parameter t1Substituting into the second formula of cubic Bezier curve, and s (t)1)=s1Solving a control point b of the cubic Bezier curve1、b2And then obtaining a cubic Bezier curve
Figure BDA0003046171510000079
Cubic Bezier curve
Figure BDA00030461715100000710
I.e. the interpolation curve, passes through s in fig. 20、s1And s2The curve of (d) is the interpolation curve.
A fourth formula may be employed to convert points on a cubic Bezier curve to a second quaternion, the fourth formula including:
Figure BDA00030461715100000711
wherein q (t) represents a second quaternion,
Figure BDA00030461715100000712
a cubic Bezier curve is shown,
Figure BDA00030461715100000713
is a unit vector.
Optionally, the sampling the interpolation curve multiple times, and obtaining multiple sampling points includes:
and sequentially sampling the interpolation curve for multiple times, and converting each sampling point obtained by sampling into a second quaternion respectively.
Specifically, cubic Bezier curves are sequentially aligned
Figure BDA00030461715100000714
And sampling to obtain a plurality of sampling points, wherein the sampling points are all represented by the second quaternion because the points on the cubic Bezier curve are converted into the second quaternion.
Optionally, the fitting all the sampling points by using a cubic B-spline curve comprises:
for the second quaternion corresponding to each sampling point, the second quaternion can be expressed as
Figure BDA0003046171510000081
Figure BDA0003046171510000082
Wherein q isi0、qi1、qi2And q isi3In the case of a real number,
Figure BDA0003046171510000083
and
Figure BDA0003046171510000084
in units of imaginary numbers.
Establishing the second quaternion QiAnd a second unit vector Qi' mapping relationship Q betweeni→Qi′,
Figure BDA0003046171510000085
Wherein q isi0≠0;
Converting the second quaternion into the second unit vectors according to the mapping relation, wherein each second unit vector corresponds to a second data point;
and fitting all the second data points by adopting a cubic B-spline curve to generate the robot posture track.
Specifically, fitting all the second data points by using the cubic B-spline curve comprises performing back calculation on a group of second data points on the curve to define a control vertex of the B-spline curve, and determining the cubic B-spline curve, namely the robot attitude trajectory. The determination of the control points of the cubic B-spline curve from the data points is known in the art, for example, see "journal of the university of post and telecommunications" paper 19, vol.3, a simple method for cubic B-spline back calculation ", which is not described herein again.
In this optional embodiment, the interpolation curve is sampled to obtain a plurality of sampling points, and then all the sampling points are fitted through cubic B-spline curve fitting algorithm, so that a whole C2 continuous robot attitude track can be obtained, wherein the robot attitude track speed and the acceleration are continuous, the smoothness of the robot motion is ensured, and compared with the prior art, the fluctuation of the generated robot attitude track is reduced, and the physical significance of the robot attitude track is more definite.
As shown in fig. 3, an embodiment of the present invention provides a robot pose trajectory generating apparatus, configured to execute the robot pose trajectory generating method described above, including:
the acquisition module is used for acquiring a plurality of quaternion postures in the motion process of the robot and grouping all the quaternion postures;
the grouping module is used for determining a first quaternion corresponding to each group of quaternion postures according to the grouping result, wherein each group of quaternion postures corresponds to two first quaternions;
the interpolation module is used for converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier curve to obtain an interpolation curve;
the sampling module is used for sampling the interpolation curve for multiple times to obtain multiple sampling points;
and the fitting module is used for fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track.
Another embodiment of the present invention provides an electronic device comprising a memory and a processor; the memory for storing a computer program; the processor is configured to implement the robot pose trajectory generation method as described above when executing the computer program. The device may be a computer or a server, etc.
Yet another embodiment of the present invention provides a computer program stored on a computer-readable storage medium, which when executed by a processor, implements the robot pose trajectory generation method as described above.
It will be understood by those skilled in the art that all or part of the processes of the methods of the embodiments described above can be implemented by a computer program, which can be stored in a computer-readable storage medium, and when executed, can include the processes of the embodiments of the methods described above. The storage medium may be a magnetic disk, an optical disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), or the like. In this application, the units described as separate parts may or may not be physically separate, and parts displayed as units may or may not be physical units, may be located in one place, or may be distributed on a plurality of network units. Some or all of the units can be selected according to actual needs to achieve the purpose of the solution of the embodiment of the present invention. In addition, functional units in the embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units are integrated into one unit. The integrated unit can be realized in a form of hardware, and can also be realized in a form of a software functional unit.
Although the present disclosure has been described above, the scope of the present disclosure is not limited thereto. Various changes and modifications may be effected therein by one of ordinary skill in the pertinent art without departing from the spirit and scope of the present disclosure, and these changes and modifications are intended to be within the scope of the present disclosure.

Claims (9)

1. A robot posture trajectory generation method is characterized by comprising the following steps:
acquiring a plurality of quaternion postures in the robot motion process, and grouping all the quaternion postures;
determining a first quaternion corresponding to each group of quaternion postures according to the grouping result;
converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier curve to obtain an interpolation curve;
sampling the interpolation curve to obtain a plurality of sampling points;
and fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track.
2. The robot pose trajectory generation method of claim 1, wherein the grouping all of the quaternion poses comprises:
and sequentially grouping every three quaternion postures into one group according to the action sequence of the robot, wherein every two adjacent groups comprise the same quaternion posture, and when the number of the remaining quaternion postures is less than three, dividing every two remaining quaternion postures into one group.
3. The method of claim 2, wherein determining the first quaternion corresponding to each group of quaternion poses according to the grouping result comprises:
for a group of three quaternion attitudes, determining a transformation matrix between two adjacent quaternion attitudes, and respectively converting the two obtained transformation matrices into the first quaternion;
and for the two quaternion attitudes which are in a group, keeping the quaternion attitudes unchanged, wherein the two quaternion attitudes respectively correspond to one first quaternion.
4. A robot pose trajectory generation method according to any of claims 1 to 3, wherein said converting each set of corresponding first quaternions into a plurality of vectors in three-dimensional space and interpolating each of said vectors using cubic bezier curves comprises:
converting each set of two corresponding first quaternions into three first unit vectors of a three-dimensional space, each first unit vector corresponding to one first data point;
and for each group of three first data points, performing interpolation by using a cubic Bezier curve, wherein the interpolation curve between the first data points is generated by solving two middle control points of the cubic Bezier curve, wherein the first data point in the motion direction of the robot in the three first data points is the first control point of the cubic Bezier curve, the third first data point is the last control point of the cubic Bezier curve, and the second first data point is positioned on the cubic Bezier curve.
5. The method of claim 4, wherein the sampling the interpolation curve to obtain a plurality of sampling points comprises:
and sequentially sampling the interpolation curve for multiple times, and converting each sampling point obtained by sampling into a second quaternion respectively.
6. The robot pose trajectory generation method of claim 5, wherein the fitting all the sample points with a cubic B-spline curve comprises:
for the second quaternion corresponding to each sampling point, establishing a mapping relation between the second quaternion and a second unit vector, and converting the second quaternion into the second unit vector according to the mapping relation, wherein each second unit vector corresponds to one second data point;
and fitting all the second data points by adopting a cubic B-spline curve to generate the robot posture track.
7. A robot pose trajectory generation apparatus, comprising:
the acquisition module is used for acquiring a plurality of quaternion postures in the motion process of the robot and grouping all the quaternion postures;
the grouping module is used for determining a first quaternion corresponding to each group of quaternion postures according to the grouping result;
the interpolation module is used for converting the first quaternion corresponding to each group into a plurality of vectors of three-dimensional space, and interpolating each vector by adopting a cubic Bezier curve to obtain an interpolation curve;
the sampling module is used for sampling the interpolation curve for multiple times to obtain multiple sampling points;
and the fitting module is used for fitting all the sampling points by adopting a cubic B-spline curve to generate a robot attitude track.
8. An electronic device comprising a memory and a processor;
the memory for storing a computer program;
the processor, configured to, when executing the computer program, implement the robot pose trajectory generation method of any of claims 1 to 6.
9. A computer-readable storage medium, characterized in that the storage medium has stored thereon a computer program which, when being executed by a processor, carries out a robot pose trajectory generation method according to any one of claims 1 to 6.
CN202110472860.5A 2021-04-29 2021-04-29 Robot attitude trajectory generation method and device and storage medium Active CN113103239B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110472860.5A CN113103239B (en) 2021-04-29 2021-04-29 Robot attitude trajectory generation method and device and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110472860.5A CN113103239B (en) 2021-04-29 2021-04-29 Robot attitude trajectory generation method and device and storage medium

Publications (2)

Publication Number Publication Date
CN113103239A true CN113103239A (en) 2021-07-13
CN113103239B CN113103239B (en) 2022-09-13

Family

ID=76720378

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110472860.5A Active CN113103239B (en) 2021-04-29 2021-04-29 Robot attitude trajectory generation method and device and storage medium

Country Status (1)

Country Link
CN (1) CN113103239B (en)

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101738984A (en) * 2009-12-23 2010-06-16 哈尔滨工业大学 Quaternion-based five-coordinate spline interpolation control method
US20140278217A1 (en) * 2013-03-15 2014-09-18 Invensense, Inc. Method to reduce data rates and power consumption using device based attitude quaternion generation
CN105773620A (en) * 2016-04-26 2016-07-20 南京工程学院 Track planning and control method of free curve of industrial robot based on double quaternions
CN107030697A (en) * 2017-04-28 2017-08-11 广州大学 A kind of planing method of robot cartesian space smooth track
CN107214702A (en) * 2017-06-29 2017-09-29 中国科学院自动化研究所 The method and system for planning of robot trajectory is determined using virtual reality handle
CN108568817A (en) * 2018-03-13 2018-09-25 同济大学 A kind of Delta robot trajectories connection control method based on Bezier
CN108664124A (en) * 2018-05-08 2018-10-16 北京奇艺世纪科技有限公司 A kind of control method and device based on attitude information
CN108804391A (en) * 2018-04-27 2018-11-13 湖南农业大学 A kind of building method and system of interpolation curve or curved surface based on B-spline
DE102018124211A1 (en) * 2017-10-06 2019-04-11 Nvidia Corporation Learning-based camera pose estimation of images of an environment
US20200055192A1 (en) * 2018-08-16 2020-02-20 Hehua Ju Axis-Invariant based Multi-axis robot inverse kinematics modeling and solving method
CN111791236A (en) * 2020-07-17 2020-10-20 广东拓斯达科技股份有限公司 Industrial robot Cartesian space trajectory transition method
CN111966954A (en) * 2020-08-18 2020-11-20 北京理工大学 Large-attitude quaternion full-angle domain Euler angle conversion method
CN112223290A (en) * 2020-10-21 2021-01-15 哈工大机器人(合肥)国际创新研究院 Joint space continuous point track transition method and device
CN112356032A (en) * 2020-11-05 2021-02-12 哈工大机器人(合肥)国际创新研究院 Posture smooth transition method and system

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101738984A (en) * 2009-12-23 2010-06-16 哈尔滨工业大学 Quaternion-based five-coordinate spline interpolation control method
US20140278217A1 (en) * 2013-03-15 2014-09-18 Invensense, Inc. Method to reduce data rates and power consumption using device based attitude quaternion generation
CN105773620A (en) * 2016-04-26 2016-07-20 南京工程学院 Track planning and control method of free curve of industrial robot based on double quaternions
CN107030697A (en) * 2017-04-28 2017-08-11 广州大学 A kind of planing method of robot cartesian space smooth track
CN107214702A (en) * 2017-06-29 2017-09-29 中国科学院自动化研究所 The method and system for planning of robot trajectory is determined using virtual reality handle
DE102018124211A1 (en) * 2017-10-06 2019-04-11 Nvidia Corporation Learning-based camera pose estimation of images of an environment
CN108568817A (en) * 2018-03-13 2018-09-25 同济大学 A kind of Delta robot trajectories connection control method based on Bezier
CN108804391A (en) * 2018-04-27 2018-11-13 湖南农业大学 A kind of building method and system of interpolation curve or curved surface based on B-spline
CN108664124A (en) * 2018-05-08 2018-10-16 北京奇艺世纪科技有限公司 A kind of control method and device based on attitude information
US20200055192A1 (en) * 2018-08-16 2020-02-20 Hehua Ju Axis-Invariant based Multi-axis robot inverse kinematics modeling and solving method
CN111791236A (en) * 2020-07-17 2020-10-20 广东拓斯达科技股份有限公司 Industrial robot Cartesian space trajectory transition method
CN111966954A (en) * 2020-08-18 2020-11-20 北京理工大学 Large-attitude quaternion full-angle domain Euler angle conversion method
CN112223290A (en) * 2020-10-21 2021-01-15 哈工大机器人(合肥)国际创新研究院 Joint space continuous point track transition method and device
CN112356032A (en) * 2020-11-05 2021-02-12 哈工大机器人(合肥)国际创新研究院 Posture smooth transition method and system

Non-Patent Citations (10)

* Cited by examiner, † Cited by third party
Title
PHAM, HL: "Set-point control of robot end-effector pose using dual quaternion feedback", 《ROBOTICS AND COMPUTER-INTEGRATED MANUFACTURING》 *
SALMERON-QUIROZ BERNARDINO BENITO: "ESTIMATION OF ATTITUDE VIA QUATERNION IN AN INDUSTRIAL ROBOT", 《2012 IEEE INTERNATIONAL CONFERENCE ON TECHNOLOGIES FOR PRACTICAL ROBOT APPLICATIONS 》 *
XIE, ZW: "Robot learning from demonstration for path planning: A review", 《SCIENCE CHINA-TECHNOLOGICAL SCIENCES》 *
YANG LIU: "Trajectory planning of robot manipulators based on unit quaternion", 《2017 IEEE INTERNATIONAL CONFERENCE ON ADVANCED INTELLIGENT MECHATRONICS (AIM)》 *
乔正: "基于四元数的手术机器人圆弧轨迹规划", 《机械与电子》 *
倪晓伟: "一种高效的机器人自由曲线运动位姿同步规划方法", 《机床与液压》 *
普亚松: "基于对数四元数的工业机器人Hermite样条曲线姿态插值", 《西北工业大学学报》 *
王效杰: "基于四元数样条曲线的姿态轨迹规划研究", 《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》 *
谢文雅: "基于四元数的工业机器人姿态规划与插补算法的研究", 《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》 *
郭闯强: "多目标位姿约束下空间机器人载体姿态扰动优化", 《空间科学学报》 *

Also Published As

Publication number Publication date
CN113103239B (en) 2022-09-13

Similar Documents

Publication Publication Date Title
EP4068150A1 (en) Hand key point detection method, gesture recognition method, and related devices
EP3944200B1 (en) Facial image generation method and apparatus, device and storage medium
CN112614213B (en) Facial expression determining method, expression parameter determining model, medium and equipment
CN108898630A (en) A kind of three-dimensional rebuilding method, device, equipment and storage medium
CN112819947A (en) Three-dimensional face reconstruction method and device, electronic equipment and storage medium
CN109732593B (en) Remote control method and device for robot and terminal equipment
CN107545242B (en) Method and device for deducing human body action posture through 2D image
JP2006268188A (en) Curved surface generation method, program, and three-dimensional shape processor
CN113298870B (en) Object posture tracking method and device, terminal equipment and storage medium
CN111709268B (en) Human hand posture estimation method and device based on human hand structure guidance in depth image
CN111868738B (en) Cross-device monitoring computer vision system
CN116977522A (en) Rendering method and device of three-dimensional model, computer equipment and storage medium
CN111709270A (en) Three-dimensional shape recovery and attitude estimation method and device based on depth image
CN112966390B (en) Method and apparatus for garment processing based on dual three-dimensional distance fields
CN107481319B (en) Hidden surface random point cloud generator
Wu et al. Correspondence matching and time delay estimation for hand-eye calibration
Song et al. Distortion-free robotic surface-drawing using conformal mapping
CN113103239B (en) Robot attitude trajectory generation method and device and storage medium
CN106408654B (en) A kind of creation method and system of three-dimensional map
CN111932628A (en) Pose determination method and device, electronic equipment and storage medium
Xin et al. Visual servoing of unknown objects for family service robots
CN115648177A (en) Method and device for determining parallel robot postures based on inverse kinematics
CN113012268B (en) Method, system, device and medium for dynamic motion of static pedestrian image
CN118163118B (en) Visual and tactile fusion display method, device and system and robot control method, device and system
WO2023179091A1 (en) Three-dimensional model rendering method and apparatus, and device, storage medium and program product

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant