[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN110561421B - Mechanical arm indirect dragging demonstration method and device - Google Patents

Mechanical arm indirect dragging demonstration method and device Download PDF

Info

Publication number
CN110561421B
CN110561421B CN201910733315.XA CN201910733315A CN110561421B CN 110561421 B CN110561421 B CN 110561421B CN 201910733315 A CN201910733315 A CN 201910733315A CN 110561421 B CN110561421 B CN 110561421B
Authority
CN
China
Prior art keywords
teaching
trajectory
plane
motion unit
dynamic motion
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.)
Active
Application number
CN201910733315.XA
Other languages
Chinese (zh)
Other versions
CN110561421A (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 Shenzhen
Original Assignee
Harbin Institute of Technology Shenzhen
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 Shenzhen filed Critical Harbin Institute of Technology Shenzhen
Priority to CN201910733315.XA priority Critical patent/CN110561421B/en
Publication of CN110561421A publication Critical patent/CN110561421A/en
Application granted granted Critical
Publication of CN110561421B publication Critical patent/CN110561421B/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/0081Programme-controlled manipulators with leader teach-in means
    • 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
    • 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

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)
  • Numerical Control (AREA)

Abstract

本发明公开了机械臂间接拖动示教方法及装置。涉及机器人控制领域,其中,方法通过在示教平面进行多次平面示教得到示教平面轨迹,对示教平面轨迹执行动态运动单元表达过程,选取新的轨迹起始点和轨迹目标点,根据动态运动单元表达过程对示教平面轨迹进行轨迹泛化,并结合接触力控制过程得到接触面的示教轨迹。通过动态运动单元表达结合接触力控制过程实现机械臂的平面示教学习和接触面上的示教轨迹生成,无需在接触面上进行拖动示教,同时实现接触力控制,解决了直接示教技术无法生成操作者无法到达的操作对象上示教轨迹的问题。

Figure 201910733315

The invention discloses a teaching method and device for indirect dragging of a mechanical arm. It relates to the field of robot control, wherein the method obtains a teaching plane trajectory by performing multiple plane teaching on the teaching plane, performs a dynamic motion unit expression process on the teaching plane trajectory, selects a new trajectory starting point and a trajectory target point, and according to the dynamic The motion unit expression process generalizes the teaching plane trajectory, and combines the contact force control process to obtain the teaching trajectory of the contact surface. Through the dynamic motion unit expression combined with the contact force control process, the plane teaching learning of the manipulator and the teaching trajectory generation on the contact surface are realized. There is no need to drag and teach on the contact surface, and the contact force control is realized at the same time, which solves the problem of direct teaching. The problem is that the technology cannot generate the teaching trajectory on the operation object that the operator cannot reach.

Figure 201910733315

Description

