WO2017219639A1 - Procédé et dispositif de planification de trajectoire de mouvement pour bras robotisé, et robot - Google Patents

Procédé et dispositif de planification de trajectoire de mouvement pour bras robotisé, et robot Download PDF

Info

Publication number
WO2017219639A1
WO2017219639A1 PCT/CN2016/113187 CN2016113187W WO2017219639A1 WO 2017219639 A1 WO2017219639 A1 WO 2017219639A1 CN 2016113187 W CN2016113187 W CN 2016113187W WO 2017219639 A1 WO2017219639 A1 WO 2017219639A1
Authority
WO
WIPO (PCT)
Prior art keywords
motion
phase
trajectory
changed
motion phase
Prior art date
Application number
PCT/CN2016/113187
Other languages
English (en)
Chinese (zh)
Inventor
罗汉杰
Original Assignee
广州视源电子科技股份有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 广州视源电子科技股份有限公司 filed Critical 广州视源电子科技股份有限公司
Publication of WO2017219639A1 publication Critical patent/WO2017219639A1/fr

Links

Images

Classifications

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

Definitions

  • the invention relates to the field of robot control, in particular to a method, a device and a robot for planning a motion path of a mechanical arm.
  • the trajectory of the manipulator needs to be planned.
  • the trajectory planning is implemented by a predetermined speed planning algorithm.
  • a predetermined speed planning algorithm For example, an S-type (Double S) velocity curve algorithm can be used.
  • S-type Double S
  • Some speed planning algorithms need to receive the start and end points provided by the user in advance when planning the trajectory. Then the program will generate a series of interpolation points between the two points to describe the trajectory of the arm. For example, in the teaching function, the user sends an instruction through the handheld device, so that the robot arm starts from the starting point and moves linearly in a certain direction until reaching the end point.
  • the end position of the end point is determined by the user in real time according to the actual situation, so the user can not give a specific end point coordinate at the beginning of the movement, which leads to the robot arm based on the current speed planning algorithm.
  • the motion trajectory cannot be planned in advance during the work process, which affects the user experience.
  • an object of the present invention is to provide a method, a device and a robot for trajectory planning of a robot arm, which can re-plan the motion trajectory according to the user's operation, and meet the user's use requirements.
  • the invention provides a method for planning a motion trajectory of a mechanical arm, comprising the following steps:
  • the speed curve algorithm is an S-type speed curve algorithm
  • the initial parameter set includes at least a path, a maximum acceleration of the acceleration phase, a maximum speed, a minimum deceleration of the deceleration phase, a maximum jerk, and a minimum jerk.
  • These initial parameters include: an accelerated motion phase, a uniform motion phase, and a deceleration phase, the accelerated motion phase including a first acceleration motion phase, a second acceleration motion phase, and a third acceleration motion phase; The first deceleration phase, the second deceleration phase, and the third deceleration phase are included.
  • the duration of the predetermined motion phase and the initial reference are changed according to a motion phase in which the moving arm is currently located a predetermined initial parameter in the set, generating a changed motion trajectory, and controlling the robot arm to move with the changed motion trajectory, specifically:
  • the changing the duration of the predetermined motion phase and the predetermined initial parameter in the initial parameter set according to the motion phase in which the moving arm is currently located, generating a modified motion trajectory, and controlling the robot arm Exercise with the changed motion trajectory specifically:
  • the changing the duration of the predetermined motion phase and the predetermined initial parameter in the initial parameter set according to the motion phase in which the moving arm is currently located, generating a modified motion trajectory, and controlling the robot arm Exercise with the changed motion trajectory specifically:
  • the duration of the uniform motion phase is changed to zero
  • the initial parameter of the route is changed according to the current motion time
  • the changed motion trajectory is generated according to the changed initial parameter
  • the robot arm is controlled to move with the changed motion trajectory.
  • the changing the duration of the predetermined motion phase and the predetermined initial parameter in the initial parameter set according to the motion phase in which the moving arm is currently located, generating a modified motion trajectory, and controlling the robot arm Exercise with the changed motion trajectory specifically:
  • the duration of the uniform motion phase is changed to tt 3 ; wherein t is the current motion time, and t 3 -t 0 is a pre-configured time t from the start timing 0 to the duration of the end of the third acceleration motion phase;
  • the initial parameter of the path is changed according to the current motion time t, the changed motion track is generated according to the changed initial parameter, and the robot arm is controlled to move with the changed motion track.
  • the method further includes:
  • the invention also provides a motion trajectory planning device for a mechanical arm, comprising:
  • a motion control unit configured to control the robot arm to move according to a predetermined motion trajectory according to a preset starting point coordinate, an end point coordinate, and a velocity curve algorithm; wherein the speed curve algorithm is to move the mechanical arm according to a preset initial parameter set
  • the motion trajectory is planned for at least two motion phases, and each motion phase is configured for a duration;
  • a motion time acquisition unit configured to acquire a current motion time of the robot arm after receiving a stop command issued by a user, and determine the robot arm according to the current motion time t and a duration configured for each motion phase The current stage of exercise;
  • a motion trajectory changing unit configured to change a duration of a predetermined motion phase and a predetermined initial parameter in the initial parameter set according to a motion phase in which the motion arm is currently in motion, generate a modified motion trajectory, and control the The arm moves with the changed motion trajectory.
  • the method further comprises:
  • a work area generating unit configured to generate a working area of the mechanical arm based on a joint parameter of the mechanical arm to be operated
  • An intersection point generating unit configured to generate a ray according to a coordinate and a moving direction of the starting point input in advance, and calculate an intersection of the ray and a boundary of the working area to generate a set of intersection points;
  • An end point marking unit is configured to calculate a distance of each intersection point in the intersection point set from the starting point, acquire coordinates of an intersection point corresponding to the minimum distance, and mark the intersection point as an end point.
  • the present invention also provides a robot comprising the above described motion trajectory planning device.
  • the method, device and robot for trajectory planning of the robot arm provided by the embodiment of the present invention, after receiving the stop command of the user before detecting the entering the deceleration motion phase, performing current and subsequent motion trajectories according to the current motion phase. Re-planning, so that the moving arm stops as soon as possible while maintaining smooth motion and continuous speed, so as to meet the user's use requirements.
  • FIG. 1 is a schematic flow chart of a method for planning a motion trajectory of a mechanical arm according to an embodiment of the present invention.
  • Figure 2 is a schematic diagram of the motion process of the S-shaped velocity curve algorithm.
  • Figure 3 is a flow chart of the calculation principle of the S-shaped velocity curve algorithm.
  • FIG. 4 is a schematic structural view of a SCARA type robot arm.
  • Fig. 5 is a schematic view showing the SCARA type robot arm shown in Fig. 4 in a DH coordinate system.
  • Fig. 6 is a schematic view showing the working area of the SCARA type robot arm shown in Fig. 4.
  • Figure 7 is a plan view of the work area shown in Figure 6.
  • Figure 8 is a schematic illustration of the connection of the ray to the work area.
  • FIG. 9 is a schematic flow chart of calculating an intersection of a ray and a circle by an optimization algorithm of a ray-circle intersection test provided by an embodiment of the present invention.
  • 10(a) to 10(c) are schematic diagrams of the optimization algorithm shown in Fig. 9.
  • FIG. 11 is a schematic structural diagram of a motion trajectory planning apparatus for a mechanical arm according to an embodiment of the present invention.
  • FIG. 12 is another schematic structural diagram of a motion trajectory planning device for a mechanical arm according to an embodiment of the present invention.
  • Embodiments of the present invention provide a method for planning a motion trajectory of a mechanical arm, which can determine an end point coordinate in real time according to a stop command issued by a user, and plan a new motion trajectory in advance.
  • an embodiment of the present invention provides a schematic flowchart of a method for planning a motion trajectory of a mechanical arm, which may be performed by a motion trajectory planning device of a mechanical arm (hereinafter referred to as a motion trajectory planning device), and includes at least the following steps:
  • S101 Control a robot arm to move according to a predetermined motion trajectory according to a preset start point coordinate, an end point coordinate, and a speed curve algorithm. wherein the speed curve algorithm plans the motion trajectory of the mechanical arm according to a preset initial parameter set. For at least two phases of motion, and configure a duration for each phase of motion.
  • the robot arm is the most widely used automatic mechanical device in the field of robot technology, and is widely used in the fields of industrial manufacturing, medical treatment, entertainment service, military, semiconductor manufacturing, and space exploration. Although they differ in their form, they all share a common feature of being able to accept instructions and accurately position them at a certain point in the three-dimensional (or two-dimensional) space according to the instructions.
  • the movement of the mechanical arm is generally controlled according to a speed curve algorithm, for example, a common trapezoidal velocity curve algorithm, a sinusoidal velocity curve algorithm, and an S-shaped velocity curve algorithm, wherein the S-shaped velocity curve
  • a speed curve algorithm for example, a common trapezoidal velocity curve algorithm, a sinusoidal velocity curve algorithm, and an S-shaped velocity curve algorithm, wherein the S-shaped velocity curve
  • the algorithm is widely used because it can control the rate of change of acceleration and smoothly transition at the speed connection, so it is very stable during operation and does not vibrate.
  • the S-type velocity curve algorithm needs to input the initial parameter set (including the path q 1 , the starting velocity v 0 , the starting acceleration a 0 the ending velocity v 1 , the ending acceleration a 1 , and the maximum acceleration a max in the acceleration motion phase during operation). , the maximum speed v max , the minimum deceleration a min , the maximum jerk j max and the minimum jerk j min ) in the deceleration phase, and then the trajectory of the motion trajectory according to these initial parameters.
  • the typical S-type velocity curve algorithm will plan the motion trajectory into three motion phases: the acceleration motion phase (duration T a ), the uniform motion phase (duration T v ), and deceleration.
  • Movement phase (duration T d ), more specifically: the acceleration motion phase includes a first acceleration motion phase (corresponding to a time interval [t 0 , t 1 ), the duration is T j1 , and the acceleration is gradually increased from 0 To a max ), the second acceleration motion phase (corresponding to the time interval [t 1 , t 2 ), at which time the acceleration remains unchanged) and the third acceleration motion phase (corresponding to the time interval [t 2 , t 3 ), continuing The time is T j1 , the acceleration gradually decreases from a max to 0); the deceleration motion phase includes a first deceleration motion phase (corresponding to the time interval [t 4 , t 5 ), the duration is T j2 , and the acceleration is from 0 gradually decreases to a min ), the second deceleration phase (corresponding to the time interval [t 5 , t 6 ), at which time the acceleration remains unchanged) and the third deceleration phase (corresponding to the time interval [t 6 , t 7 ), the
  • the S-type speed curve algorithm first needs to accept the initial parameters given by the user, including: path q 1 , starting point velocity v 0 , starting point acceleration a 0 end point speed v 1 , end point acceleration a 1.
  • the S-type velocity curve algorithm judges based on these initial parameters.
  • the specific time parameters T j1 , T j2 , T a and T d are calculated using equation (1). If not, the formula (2) is used to calculate the specific time parameters T j1 , T j2 , T a and T d . Thereafter, after T j1 , T j2 , T a , and T d are obtained, T v is calculated according to the T a calculated by the formula (3). Next, it is judged whether T v >0 is established, and if it is established, the final t 0 , t 1 , t 2 , t 3 , t 4 , t 5 , t 6 are calculated using equations (6) and (7).
  • T v and new T a and T d are obtained according to formula (4), and the final t 0 , t 1 , t 2 , t 3 , t are calculated according to formula (6) and formula (7). 4 , t 5 , t 6 , t 7 . If not, calculate T v and new T j1 , T j2 , T a and T d using equation (5), and calculate the final t 0 , t 1 according to formula (6) and formula (7). , t 2 , t 3 , t 4 , t 5 , t 6 , t 7 .
  • the specific forms of the formulas (1) to (7) are as follows:
  • the user when the user uses the mechanical arm, the user may issue a stop command as needed (for example, during the teaching, the user can issue a stop command to the robot arm through the teaching box), then After receiving the stop command issued by the user, the motion trajectory planning device acquires the current motion time t of the robot arm, and determines, according to the current motion time t and the duration (or time interval), that the robot arm is currently located. The stage of exercise.
  • the motion trajectory planning device needs to stop the robot arm as soon as possible and remains stable. For this reason, the motion trajectory planning device needs to be according to the motion.
  • the motion phase in which the arm is currently is changing the duration of the predetermined motion phase and the predetermined initial parameters in the initial set of parameters.
  • the durations of the first acceleration motion phase, the third acceleration motion phase, the first deceleration motion phase, and the third deceleration motion phase Change to t and change the duration of the second acceleration motion phase, the uniform velocity motion phase, and the second deceleration motion phase to zero.
  • the motion trajectory planning device when the motion trajectory planning device determines that the user issues a stop command during the first acceleration motion phase, that is, the current running time t ⁇ t 1 , the motion trajectory planning device immediately terminates the first acceleration motion phase. At the same time, in order to stop the robot arm as soon as possible, the durations of the second acceleration motion phase, the uniform velocity motion phase, and the second deceleration motion phase are also changed to zero.
  • the initial parameters of the path, the maximum speed, the maximum acceleration of the acceleration motion phase, and the minimum deceleration phase of the deceleration motion phase are changed, and the changed motion trajectory is generated according to the changed initial parameters, and the control center is controlled.
  • the robot arm moves with the changed motion trajectory.
  • the maximum acceleration a max of the acceleration motion phase is changed to j max *t
  • the minimum deceleration a min of the deceleration motion phase is changed to -j min *t
  • the maximum velocity v max is changed to t*a max q 1 is changed to t*a max *2t, after which the changed motion trajectory can be obtained according to formula (8), and the robot arm is controlled to move with the changed motion trajectory.
  • the motion trajectory planning device determines that the user issues a stop command during the second acceleration motion phase
  • the motion trajectory planning device Immediately terminating the second acceleration motion phase, that is, the second acceleration motion phase, and in order to stop the robot arm as soon as possible, the duration of the second deceleration motion phase is also changed to tt 1 , and the uniform motion phase is changed. Zero.
  • the time interval of each motion phase becomes: the time interval corresponding to the first acceleration motion phase is [t 0 , t 1 ), and the time interval corresponding to the second acceleration motion phase is [t 1 , t
  • the time interval corresponding to the third acceleration motion phase is [t, t 3n2 ), and the time interval corresponding to the uniform motion phase is [t 3n2 , t 4n2 ), and the time interval corresponding to the first deceleration motion phase [t 4n2 , t 5n2 ), the time interval corresponding to the second deceleration motion phase is [t 5n2 , t 6n2 ), and the time interval corresponding to the third deceleration motion phase is changed to [t 6n2 , t 7n2 ),
  • the changed motion trajectory can be obtained according to formula (8), and the robot arm is controlled to move with the changed motion trajectory.
  • the motion trajectory planning device determines that the user issues a stop command during the third acceleration motion phase
  • the current running time t satisfies: t 2 ⁇ t ⁇ t 3 , in order to stop the mechanism as soon as possible
  • the arm changes the uniform motion phase to zero.
  • the time interval of each motion phase becomes: the time interval corresponding to the first acceleration motion phase is [t 0 , t 1 ), and the time interval corresponding to the second acceleration motion phase is [t 1 , t 2
  • the time interval corresponding to the third acceleration motion phase is [t 2 , t 3 ), the time interval corresponding to the uniform motion phase is [t 3 , t), and the time interval corresponding to the first deceleration motion phase
  • the time interval corresponding to the second deceleration motion phase is [t 5n4 , t 6n4 )
  • the changed path q 1 q 1 -v max [T v -(tt 3 )].
  • the changed motion trajectory can be obtained according to formula (8), and the robot arm is controlled to move with the changed motion trajectory.
  • the motion track is not changed.
  • the method for planning the motion trajectory of the robot arm after receiving the stop command of the user before detecting the entering the deceleration motion phase, the current and subsequent motion trajectories according to the current motion phase.
  • the re-planning is carried out so that the moving arm stops as soon as possible while maintaining smooth motion and continuous speed, thereby satisfying the user's use requirements.
  • the speed curve algorithm is an S-type speed curve algorithm, but the idea of the present invention is equally applicable to other speed curve algorithms, and in particular, to a speed curve having multiple motion stages.
  • the algorithms are all within the scope of the present invention and will not be described herein.
  • the endpoint coordinates can be obtained based on the following steps:
  • a robotic arm includes a plurality of joints, each joint having joint parameters, which may include joint type, arm length (length of the connecting arm connecting the two joints), range of motion, and the like.
  • the joint type may include a rotating joint and a sliding joint
  • the rotating joint may control the rotation of the connecting arm
  • the sliding joint may realize the vertical sliding of the connecting arm.
  • the working area of the robot arm can be controlled by a combination of different joints. Specifically, the working area of the robot arm can be determined by the following steps:
  • a coordinate system for generating each joint is established based on the DH coordinate system.
  • a SCARA (Selective Compliant Articulated Robot for Assembly) type robot arm is exemplified, which has four joints J1, J2, J3, and J4, wherein J1, J2, and J4 are rotating joints, and J1 and J2, J2 and J4 are connected by corresponding connecting arms, and J3 is a sliding joint.
  • J1, J2, and J4 are rotating joints
  • J1 and J2, J2 and J4 are connected by corresponding connecting arms
  • J3 is a sliding joint
  • a coordinate system of each joint can be established based on the DH (Denavit-Hartenberg) coordinate system, wherein the rotational axes of the rotating joints Ji and their respective The zi axis (the connecting arm of the rotating joint Ji rotates around the zi axis) is parallel to each other, the arm length of the connecting arm is ⁇ i, ⁇ i
  • the zi axis is determined, the direction of the first joint pointing to the second joint can be used as the xi direction, and the direction of yi can be determined based on the right hand rule, thus, the coordinate system of each joint is generated.
  • the range of motion is the range of the angle of rotation of the connecting arm rotation, and for the sliding joint, the range of motion is
  • the working range of the arm can be generated by the upper and lower movement range of the connecting arm (as shown in FIG. 6).
  • a plan view as shown in FIG. 7 can be generated by simply projecting on the plane.
  • S02 Generate a ray according to the coordinates and the moving direction of the starting point input in advance, and calculate an intersection of the ray and the boundary of the working area to generate a set of intersection points.
  • it may include:
  • S021 Decompose the working area into at least two arcs, obtain a circle center, a radius, and a central angle range of each arc, and generate an equation of a circle corresponding to each arc.
  • the working area of the robot arm is Four arcs are enclosed.
  • the four arcs are located on four circles: ⁇ O 1 , ⁇ O 2 , ⁇ O 3 , ⁇ O 4 .
  • the center O 1 , O 4 coincides with the J 1 axis;
  • O 2 and O 3 are the positions of the J 2 axis when the J 1 axis is rotated to the positive and negative limits, respectively.
  • the maximum range of motion in the positive/negative direction of the axis J i respectively ⁇ j i
  • the starting point is I
  • the direction vector is n
  • the equation of the ray R(u) when calculating the intersection point, the equation of the ray R(u) can be sequentially connected with the equation of each circle, and obtained by using the parametric equation method.
  • the ray IP intersects ⁇ O 1 at point N, respectively; ⁇ O 2 intersects at point K and point M; ⁇ O 4 intersects point J and point L; and ⁇ O 3 does not Intersection.
  • the points K, N are on the circle, but are not on the arc of the working area, so after obtaining the intersection point, it is also necessary to check whether the arc angle ⁇ i of the intersection point satisfies
  • the working area does not necessarily consist of an arc of a circle.
  • the working area may be composed of an elliptical arc or a mixture of arcs of different types of geometric shapes.
  • the equations and angular ranges of the geometric shapes corresponding to the arcs may be obtained, and then The method can be used to calculate and generate a set of intersection points.
  • the distance between each intersection point and the starting point I can be calculated by the Euler formula, and then each calculated distance is compared, and the coordinates of the intersection point corresponding to the minimum distance are obtained, and the The intersection point is marked as the end point, at which point the boundary of the desired work area is obtained.
  • the intersection of the ray generated by the coordinates and the moving direction of the starting point input in advance and the boundary of the working area is calculated, and the acquisition and the starting point have The coordinates of the intersection of the minimum distances are obtained at the end points corresponding to the starting point and the moving direction.
  • the invention is based on a geometric method to determine the boundary of the working area of the robot arm, so that the robot can know the position of the end point in advance before the movement, so that the robot can plan the motion trajectory.
  • step S022 after the ray is generated, a conventional parametric equation method may be used to find an intersection point, or may be used.
  • An optimization algorithm based on the ray and circle intersection test is proposed to calculate the intersection of the ray and each circle.
  • Fig. 10(a) first calculate the vector from the starting point I to the center of the circle O i vector length And vector Projection along the
  • the ray has two intersections with the circle O i , respectively as well as (As shown in Figure 10 (a)). If Then, the starting point I is located in the circle O i . At this time, the ray has an intersection with the circle O i , which is I+(l+q) ⁇
  • FIG. 11 is a motion trajectory planning apparatus 100 for a mechanical arm according to an embodiment of the present invention, which includes:
  • a motion control unit 10 configured to control the robot arm to move according to a predetermined motion trajectory according to preset start point coordinates, an end point coordinate, and a speed curve algorithm; wherein the speed curve algorithm is to move the machine according to a preset initial parameter set
  • the trajectory of the arm is planned for at least two phases of motion and a duration is configured for each phase of motion.
  • the motion time acquisition unit 20 is configured to acquire a current motion time t of the robot arm after receiving a stop command issued by the user, and determine the current motion time t and the duration configured for each motion phase. The current stage of motion of the robotic arm.
  • a motion trajectory changing unit 30 configured to change a duration of a predetermined motion phase and a predetermined initial parameter in the initial parameter set according to a motion phase in which the motion arm is currently located, generate a modified motion trajectory, and control the Mechanical arm The trajectory moves.
  • the motion trajectory changing unit 30 determines that the mechanical arm is currently in the first acceleration motion phase, the first acceleration motion phase, the third acceleration motion phase, the first deceleration motion phase, and the third deceleration
  • the duration of the motion phase is changed to t, and the durations of the second acceleration motion phase, the uniform motion phase, and the second deceleration phase are changed to zero; thereafter, based on the current motion time t, the initial parameter a max , a min , v max and q 1 are changed, the changed motion trajectory is generated according to the changed initial parameters, and the robot arm is controlled to move with the changed motion trajectory.
  • the motion trajectory changing unit 30 determines that the mechanical arm is currently in the second acceleration motion phase, change the duration of the second acceleration motion phase and the second deceleration motion phase to tt 2 , and move the uniform motion The duration of the phase is changed to zero. Thereafter, the initial parameters v max and q 1 are changed according to the current motion time t, the changed motion trajectory is generated according to the changed initial parameters, and the robot arm is controlled to be changed.
  • the motion track is moving.
  • the motion trajectory changing unit 30 determines that the mechanical arm is currently in the third acceleration motion phase, the duration of the uniform motion phase is changed to zero;
  • the initial parameter q 1 is changed according to the current motion time t, the changed motion trajectory is generated according to the changed initial parameter, and the robot arm is controlled to move with the changed motion trajectory.
  • the initial parameter q 1 is changed according to the current motion time t, the changed motion trajectory is generated according to the changed initial parameter, and the robot arm is controlled to move with the changed motion trajectory.
  • the motion trajectory planning apparatus 100 of the robot arm re-plans the current and subsequent motion trajectories according to the current motion stage after receiving the user's stop command before detecting the entering the deceleration motion phase.
  • the moving arm is stopped as soon as possible while maintaining smooth motion and continuous speed, thereby satisfying the user's use requirements.
  • the motion trajectory planning device of the mechanical arm further includes:
  • the work area generating unit 40 is configured to generate a working area of the mechanical arm based on joint parameters of the mechanical arm to be operated.
  • the intersection point generation unit 50 is configured to generate a ray according to the coordinates and the movement direction of the start point input in advance, and calculate an intersection of the ray and the boundary of the work area to generate an intersection set.
  • the end point marking unit 60 is configured to calculate a distance between each intersection point in the intersection point set and the starting point, acquire coordinates of an intersection point corresponding to the minimum distance, and mark the intersection point as an end point.
  • the working area generating unit 40 generates the working area of the robot arm
  • the intersection point generating unit 50 calculates the intersection of the ray generated by the coordinates and the moving direction of the starting point input in advance and the boundary of the working area.
  • the end point marking unit 60 acquires the coordinates of the intersection point having the smallest distance from the starting point, obtains the end point corresponding to the starting point and the moving direction, and then performs the planning of the motion trajectory according to the starting point, the ending point and the preset trajectory planning algorithm.
  • the invention is based on a geometric method to determine the boundary of the working area of the robot arm, so that the robot can know the position of the end point in advance before the movement, so that the robot can plan the motion trajectory.
  • the present invention also provides a robot comprising the above described motion trajectory planning apparatus 100.
  • the robot provided by the embodiment of the present invention, after receiving the stop command of the user before detecting the entering the deceleration motion phase, re-plans the current and subsequent motion trajectories according to the current motion phase, so that the motion arm is maintained. Under the premise of smooth motion and continuous speed, stop as soon as possible to meet the user's needs.
  • the robot provided by the embodiment of the present invention re-plans the entire motion trajectory after receiving the stop command of the user before entering the deceleration motion phase, so that the motion arm stops as soon as possible while maintaining smooth motion and continuous speed. In order to meet the user's needs.

Abstract

L'invention concerne un procédé de planification de trajectoire de mouvement, pour un bras robotisé, qui comprend les étapes suivantes : la commande d'un bras robotisé pour qu'il se déplace selon une trajectoire de mouvement prédéterminée en fonction de coordonnées de point de départ et de coordonnées de point d'arrivée pré-établies et d'un algorithme de courbe de vitesse ; suite à la réception d'une instruction d'arrêt envoyée par un utilisateur, l'obtention de la durée du mouvement réelle du bras robotisé, et la détermination de l'étape de mouvement réel du bras robotisé en fonction de la durée de mouvement réelle et de la durée établie pour chaque étape de mouvement ; en fonction de l'étape de mouvement réelle du bras robotisé, la modification des durées prédéterminées des étapes de mouvement et des paramètres initiaux prédéterminés dans un ensemble de paramètres initiaux, la génération d'une trajectoire de mouvement modifiée et la commande du bras robotisé pour qu'il se déplace selon la trajectoire de mouvement modifiée. L'invention concerne un dispositif de planification de trajectoire de mouvement (100) pour un bras robotisé et un robot. Une fois qu'une instruction d'arrêt d'un utilisateur est reçue, une trajectoire de mouvement est à nouveau planifiée, de sorte qu'un bras mobile s'arrête dès que possible dans une logique de maintien d'un mouvement stable et de continuité de la vitesse.
PCT/CN2016/113187 2016-06-20 2016-12-29 Procédé et dispositif de planification de trajectoire de mouvement pour bras robotisé, et robot WO2017219639A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201610453116.X 2016-06-20
CN201610453116.XA CN105922265B (zh) 2016-06-20 2016-06-20 一种机械臂的运动轨迹规划方法、装置及机器人

Publications (1)

Publication Number Publication Date
WO2017219639A1 true WO2017219639A1 (fr) 2017-12-28

Family

ID=56831560

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2016/113187 WO2017219639A1 (fr) 2016-06-20 2016-12-29 Procédé et dispositif de planification de trajectoire de mouvement pour bras robotisé, et robot

Country Status (2)

Country Link
CN (1) CN105922265B (fr)
WO (1) WO2017219639A1 (fr)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111161373A (zh) * 2019-12-09 2020-05-15 北京理工大学 一种基于正弦曲线灰度显示的绘画方法
CN111958584A (zh) * 2019-06-28 2020-11-20 鲁班嫡系机器人（深圳）有限公司 轨迹规划方法、装置及系统
CN112720475A (zh) * 2020-12-22 2021-04-30 深圳市优必选科技股份有限公司 机器人下台阶的轨迹规划方法、装置及机器人
CN113608441A (zh) * 2021-08-05 2021-11-05 南京佗道医疗科技有限公司 一种位置前瞻自适应穿刺控制方法
CN113703433A (zh) * 2020-05-21 2021-11-26 北京配天技术有限公司 机器人运动轨迹的速度规划方法及装置
CN113941783A (zh) * 2021-11-23 2022-01-18 深圳软动智能控制有限公司 激光轴蛙跳实现方法、装置、激光设备和存储介质
CN114102597A (zh) * 2021-11-30 2022-03-01 伯朗特机器人股份有限公司 机械臂关节点动操作控制方法、电子设备及存储介质
CN115129079A (zh) * 2022-06-17 2022-09-30 西北工业大学 一种基于改进弹性带算法的三维直升机航迹重规划方法
CN116100561A (zh) * 2023-04-10 2023-05-12 国网浙江省电力有限公司宁波供电公司 一种自动接线轨迹控制方法及系统
CN116313880A (zh) * 2022-06-20 2023-06-23 无锡亚电智能装备有限公司 一种晶圆清洗设备传输机构控制方法及装置
CN116572257A (zh) * 2023-07-13 2023-08-11 湖南尖山智能科技有限责任公司 机械臂控制方法、装置、系统、存储介质及机械臂
CN113703433B (zh) * 2020-05-21 2024-05-14 北京配天技术有限公司 机器人运动轨迹的速度规划方法及装置

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105922265B (zh) * 2016-06-20 2018-08-24 广州视源电子科技股份有限公司 一种机械臂的运动轨迹规划方法、装置及机器人
CN106041941B (zh) * 2016-06-20 2018-04-06 广州视源电子科技股份有限公司 一种机械臂的轨迹规划方法及装置
CN106671110A (zh) * 2017-02-10 2017-05-17 苏州库浩斯信息科技有限公司 一种机器人头部行程控制方法及其系统
CN106985140B (zh) * 2017-04-19 2019-05-07 广州视源电子科技股份有限公司 机器人点到点运动控制方法和系统
CN108132598B (zh) * 2017-11-17 2021-06-01 吉林大学 移动装弹机械臂系统动力学模型与轨迹控制
CN109991915A (zh) 2017-12-29 2019-07-09 深圳市优必选科技有限公司 一种机器人的运动控制方法、装置及机器人
CN108415427B (zh) * 2018-02-11 2021-06-11 昆山艾派科技有限公司 机器人多步连续运动的路径拼接方法
CN108333968B (zh) * 2018-02-11 2021-05-25 昆山艾派科技有限公司 机器人单步运动的轨迹规划方法
DE102018202321A1 (de) * 2018-02-15 2019-08-22 Robert Bosch Gmbh Koordinierungsanlage, Handhabungseinrichtung und Verfahren
CN110442086A (zh) * 2018-05-02 2019-11-12 深圳市优必选科技有限公司 一种机器人及其动作切换的方法
CN109108965B (zh) * 2018-07-27 2021-07-23 武汉精锋微控科技有限公司 一种应用于机械手臂的笛卡尔空间运动预测方法
CN109129470B (zh) * 2018-08-02 2021-07-09 深圳市智能机器人研究院 机器人直线路径的规划方法及系统
CN111015669B (zh) * 2019-12-27 2022-03-11 南京埃斯顿机器人工程有限公司 一种工业机器人停止运动轨迹规划方法
CN111015674B (zh) * 2020-01-13 2021-05-11 上海景吾智能科技有限公司 一种机器人运动关节控制方法、系统、存储介质及机器人
CN111775148B (zh) * 2020-06-15 2022-03-08 珠海格力电器股份有限公司 一种机器人控制方法、装置、存储介质及机器人
CN112323755B (zh) * 2020-11-10 2022-11-08 安徽省六安恒源机械有限公司 一种抓臂式清污机器人控制方法
CN112847340B (zh) * 2020-12-25 2022-09-16 深圳市优必选科技股份有限公司 一种控制方法、控制装置及机器人
CN112677155B (zh) * 2020-12-28 2022-07-12 北京配天技术有限公司 机器人单步运动的控制方法及控制设备、存储介质
CN112894822B (zh) * 2021-02-01 2023-12-15 配天机器人技术有限公司 机器人运动轨迹规划方法、机器人及计算机存储介质
CN113070881B (zh) * 2021-04-02 2022-11-11 深圳市优必选科技股份有限公司 机器人运动控制方法、装置和机器人
CN113176418B (zh) * 2021-05-21 2024-01-05 南京工业大学 一种多组分检测自动移液装置
CN115922687B (zh) * 2022-05-23 2023-11-17 以诺康医疗科技（苏州）有限公司 一种基于s形速度曲线的运动轨迹规划方法及装置
CN116252288A (zh) * 2023-03-09 2023-06-13 南京智欧智能技术研究院有限公司 一种多自由度平面线控机器人及线控方法
CN117103285A (zh) * 2023-10-25 2023-11-24 成都信息工程大学 一种舵机步行机器人的运动控制方法及机器人

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014048443A1 (fr) * 2012-09-25 2014-04-03 Abb Technology Ag Procédé de surveillance d'un robot
CN104589346A (zh) * 2014-12-15 2015-05-06 广西科技大学 一种适用于机械手的无碰撞路径规划方法
CN105082135A (zh) * 2015-09-11 2015-11-25 东南大学 一种机器人点动操作的速度控制方法
CN105415389A (zh) * 2016-01-08 2016-03-23 浙江理工大学 一种机械爪以及控制方法
CN105922265A (zh) * 2016-06-20 2016-09-07 广州视源电子科技股份有限公司 一种机械臂的运动轨迹规划方法、装置及机器人

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6216058B1 (en) * 1999-05-28 2001-04-10 Brooks Automation, Inc. System of trajectory planning for robotic manipulators based on pre-defined time-optimum trajectory shapes
CN101733750B (zh) * 2009-11-05 2011-05-04 浙江大学 基于动态响应谱的关节含间隙机器人轨迹规划方法
CN102785246B (zh) * 2012-08-24 2015-01-21 电子科技大学 一种可实现自动轨迹修正的机器人标定方法
KR101363358B1 (ko) * 2012-12-06 2014-02-17 (주)동부로봇 로봇의 제어 시스템 및 그 방법

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014048443A1 (fr) * 2012-09-25 2014-04-03 Abb Technology Ag Procédé de surveillance d'un robot
CN104589346A (zh) * 2014-12-15 2015-05-06 广西科技大学 一种适用于机械手的无碰撞路径规划方法
CN105082135A (zh) * 2015-09-11 2015-11-25 东南大学 一种机器人点动操作的速度控制方法
CN105415389A (zh) * 2016-01-08 2016-03-23 浙江理工大学 一种机械爪以及控制方法
CN105922265A (zh) * 2016-06-20 2016-09-07 广州视源电子科技股份有限公司 一种机械臂的运动轨迹规划方法、装置及机器人

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111958584A (zh) * 2019-06-28 2020-11-20 鲁班嫡系机器人（深圳）有限公司 轨迹规划方法、装置及系统
CN111161373B (zh) * 2019-12-09 2022-06-03 北京理工大学 一种基于正弦曲线灰度显示的绘画方法
CN111161373A (zh) * 2019-12-09 2020-05-15 北京理工大学 一种基于正弦曲线灰度显示的绘画方法
CN113703433A (zh) * 2020-05-21 2021-11-26 北京配天技术有限公司 机器人运动轨迹的速度规划方法及装置
CN113703433B (zh) * 2020-05-21 2024-05-14 北京配天技术有限公司 机器人运动轨迹的速度规划方法及装置
CN112720475B (zh) * 2020-12-22 2023-09-22 深圳市优必选科技股份有限公司 机器人下台阶的轨迹规划方法、装置及机器人
CN112720475A (zh) * 2020-12-22 2021-04-30 深圳市优必选科技股份有限公司 机器人下台阶的轨迹规划方法、装置及机器人
CN113608441A (zh) * 2021-08-05 2021-11-05 南京佗道医疗科技有限公司 一种位置前瞻自适应穿刺控制方法
CN113941783A (zh) * 2021-11-23 2022-01-18 深圳软动智能控制有限公司 激光轴蛙跳实现方法、装置、激光设备和存储介质
CN113941783B (zh) * 2021-11-23 2023-11-21 深圳软动智能控制有限公司 激光轴蛙跳实现方法、装置、激光设备和存储介质
CN114102597A (zh) * 2021-11-30 2022-03-01 伯朗特机器人股份有限公司 机械臂关节点动操作控制方法、电子设备及存储介质
CN115129079A (zh) * 2022-06-17 2022-09-30 西北工业大学 一种基于改进弹性带算法的三维直升机航迹重规划方法
CN115129079B (zh) * 2022-06-17 2024-05-03 西北工业大学 一种基于改进弹性带算法的三维直升机航迹重规划方法
CN116313880A (zh) * 2022-06-20 2023-06-23 无锡亚电智能装备有限公司 一种晶圆清洗设备传输机构控制方法及装置
CN116313880B (zh) * 2022-06-20 2023-12-01 无锡亚电智能装备有限公司 一种晶圆清洗设备传输机构控制方法及装置
CN116100561B (zh) * 2023-04-10 2023-09-05 国网浙江省电力有限公司宁波供电公司 一种自动接线轨迹控制方法及系统
CN116100561A (zh) * 2023-04-10 2023-05-12 国网浙江省电力有限公司宁波供电公司 一种自动接线轨迹控制方法及系统
CN116572257B (zh) * 2023-07-13 2023-09-22 湖南尖山智能科技有限责任公司 机械臂控制方法、装置、系统、存储介质及机械臂
CN116572257A (zh) * 2023-07-13 2023-08-11 湖南尖山智能科技有限责任公司 机械臂控制方法、装置、系统、存储介质及机械臂

Also Published As

Publication number Publication date
CN105922265B (zh) 2018-08-24
CN105922265A (zh) 2016-09-07

Similar Documents

Publication Publication Date Title
WO2017219639A1 (fr) Procédé et dispositif de planification de trajectoire de mouvement pour bras robotisé, et robot
WO2017219640A1 (fr) Procédé et dispositif de planification de trajectoire pour bras mécanique
CN107139171B (zh) 一种基于力矩控制的工业机器人避障轨迹规划方法
CN107030697B (zh) 一种机器人笛卡尔空间平滑轨迹的规划方法
CN106313047B (zh) 一种基于Bezier样条的机器人实时拐角过渡方法
CN107571261B (zh) 示教机器人多空间轨迹规划的平滑过渡方法及装置
WO2018126354A1 (fr) Procédé de planification de trajectoire de mouvement de robot et dispositif associé
CN105353725B (zh) 用于工业机器人的过辅助点姿态空间圆弧插补方法
CN107160389B (zh) 一种工业机器人的力矩控制方法
JP2019517929A (ja) ロボット関節空間におけるポイントツーポイント移動の軌跡計画方法
WO2017113219A1 (fr) Procédé, appareil et système pour planifier un cintrage suivant une trajectoire
CN106054882A (zh) 一种机器人避障方法
CN103568012A (zh) 一种弧焊机器人双平面摆弧轨迹的规划方法
CN106249888A (zh) 一种云台控制方法和装置
CN110162029A (zh) 一种基于规划路径的运动控制方法及装置、机器人
CN109623825B (zh) 一种移动轨迹规划方法、装置、设备和存储介质
CN107756400A (zh) 一种基于旋量理论的6r机器人逆运动学几何求解方法
CN108496132A (zh) 控制终端和无人机及其控制方法
Gao et al. Multi-mobile robot autonomous navigation system for intelligent logistics
CN110299062A (zh) 机械臂示教系统、方法、装置、介质、控制器及机械臂
CN112486183A (zh) 一种室内移动机器人的路径规划算法
CN110032213A (zh) 机器人跟随系统及机器人跟随方法
CN110413011A (zh) 一种双目云台控制方法、装置及存储介质
Cruciani et al. Dual-arm in-hand manipulation and regrasping using dexterous manipulation graphs
CN110193816A (zh) 工业机器人示教方法、手柄及系统

Legal Events

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

Ref document number: 16906176

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 16906176

Country of ref document: EP

Kind code of ref document: A1