Mechanical arm indirect dragging demonstration method and device
Technical Field
The invention relates to the field of robot control, in particular to a method and a device for teaching indirect dragging of a mechanical arm.
Background
The mechanical arm of the robot has the advantages of high precision, good safety, good man-machine interaction and the like, and is mainly used for man-machine cooperative work occasions. Generally, the mechanical arm needs to be manually dragged to a working position, the position is recorded, dragging teaching is achieved, the mechanical arm can move according to the expectation of an operator through a direct dragging teaching technology, and the mechanical arm has the advantages of being simple to operate, high in precision, strong in collaboration and the like. However, the direct-dragging teaching technology has limitations, and for some occasions where operators cannot reach or occasions where accurate track and force tracking are required, the use process is limited, the requirements of specified operation under complex working conditions are difficult to meet, and the direct-dragging teaching technology cannot achieve accurate teaching. Therefore, a teaching method for indirectly dragging the mechanical arm with a wide application range is needed.
Disclosure of Invention
The present invention is directed to solving, at least to some extent, one of the technical problems in the related art. Therefore, the invention aims to provide the teaching method for the indirect mechanical arm dragging, which has a wide application range.
The technical scheme adopted by the invention is as follows:
in a first aspect, the present invention provides a method for teaching indirect arm dragging, including:
performing plane teaching on a teaching plane for multiple times to obtain a teaching plane track;
executing a dynamic motion unit expression process on the teaching plane trajectory;
and selecting a new track starting point and a new track target point, carrying out track generalization on the teaching plane track according to the dynamic motion unit expression process, and obtaining the teaching track of the contact surface by combining with the contact force control process.
Further, obtaining the teaching trajectory plane further includes: and smoothing the teaching plane track to obtain a smooth teaching track.
Further, a Gaussian mixture model and Gaussian mixture regression are adopted to realize the smoothing processing.
Further, the dynamic motion unit expression process refers to: the teaching plane track is expressed by using a dynamic motion unit, and specifically comprises the following steps:
Figure BDA0002161350670000021
wherein x, v,
Figure BDA0002161350670000022
Respectively representing the position vector, the velocity vector and the acceleration vector, x of the track point in the teaching plane track0And the vector of the position of the starting point of the teaching plane track is shown, g is the vector of the position of the target point of the teaching plane track, f is a forcing function, and both tau and K, D are constants.
Further, the forcing function is specifically:
Figure BDA0002161350670000023
ψi(s)=exp(-hi(s-μi)2)
wherein s denotes a phase variable, #i(s) represents the center and width respectively are muiAnd hiGaussian of ωiRepresenting dynamic motion unit weights, N tableThe number of gaussian basis functions is shown.
Further, the track generalization process specifically includes:
selecting a new track starting point and a new track target point;
obtaining a contact force of the tail end of the mechanical arm and the contact surface, wherein the contact force is smaller than a force error threshold;
and generating a teaching track of the contact surface according to the dynamic motion unit expression process and the contact force.
Further, the end of the mechanical arm is perpendicular to the contact surface.
In a second aspect, the present invention further provides an indirect arm drag teaching apparatus, including:
a plane trajectory acquisition module: the teaching plane track is used for carrying out plane teaching on a teaching plane for multiple times to obtain a teaching plane track;
the dynamic motion unit expression module: the dynamic motion unit expression process is executed on the teaching plane track;
a track generalization control module: and the dynamic motion unit expression process is used for selecting a new track starting point and a new track target point, carrying out track generalization on the teaching plane track according to the dynamic motion unit expression process, and obtaining the teaching track of the contact surface by combining with the contact force control process.
In a third aspect, the present invention provides an indirect-arm-drag teaching apparatus, including:
at least one processor, and a memory communicatively coupled to the at least one processor;
wherein the processor is adapted to perform the method of any of the first aspects by invoking a computer program stored in the memory.
In a fourth aspect, the present invention provides a computer-readable storage medium having stored thereon computer-executable instructions for causing a computer to perform the method of any of the first aspects.
The invention has the beneficial effects that:
according to the invention, a teaching plane track is obtained by carrying out plane teaching on a teaching plane for multiple times, a dynamic motion unit expression process is carried out on the teaching plane track, a new track starting point and a new track target point are selected, track generalization is carried out on the teaching plane track according to the dynamic motion unit expression process, and the teaching track of the contact surface is obtained by combining a contact force control process. The limitation of a direct-dragging teaching technology in the prior art is overcome, and the problems that the use process is limited, the specified operation requirement under the complex working condition is difficult to meet, the direct-dragging teaching technology cannot realize accurate teaching and the like in the occasions where operators cannot reach or the occasions where accurate tracks and force tracking are required are solved. The plane teaching learning of the mechanical arm and the teaching track generation on the contact surface are realized by combining the dynamic motion unit expression with the contact force control process, the dragging teaching on the contact surface is not needed, the contact force control is realized, and the problem that the teaching track on an operation object which cannot be reached by an operator cannot be generated by a direct teaching technology is solved.
The robot control teaching device can be widely applied to the robot control teaching field.
Drawings
FIG. 1 is a flowchart illustrating an implementation of an indirect robot arm dragging teaching method according to an embodiment of the present invention;
FIG. 2 is a schematic diagram illustrating a smoothing process of an exemplary embodiment of an indirect robot arm dragging teaching method according to the present invention;
FIG. 3 is a schematic diagram illustrating indirect-drag teaching according to an embodiment of the present invention;
FIG. 4 is a schematic diagram of the end coordinate system and the tool coordinate system of the robot arm according to an embodiment of the present invention;
FIG. 5 is a block diagram of an exemplary embodiment of an indirect robot arm drag teaching apparatus according to the present invention.
Detailed Description
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the following description will be made with reference to the accompanying drawings. It is obvious that the drawings in the following description are only some examples of the invention, and that for a person skilled in the art, other drawings and embodiments can be derived from them without inventive effort.
Unless defined otherwise, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention belongs. The terminology used in the description of the invention herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention.
An embodiment of the present invention provides a teaching method for indirect dragging of a robot arm, and fig. 1 is a flowchart illustrating an implementation of the teaching method for indirect dragging of a robot arm according to the embodiment of the present invention, as shown in fig. 1, the method includes the following steps:
s1: in the embodiment, a focal plane is selected at first, in order to avoid a large teaching error caused by one-time teaching, multiple-time plane teaching is performed to obtain multiple teaching plane tracks, and a teaching process on the teaching plane is taught by using a conventional teaching method.
S2: in this embodiment, a gaussian mixture model and a gaussian mixture regression are adopted to perform smoothing processing, that is, in this embodiment, a smooth teaching trajectory can be obtained by processing using the gaussian mixture model and the gaussian mixture regression, and is used for executing the following steps.
S3: and executing a dynamic motion unit expression process on the smooth teaching track, namely expressing the smooth teaching track obtained by the steps by using a dynamic motion unit, wherein the dynamic motion unit can use a second-order differential equation to express any section of continuous track.
S4: and (3) carrying out track generalization to obtain a teaching track of the contact surface, specifically: and selecting a new track starting point and a new track target point, carrying out track generalization on the smooth teaching track according to the dynamic motion unit expression process, and obtaining the teaching track of the contact surface by combining with the contact force control process.
Specifically, in step S2, the gaussian mixture model is a probability model formed by overlapping a plurality of gaussian distributions, and as long as the number of gaussian distribution mixtures is sufficient, an arbitrary continuous distribution can be approximated by a weighted average of the gaussian mixtures with arbitrary accuracy, and the method is widely applied to trajectory generation of robot simulation learning and finally motion simulation, in this embodiment, the probability density function of the gaussian mixture model is represented as:
Figure BDA0002161350670000041
wherein y represents track points on the current teaching plane track, y | theta represents state quantity, alphakRepresents a weight coefficient, phi (y | theta)k) Is conditional probability distribution and obeys gaussian distribution, K represents the number of gaussian distributions in the gaussian mixture model and has:
Figure BDA0002161350670000042
in this embodiment, the weight coefficient is a prior probability, and is estimated by using an expectation-maximization algorithm, which is described in detail in the prior art and is not described herein again.
After the acquired multiple pieces of teaching plane trajectory data are encoded by the gaussian mixture model, data reconstruction is performed in a gaussian mixture regression mode, and then after generalization processing, a general output, that is, a continuous motion trajectory, is obtained for trajectory reproduction of a motion behavior, that is, a smooth teaching trajectory in this embodiment. Specifically, a Gaussian mixture model is used for calculating the conditional probability phi (y | theta)k) Using the expected values as generalized reconstructed data points, generating a smooth teaching trajectory under covariance constraint, similar to a given θkAnd solving for y.
In addition, in this embodiment, the trajectory points reconstructed in the smooth teaching trajectory through the gaussian mixture regression method are not included in the rules of the multiple teaching planes, but have the characteristics of the teaching plane trajectory, and a smooth and reliable teaching trajectory is generated under constraint, so that effective control of the mechanical arm is realized.
As shown in fig. 2, the schematic diagram of the smoothing process in this embodiment is shown in the left drawing, which shows that the shape "2" is formed by combining a plurality of discrete track points, and the right drawing is a continuous smooth teaching track obtained by performing the smoothing process on a plurality of teaching plane tracks through a gaussian mixture model and a gaussian mixture regression, and the shape "2" is formed by combining the constraint relationship of the teaching plane tracks.
After the smooth teaching track is obtained, a dynamic motion unit expression process is executed on the smooth teaching track according to step S3, where the dynamic motion unit expression process refers to: the method utilizes a dynamic motion unit to express a smooth teaching track, and is specifically represented as follows:
Figure BDA0002161350670000051
wherein x, v,
Figure BDA0002161350670000052
Respectively representing the position vector, velocity vector and acceleration vector, x, of the locus point in the smooth teaching locus0The vector represents the starting point position vector of the smooth teaching track, g represents the target point position vector of the smooth teaching track, f represents a forcing function, and is formed by combining a series of nonlinear functions, wherein tau and K, D are constants, and tau represents a time scaling factor for adjusting the attenuation speed of the system.
Further, the forcing function f is specifically:
Figure BDA0002161350670000053
ψi(s)=exp(-hi(s-μi)2) (4)
wherein s denotes a phase variable, #i(s) represents the center and width respectively are muiAnd hiGaussian of ωiDisplay movementThe state motion unit weight can store the characteristics of a smooth teaching track after training, N represents the number of Gaussian basis functions and satisfies the following conditions:
Figure BDA0002161350670000054
αsis constant to ensure the convergence of the system.
The weight omega of the dynamic motion unit is calculated according to the local weighted regression modeiIs called a dynamic motion unit trajectory learning process, and is expressed as:
Figure BDA0002161350670000055
the above equation (5) satisfies the following relationship:
Figure BDA0002161350670000056
wherein D represents a damping coefficient, xdemoA position vector representing the taught target point,
Figure BDA0002161350670000057
a velocity vector representing the taught target point,
Figure BDA0002161350670000058
acceleration vector representing teaching target point, ftargetRepresenting the objective forcing function.
In this embodiment, the target forcing function f can be obtained by smoothing the teaching trajectory informationtargetThereby weighting the dynamic motion unitiThe solution of (a) is converted into a function approximation problem, i.e. ω is determined by a local weighted regression algorithmiForcing functions f and ftargetAs close as possible, i.e. determining ωiIs such that f ≈ ftargetAnd a forcing function f is obtained.
In step S4, the track generalization process specifically includes:
s41: and selecting a new track starting point and a new track target point, wherein in the embodiment, the new track starting point and the new track target point are positioned on the contact surface, the contact surface can be a plane or a curved surface, selecting or carrying out coordinate axis transformation according to actual requirements, and calculating the teaching track of the contact surface by combining the new track starting point and the new track target point according to the formula (2).
S42: acquiring a contact force of the tail end of the mechanical arm and the contact surface, which is smaller than a force error threshold value, in a specific embodiment, the contact force between the tail end of the mechanical arm and the operation surface can be measured through a six-dimensional force sensor at the tail end of the mechanical arm, and the dragging teaching and force control operation of the mechanical arm can be realized by using the six-dimensional force sensor at the tail end, wherein the tail end of the mechanical arm and the contact surface are always kept perpendicular in the measurement process, and the magnitude of the contact force is smaller than the force error threshold value, which is defined:
Ferr=[F zd 0 0]T-[Fzt Mxt Myt]T (7)
wherein, FerrIndicating a force error threshold, FzdIndicating the desired contact force in the z-axis direction, FztRepresenting the actual contact force in the z-axis direction, MxtRepresenting the actual moment in the x-axis direction, MytThe y-axis direction actual moment is shown.
S43: generating a teaching track of the contact surface according to the dynamic motion unit expression process and the contact force, namely the teaching track has contact force size constraint and is expressed as six dynamic motion elementary equations:
Figure BDA0002161350670000061
in the above formula, the coordinate axis of the angular velocity is defined as α - β - γ, α represents the angular velocity in the α axis direction of the locus point in the smooth teaching trajectory, α0Alpha-axis direction angular velocity f representing starting point of smooth teaching trajectoryαRepresenting the forcing function of the alpha axis direction, the rest axes are analogized, FztRepresenting the actual contact force in the z-axis direction, MxtRepresenting the actual moment in the x-axis direction, MytRepresenting the actual moment in the y-axis direction, K、K、KfzRepresenting the contact force error coefficient.
As shown in fig. 3, a schematic diagram of the indirect drag teaching according to the present embodiment is shown, which includes: the robot comprises a mechanical arm 01, a six-dimensional force sensor 02 on the tail end, a tail end tool 03, a contact surface 04, a teaching plane 05, a smooth teaching track 06 and a teaching track 07 of the contact surface, wherein the contact surface 04 is a curved surface, the smooth teaching track is obtained through teaching on the teaching plane, the smooth teaching track is expressed through a dynamic motion unit, then a new track starting point and a new track target point are selected on the contact surface, track generalization is carried out on the smooth teaching track according to the dynamic motion unit expression process, the teaching track of the contact surface is obtained by combining with a contact force control process, and the conversion process of converting the plane track into the curved surface track is a conventional mechanical arm coordinate system conversion process, which is not described in detail herein.
As shown in fig. 4, a schematic diagram of the end coordinate system and the tool coordinate system of the robot arm of the embodiment is shown, and it can be seen that the schematic diagram includes: the robot arm 01, the six-dimensional force sensor 02 on the tip, the tip tool 03 (length d), the contact surface 04 (optionally a curved surface), where the contact force matrix on the tool coordinate system is represented as: fzt-Mxt-MytIn particular, FztRepresenting the actual contact force in the z-axis direction, MxtRepresenting the actual moment in the x-axis direction, MytThe contact force matrix representing the actual moment in the y-axis direction, transformed by coordinates to the terminal coordinate system, is represented as: fz-Mx-MyIn particular, FzRepresenting tip contact force in z-axis direction, MxRepresenting the end moment in the x-axis direction, MyRepresenting the y-axis direction end moment.
In this embodiment, a teaching plane trajectory is obtained by performing multiple times of plane teaching on a teaching plane, a dynamic motion unit expression process is performed on the teaching plane trajectory, a new trajectory start point and a new trajectory target point are selected, trajectory generalization is performed on the teaching plane trajectory according to the dynamic motion unit expression process, and a teaching trajectory of a contact surface is obtained by combining a contact force control process. The limitation of a direct-dragging teaching technology in the prior art is overcome, and the problems that the use process is limited, the specified operation requirement under the complex working condition is difficult to meet, the direct-dragging teaching technology cannot realize accurate teaching and the like in the occasions where operators cannot reach or the occasions where accurate tracks and force tracking are required are solved.
Example two:
as shown in fig. 5, a block diagram of a robot indirect-dragging teaching apparatus according to this embodiment is suitable for executing the method according to the first embodiment, and includes:
the plane trajectory acquisition module 10: the teaching plane track is used for carrying out plane teaching on a teaching plane for multiple times to obtain a teaching plane track;
dynamic motion unit expression module 30: the dynamic motion unit expression process is executed on the teaching plane track;
the track generalization control module 40: the method is used for selecting a new track starting point and a new track target point, carrying out track generalization on the teaching plane track according to the dynamic motion unit expression process, and obtaining the teaching track of the contact surface by combining with the contact force control process.
The planar trajectory acquisition module 10 further comprises: and a smoothing module 20, configured to smooth the teaching plane trajectory to obtain a smooth teaching trajectory.
In addition, the invention also provides a mechanical arm indirect dragging teaching device, which comprises:
at least one processor, and a memory communicatively coupled to the at least one processor;
wherein the processor is configured to perform the method according to embodiment one by calling the computer program stored in the memory.
In addition, the present invention also provides a computer-readable storage medium, which stores computer-executable instructions for causing a computer to perform the method according to the first embodiment.
The invention realizes plane teaching learning of the mechanical arm and generation of a teaching track on the contact surface by combining dynamic motion unit expression with a contact force control process, does not need to drag teaching on the contact surface, simultaneously realizes contact force control, and solves the problem that a direct teaching technology cannot generate the teaching track on an operation object which cannot be reached by an operator. The robot control teaching device can be widely applied to the robot control teaching field.
The above embodiments are only used for illustrating the technical solutions of the present invention, and not for limiting the same, although the present invention is described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: the technical solutions described in the foregoing embodiments may still be modified, or some or all of the technical features may be equivalently replaced; such modifications and substitutions do not depart from the spirit and scope of the present invention, and they should be construed as being included in the following claims and description.

Claims (9)

1.一种机械臂间接拖动示教方法,其特征在于,包括:1. a teaching method for indirect dragging of a mechanical arm, is characterized in that, comprising: 在示教平面进行多次平面示教得到示教平面轨迹;Perform multiple plane teaching on the teaching plane to obtain the teaching plane trajectory; 对所述示教平面轨迹执行动态运动单元表达过程;performing a dynamic motion unit expression process on the teaching plane trajectory; 选取新的轨迹起始点和轨迹目标点,根据所述动态运动单元表达过程对所述示教平面轨迹进行轨迹泛化,并结合接触力控制过程得到接触面的示教轨迹;Select a new trajectory starting point and a trajectory target point, perform trajectory generalization on the teaching plane trajectory according to the dynamic motion unit expression process, and obtain the teaching trajectory of the contact surface in combination with the contact force control process; 所述动态运动单元表达过程指:利用动态运动单元表达所述示教平面轨迹,具体为:The dynamic motion unit expression process refers to: expressing the teaching plane trajectory by using a dynamic motion unit, specifically:
Figure FDA0002891100830000011
Figure FDA0002891100830000011
其中,x、v、
Figure FDA0002891100830000012
分别表示所述示教平面轨迹中轨迹点的位置向量、速度向量和加速度向量,x0表示所述示教平面轨迹的起始点位置向量,g表示所述示教平面轨迹的目标点位置向量,f表示强迫函数,τ、K、D均为常数。
Among them, x, v,
Figure FDA0002891100830000012
respectively represent the position vector, velocity vector and acceleration vector of the trajectory point in the teaching plane trajectory, x 0 represents the starting point position vector of the teaching plane trajectory, g represents the target point position vector of the teaching plane trajectory, f represents the forcing function, and τ, K, and D are all constants.
2.根据权利要求1所述的一种机械臂间接拖动示教方法,其特征在于,得到所述示教平面轨迹后还包括:对所述示教平面轨迹进行平滑处理得到平滑示教轨迹。2 . The teaching method for indirect dragging of a robotic arm according to claim 1 , wherein after obtaining the teaching plane trajectory, the method further comprises: smoothing the teaching plane trajectory to obtain a smooth teaching trajectory. 3 . . 3.根据权利要求2所述的一种机械臂间接拖动示教方法,其特征在于,采用高斯混合模型和高斯混合回归实现所述平滑处理。3 . The teaching method for indirect dragging of a robotic arm according to claim 2 , wherein the smoothing process is realized by using a Gaussian mixture model and a Gaussian mixture regression. 4 . 4.根据权利要求1所述的一种机械臂间接拖动示教方法,其特征在于,所述强迫函数具体为:4. a kind of mechanical arm indirect drag teaching method according to claim 1, is characterized in that, described forcing function is specifically:
Figure FDA0002891100830000013
Figure FDA0002891100830000013
ψi(s)=exp(-hi(s-μi)2)ψ i (s)=exp(-hi (s-μ i ) 2 ) 其中,s表示相位变量,ψi(s)表示中心和宽度分别为μi和hi的高斯基函数,ωi表示动态运动单元权值,N表示高斯基函数的个数。Among them, s represents the phase variable, ψ i (s) represents the Gaussian basis function whose center and width are μ i and hi respectively, ω i represents the weight of the dynamic motion unit, and N represents the number of Gaussian basis functions.
5.根据权利要求1至4任一项所述的一种机械臂间接拖动示教方法,其特征在于,所述轨迹泛化的过程具体为:5. The teaching method for indirect dragging of a robotic arm according to any one of claims 1 to 4, wherein the process of the trajectory generalization is specifically: 选取新的轨迹起始点和轨迹目标点;Select a new trajectory start point and trajectory target point; 获取所述机械臂末端与接触面的小于力误差阈值的接触力;Obtain the contact force between the end of the robotic arm and the contact surface that is less than the force error threshold; 根据所述动态运动单元表达过程和所述接触力生成所述接触面的示教轨迹。The teaching trajectory of the contact surface is generated according to the dynamic motion unit expression process and the contact force. 6.根据权利要求5所述的一种机械臂间接拖动示教方法,其特征在于,所述机械臂末端与所述接触面保持垂直。6 . The teaching method for indirect dragging of a robotic arm according to claim 5 , wherein the end of the robotic arm is kept perpendicular to the contact surface. 7 . 7.一种机械臂间接拖动示教装置,其特征在于,包括:7. A teaching device for indirect dragging by a mechanical arm, characterized in that it comprises: 获取平面轨迹模块:用于在示教平面进行多次平面示教得到示教平面轨迹;Obtaining plane trajectory module: used for multiple plane teaching on the teaching plane to obtain the teaching plane trajectory; 动态运动单元表达模块:用于对所述示教平面轨迹执行动态运动单元表达过程;Dynamic motion unit expression module: used to perform a dynamic motion unit expression process on the teaching plane trajectory; 轨迹泛化控制模块:用于选取新的轨迹起始点和轨迹目标点,根据所述动态运动单元表达过程对所述示教平面轨迹进行轨迹泛化,并结合接触力控制过程得到接触面的示教轨迹;Trajectory generalization control module: used to select a new trajectory starting point and trajectory target point, perform trajectory generalization on the teaching plane trajectory according to the dynamic motion unit expression process, and obtain the representation of the contact surface in combination with the contact force control process. teaching track; 所述动态运动单元表达过程指:利用动态运动单元表达所述示教平面轨迹,具体为:The dynamic motion unit expression process refers to: expressing the teaching plane trajectory by using a dynamic motion unit, specifically:
Figure FDA0002891100830000021
Figure FDA0002891100830000021
其中,x、v、
Figure FDA0002891100830000022
分别表示所述示教平面轨迹中轨迹点的位置向量、速度向量和加速度向量,x0表示所述示教平面轨迹的起始点位置向量,g表示所述示教平面轨迹的目标点位置向量,f表示强迫函数,τ、K、D均为常数。
Among them, x, v,
Figure FDA0002891100830000022
respectively represent the position vector, velocity vector and acceleration vector of the trajectory point in the teaching plane trajectory, x 0 represents the starting point position vector of the teaching plane trajectory, g represents the target point position vector of the teaching plane trajectory, f represents the forcing function, and τ, K, and D are all constants.
8.一种机械臂间接拖动示教设备,其特征在于,包括:8. A teaching device for indirect dragging by a robotic arm, characterized in that it comprises: 至少一个处理器;以及,与所述至少一个处理器通信连接的存储器;at least one processor; and, a memory communicatively coupled to the at least one processor; 其中,所述处理器通过调用所述存储器中存储的计算机程序,用于执行如权利要求1至6任一项所述的方法。Wherein, the processor is configured to execute the method according to any one of claims 1 to 6 by calling the computer program stored in the memory. 9.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机可执行指令,所述计算机可执行指令用于使计算机执行如权利要求1至6任一项所述的方法。9. A computer-readable storage medium, characterized in that the computer-readable storage medium stores computer-executable instructions, and the computer-executable instructions are used to cause a computer to execute any one of claims 1 to 6. Methods.
CN201910733315.XA 2019-08-09 2019-08-09 Mechanical arm indirect dragging demonstration method and device Active CN110561421B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910733315.XA CN110561421B (en) 2019-08-09 2019-08-09 Mechanical arm indirect dragging demonstration method and device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910733315.XA CN110561421B (en) 2019-08-09 2019-08-09 Mechanical arm indirect dragging demonstration method and device

Publications (2)

Publication Number Publication Date
CN110561421A CN110561421A (en) 2019-12-13
CN110561421B true CN110561421B (en) 2021-03-19

Family

ID=68774995

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910733315.XA Active CN110561421B (en) 2019-08-09 2019-08-09 Mechanical arm indirect dragging demonstration method and device

Country Status (1)

Country Link
CN (1) CN110561421B (en)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113733107B (en) * 2020-05-15 2022-10-18 北京配天技术有限公司 Robot drag teaching method, robot and computer storage medium
CN112847355B (en) * 2020-12-31 2022-08-12 山东大学 A DMP-based robot bolt screwing method and system
CN113977580B (en) * 2021-10-29 2023-06-27 浙江工业大学 Mechanical arm imitation learning method based on dynamic motion primitive and self-adaptive control
CN114366552B (en) * 2021-12-23 2023-10-24 威海经济技术开发区天智创新技术研究院 Exoskeleton control method and system for upper limb rehabilitation training
CN114227688B (en) * 2021-12-29 2023-08-04 同济大学 A Teaching Trajectory Learning Method Based on Curve Registration
CN114800535B (en) * 2022-06-29 2022-10-25 深圳鹏行智能研究有限公司 Robot control method, mechanical arm control method, robot and control terminal

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH065486B2 (en) * 1981-03-26 1994-01-19 株式会社安川電機 Robot trajectory control method
JPS60193016A (en) * 1984-03-14 1985-10-01 Toyota Motor Corp Robot device
JP4922584B2 (en) * 2004-12-10 2012-04-25 株式会社安川電機 Robot system
JP5642304B2 (en) * 2013-02-15 2014-12-17 株式会社神戸製鋼所 Robot pendant
CN108453707B (en) * 2018-04-12 2021-11-19 珞石(山东)智能科技有限公司 Robot dragging teaching track generation method
CN109483556B (en) * 2018-10-30 2021-04-16 武汉大学 Robot polishing system and method based on teaching learning
CN109382828B (en) * 2018-10-30 2021-04-16 武汉大学 A robot shaft hole assembly system and method based on teaching and learning

Also Published As

Publication number Publication date
CN110561421A (en) 2019-12-13

Similar Documents

Publication Publication Date Title
CN110561421B (en) Mechanical arm indirect dragging demonstration method and device
Nguyen-Tuong et al. Using model knowledge for learning inverse dynamics
JP5225720B2 (en) Apparatus and method for generating and controlling robot motion
Navarro-Alarcon et al. Model-free visually servoed deformation control of elastic objects by robot manipulators
Peters et al. Reinforcement learning by reward-weighted regression for operational space control
CN109702740B (en) Robot compliance control method, device, equipment and storage medium
US20110093119A1 (en) Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same
Shetab-Bushehri et al. As-rigid-as-possible shape servoing
JP2019166626A (en) Control device and machine learning device
CN108247631B (en) Mechanical arm autonomous robust singularity avoiding method for improving path tracking performance
KR20220155921A (en) Method for controlling a robot device
Laezza et al. Reform: A robot learning sandbox for deformable linear object manipulation
CN114179089B (en) Robust region tracking control method for mechanical arm
Oikonomou et al. Reproduction of human demonstrations with a soft-robotic arm based on a library of learned probabilistic movement primitives
CN114502338B (en) Techniques for generating controllers for robots
Palm et al. Recognition of human grasps by time-clustering and fuzzy modeling
CN117260701A (en) Method for training machine learning model to implement control rules
Minatohara et al. The self-organizing adaptive controller
KR101329640B1 (en) Method for learning task skill and robot using thereof
Choi et al. Towards Feasible Dynamic Grasping: Leveraging Gaussian Process Distance Field, SE (3) Equivariance, and Riemannian Mixture Models
Conradt et al. On-line learning for humanoid robot systems
CN113510701B (en) Robot control method, robot, and computer-readable storage medium
Wang et al. Trajectory planning for robot arm based on the Improved Mixture of Motors Primitives
CN119200396A (en) Method, device, medium and electronic device for determining approximate disturbed parameters
Popescu et al. Fast movements and jerk mechanics

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