CN110948504B - Normal constant force tracking method and device for robot machining operation - Google Patents

Normal constant force tracking method and device for robot machining operation Download PDF

Info

Publication number
CN110948504B
CN110948504B CN202010103489.0A CN202010103489A CN110948504B CN 110948504 B CN110948504 B CN 110948504B CN 202010103489 A CN202010103489 A CN 202010103489A CN 110948504 B CN110948504 B CN 110948504B
Authority
CN
China
Prior art keywords
robot
contact force
force
reference track
actual contact
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
CN202010103489.0A
Other languages
Chinese (zh)
Other versions
CN110948504A (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.)
Siasun Co Ltd
Original Assignee
Siasun Co Ltd
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 Siasun Co Ltd filed Critical Siasun Co Ltd
Priority to CN202010103489.0A priority Critical patent/CN110948504B/en
Publication of CN110948504A publication Critical patent/CN110948504A/en
Application granted granted Critical
Publication of CN110948504B publication Critical patent/CN110948504B/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
    • B25J11/00Manipulators not otherwise provided for
    • B25J11/005Manipulators for mechanical processing tasks
    • B25J11/0065Polishing or grinding
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • 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)
  • Manipulator (AREA)

Abstract

The invention provides a normal constant force tracking method and a normal constant force tracking device for robot machining operation, wherein the method comprises the following steps: giving an initial reference track; controlling the robot to move along the reference track; iteratively calculating and updating the position of the current reference track according to the error between the actual contact force and the expected contact force; calculating the attitude of the reference trajectory based on the updated position of the reference trajectory and the direction of the actual contact force. The method introduces a reference track into the existing robot machining force control system, obtains the high-precision reference track through iterative learning and attitude estimation, reflects the outline of a machined workpiece and the attitude which a robot machining tool needs to keep, performs machining according to the reference track, and can realize normal constant force tracking in the process of various curved surface machining operations. Meanwhile, the invention can be realized only by a 3-dimensional force sensor, and the cost increase caused by adopting a 6-dimensional force sensor is avoided.

Description

Normal constant force tracking method and device for robot machining operation
Technical Field
The invention relates to the field of industrial robots, in particular to a robot control technology, and specifically relates to a normal constant force tracking method and device in robot machining operation.
Background
At present, the 3C industry has a great demand on the application of robot grinding, polishing and the like. The traditional robot adopts position control, which is difficult to ensure constant contact force in grinding and polishing operations, resulting in uneven processing quality. Force sensor based robotic manual machining solutions have therefore been introduced by many companies.
Most of the current methods used in force control machining are impedance/admittance control (the control block diagram is shown in fig. 1). In performing robotic machining (grinding, polishing) operations, the contact force and relative position between the robot end tool and the part being machined can be expressed as aA determined impedance relationship. Error of actual contact force from expected contact force
Figure 704130DEST_PATH_IMAGE001
Can be expressed as:
Figure 662859DEST_PATH_IMAGE002
wherein the content of the first and second substances,
Figure 193197DEST_PATH_IMAGE003
the parameters of the inertia are represented by,
Figure 946390DEST_PATH_IMAGE004
the damping parameter is represented by a value representing the damping parameter,
Figure 77026DEST_PATH_IMAGE005
which is indicative of a stiffness parameter of the steel,
Figure 308287DEST_PATH_IMAGE006
representing a desired trajectory
Figure 958711DEST_PATH_IMAGE007
And the actual trajectory
Figure 617226DEST_PATH_IMAGE008
Position error therebetween.
When the contact force is stable, the above formula is simplified to
Figure 782628DEST_PATH_IMAGE009
I.e. for a fixed stiffness parameter
Figure 66847DEST_PATH_IMAGE005
As long as the position error can be ensured
Figure 837357DEST_PATH_IMAGE010
It is ensured that the contact force is kept in conformity with the desired force. This requires a sufficiently accurate machining reference trajectory
Figure 401194DEST_PATH_IMAGE008
To improve force tracking accuracy.
Assuming that the contour trace of the surface of the workpiece is
Figure 257154DEST_PATH_IMAGE011
The track that the robot end tool should travel is
Figure 345065DEST_PATH_IMAGE006
Then exist
Figure 501240DEST_PATH_IMAGE012
Typically, the profile path of the workpiece surface is readily available (e.g., taught) if the contact stiffness between the tool tip and the workpiece surface is high
Figure 501557DEST_PATH_IMAGE005
If also known, can pass
Figure 579234DEST_PATH_IMAGE013
Figure 221568DEST_PATH_IMAGE014
For target contact force) to calculate a position error
Figure 497829DEST_PATH_IMAGE015
. Then the position error is determined
Figure 186823DEST_PATH_IMAGE015
And the required track position of the tail end can be obtained by superposing the tail end on the contour track of the surface of the workpiece. However, for most processing scenarios, it is difficult to obtain the stiffness parameter
Figure 751797DEST_PATH_IMAGE005
And therefore it is also difficult to obtain an accurate machining locus in the end
Figure 666663DEST_PATH_IMAGE006
In addition, if normal constant force tracking in machining operations is to be achieved, it is often necessary to employ 6-dimensional force sensors, which undoubtedly increases production costs. Meanwhile, due to the friction force between the end tool of the robot and the workpiece, accurate normal tracking is difficult to realize.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provide a normal constant force tracking method and a control system in robot machining operation, so that the machining precision in the robot machining operation is effectively improved, and meanwhile, the cost is reduced.
The invention provides a normal constant force tracking method for robot machining operation on one hand, which comprises the following steps:
giving an initial reference trajectory comprising a position and a pose;
controlling the robot to move along the initial reference track, and ensuring that a tool at the tail end of the robot is always in contact with a workpiece in the moving process;
according to the error between the actual contact force and the expected contact force, iteratively calculating and updating the position of the current reference track to be used as the reference track of the next movement;
carrying out interpolation and difference on the updated reference track to obtain a speed vector of each control period;
converting the actual contact force vector of each control period into a base coordinate system, and calculating the projection of the actual contact force vector on a plane perpendicular to the velocity vector of the corresponding period in the base coordinate system to be used as the attitude of the updated reference track;
and controlling the robot to move according to the reference track obtained after the iteration, including the position and the posture, and using the reference track for formally processing the workpiece.
Optionally, the initial reference trajectory is obtained through teaching point location, model derivation, or traction teaching.
Optionally, a force control method based on impedance or admittance control is adopted to control the robot to move along the initial reference trajectory, and ensure that the end tool of the robot and the workpiece are always kept in contact in the moving process.
Optionally, the iteratively calculating and updating the position of the current reference trajectory according to the error between the actual contact force and the expected contact force in the motion process, as the reference trajectory of the next motion, includes:
collecting the actual contact force between the robot tail end tool and the workpiece in the motion process;
calculating an error between the actual contact force and the desired contact force;
updating the position of the current reference track according to the error;
the robot moves next time along the updated reference track;
and repeating the steps until the error between the actual contact force and the expected contact force converges to a set value or the movement times reach the set value, and finishing the iteration.
Optionally, the position of the current reference track is iteratively calculated and updated according to the following rules:
Figure 693DEST_PATH_IMAGE016
wherein the content of the first and second substances,
Figure 405129DEST_PATH_IMAGE017
in order to refer to the position of the track,
Figure 706667DEST_PATH_IMAGE018
for the number of iterations to be performed,
Figure 159645DEST_PATH_IMAGE019
in order to iterate the scaling factor,
Figure 613760DEST_PATH_IMAGE020
in order to iterate the differential coefficients, the coefficients are,
Figure 189098DEST_PATH_IMAGE021
the error of the expected contact force from the actual contact force.
Optionally, the interpolating and differentiating the updated reference trajectory to obtain the velocity vector of each control period includes:
smoothing the updated reference track;
carrying out spline curve interpolation to obtain the position information of each control period;
and obtaining a velocity vector according to the change difference of the position.
Optionally, the method for obtaining the velocity vector according to the change difference of the position includes:
assume that the position at time T is
Figure 728663DEST_PATH_IMAGE022
The position at time T-1 is
Figure 500179DEST_PATH_IMAGE023
Velocity vector at time T
Figure 808801DEST_PATH_IMAGE024
Wherein
Figure 492723DEST_PATH_IMAGE025
Indicating a control period.
In another aspect, the present invention further provides a normal constant force tracking apparatus for robot machining operation, including: robot force control unit, robot position control unit, actual contact force collection system, position feedforward unit, wherein:
the actual contact force acquisition device is used for measuring the actual contact force between the tail end processing tool of the robot and the workpiece and feeding back the actual contact force to the robot power control unit;
the robot force control unit is used for generating a robot tail end position adjusting instruction according to the error between the actual contact force and the expected contact force and sending the robot tail end position adjusting instruction to the robot position control unit;
the position feedforward unit is used for sending the current reference track to the robot position control unit; iteratively updating the position of the current reference track according to the error between the actual contact force and the expected contact force, and calculating the posture of the current reference track based on the updated reference track;
and the robot position control unit controls the position and the posture of the robot to make corresponding adjustment according to the received robot tail end position adjustment instruction and the current reference track.
Optionally, the position feedforward unit iteratively updates the position of the current reference trajectory according to the following formula:
Figure 254005DEST_PATH_IMAGE016
wherein the content of the first and second substances,
Figure 829212DEST_PATH_IMAGE017
in order to refer to the position of the track,
Figure 789078DEST_PATH_IMAGE018
for the number of iterations to be performed,
Figure 909481DEST_PATH_IMAGE019
in order to iterate the scaling factor,
Figure 158059DEST_PATH_IMAGE020
in order to iterate the differential coefficients, the coefficients are,
Figure 22110DEST_PATH_IMAGE021
the error of the expected contact force from the actual contact force.
Optionally, the method for calculating the attitude of the position feedforward unit based on the updated reference trajectory includes:
carrying out interpolation and difference on the updated reference track to obtain a speed vector of each control period;
and converting the actual contact force vector of each control period into a base coordinate system, and calculating the projection of the actual contact force vector on a plane perpendicular to the velocity vector of the corresponding period in the base coordinate system to be used as the attitude of the updated reference track.
Optionally, the actual contact force collecting device adopts a 3-dimensional force sensor, and the robot end processing tool is fixedly mounted on the 3-dimensional force sensor.
The invention improves the force control precision by adding the reference track in the robot machining operation, and simultaneously obtains the accurate reference track including the position and the posture by introducing the preprocessing step for subsequent formal machining. Therefore, on one hand, the position of the reference track is updated through an iterative learning method, namely the surface contour of the workpiece is obtained, on the other hand, the tail end attitude of the robot in the motion process along the reference track is estimated by utilizing the tail end speed information of the robot and the actual contact force information contained in the reference track, the influence of friction force is avoided, the position and the attitude of a tail end processing tool of the robot are controlled according to the obtained reference track, and normal constant force tracking in processing operation on various curved surfaces can be realized. In addition, the invention can be realized only by a 3-dimensional force sensor, and the cost increase caused by adopting a 6-dimensional force sensor is avoided.
It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the invention, as claimed.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate exemplary embodiments of the invention and together with the description, serve to explain the principles of the invention.
Fig. 1 is a schematic structural diagram of a conventional robot machining operation force control system (impedance/admittance control method);
FIG. 2 is a flow chart of one embodiment of a method for constant normal force tracking for robotic work operations according to the present disclosure;
FIG. 3 is a flow chart of one embodiment of a method for constant normal force tracking for robotic work operations according to the present disclosure;
FIG. 4 is a schematic structural diagram of an embodiment of a normal constant force tracking device for robotic work operations according to the present disclosure;
fig. 5 is a graph comparing the effect of an exemplary embodiment of a method for tracking a constant normal force in a robot machining operation with the prior art.
Detailed Description
Reference will now be made in detail to various exemplary embodiments of the invention, the detailed description should not be construed as limiting the invention but as a more detailed description of certain aspects, features and embodiments of the invention. Many modifications and variations may be made to the specific embodiments of the present disclosure without departing from the scope or spirit of the present disclosure.
Fig. 2 and 3 are flow charts of an embodiment of a method for tracking a constant normal force in a robotic work operation according to the present disclosure.
Example one
As shown in fig. 2, the method for tracking the constant normal force of the robot machining operation in this embodiment includes the following steps:
step S101: given an initial reference trajectory, including position and attitude
I.e. given a rough reference track
Figure 836482DEST_PATH_IMAGE026
Including position and attitude, where attitude refers to the attitude direction of the robot end tooling.
Optionally, the initial reference trajectory may be derived from teaching point positions, models, or traction teaching.
Step S102: and controlling the robot to move along the initial reference track, and ensuring that a tool at the tail end of the robot is always in contact with the workpiece in the moving process.
And setting the robot to move along a reference track, starting a force control function, and setting appropriate force control parameters such as reference force, damping and the like so as to ensure that a tool at the tail end of the robot is always in contact with a workpiece in the movement process.
Optionally, the robot is controlled to complete the above movement by using a currently common force control method based on impedance or admittance control.
Step S103: and iteratively calculating and updating the position of the current reference track according to the error between the actual contact force and the expected contact force to serve as the reference track of the next movement.
In the motion process, the robot force control unit can automatically adjust the position of the robot to ensure the force tracking precision, but due to the inaccurate track, certain errors exist between the actual contact force and the expected reference force. Updating the position of the reference track according to the error so as to reduce the error;
then, according to the updated reference track, the next movement is carried out, namely step S102 is repeated, the track is further updated, and the error is reduced;
through such a plurality of iterative updates, the iteration is terminated when the error converges to a desired range or the number of movements reaches a predetermined set value.
Optionally, the iteratively calculating and updating the position of the current reference trajectory according to the error between the actual contact force and the expected contact force in the motion process, as the reference trajectory of the next motion, includes:
collecting the actual contact force between the robot tail end tool and the workpiece in the motion process;
calculating an error between the actual contact force and the desired contact force;
updating the position of the current reference track according to the error;
the robot moves next time along the updated reference track;
and repeating the steps until the error between the actual contact force and the expected contact force converges to a set value or the movement times reach the set value, and finishing the iteration.
Optionally, the position of the current reference track is iteratively calculated and updated according to the following rules:
Figure 663141DEST_PATH_IMAGE016
wherein the content of the first and second substances,
Figure 399016DEST_PATH_IMAGE017
in order to refer to the position of the track,
Figure 801178DEST_PATH_IMAGE018
for the number of iterations to be performed,
Figure 673320DEST_PATH_IMAGE019
in order to iterate the scaling factor,
Figure 650372DEST_PATH_IMAGE020
in order to iterate the differential coefficients, the coefficients are,
Figure 670280DEST_PATH_IMAGE021
the error of the expected contact force from the actual contact force.
The track update may also adopt other existing update rules. These rules are updated based on the error in the force.
And obtaining the position information of the reference track in the base coordinate system at the end of the iteration.
Step S104: calculating the attitude based on the position of the reference trajectory obtained after the last update, namely when the iteration is finished, specifically comprising:
carrying out interpolation and difference on the updated reference track to obtain a speed vector of each control period;
converting the actual contact force vector of each control period into a base coordinate system;
the projection of the actual contact force vector on a plane perpendicular to the velocity vector of the corresponding period is calculated in the basis coordinate system as the pose of the updated reference trajectory.
For normal constant force tracking, the force application direction of the robot end machining tool is always perpendicular to the velocity vector, and a plane perpendicular to the velocity direction at each moment, namely a tool attitude plane at each moment, can be determined according to the constraint relation. And then calculating the projection of the actual contact force vector on the plane, wherein the projection direction is the normal direction of the workpiece surface in the control period, namely the attitude direction which the machining tool at the tail end of the robot needs to reach.
Optionally, the interpolating and differentiating the updated reference trajectory to obtain the velocity vector of each control period includes:
smoothing the updated reference track;
carrying out spline curve interpolation to obtain the position information of each control period;
and obtaining a velocity vector according to the change difference of the position.
Optionally, the method for obtaining the velocity vector according to the change difference of the position includes:
assume that the position at time T is
Figure 876134DEST_PATH_IMAGE022
The position at time T-1 is
Figure 868360DEST_PATH_IMAGE023
Velocity vector at time T
Figure 501467DEST_PATH_IMAGE024
Wherein
Figure 195623DEST_PATH_IMAGE025
Indicating a control period.
In each recording period of the robot machining process, actual contact force information is continuously acquired through the force acquisition device. Suppose the force information at time T is
Figure 1904DEST_PATH_IMAGE027
At this time
Figure 114217DEST_PATH_IMAGE028
For the force vector in the sensor coordinate system, by transforming the matrix
Figure 652646DEST_PATH_IMAGE029
Can be converted into vectors in the base coordinate system
Figure 850409DEST_PATH_IMAGE030
I.e. by
Figure DEST_PATH_IMAGE031
Calculating an actual contact force vector
Figure 912912DEST_PATH_IMAGE030
The projection in the plane perpendicular to the velocity vector results in the tool attitude perpendicular to the velocity direction during machining, i.e., the normal force application direction.
Therefore, high-precision reference track position and posture information can be completely obtained, and the follow-up robot applies constant force along the track and the posture, so that normal constant force machining can be realized.
Step S105: and controlling the robot to move according to the reference track obtained after the iteration, including the position and the posture, and using the reference track for formally processing the workpiece.
Example two
As shown in fig. 3, the difference between the present embodiment and the first embodiment is that after the track position is updated, the posture is updated each time. This method increases the amount of calculation, but can further improve the accuracy of the reference trajectory.
Figure 4 provides one embodiment of a robotic work operation normal constant force tracking device according to the present disclosure. As shown in fig. 4, the apparatus includes:
the force sensor is used as one of the actual contact force acquisition devices of the robot, is used for measuring the actual contact force between a machining tool at the tail end of the robot and a workpiece and feeds back the actual contact force to the force controller;
the force controller is a robot force control unit and is used for generating a robot tail end position adjusting instruction according to the error between the actual contact force and the expected contact force and sending the robot tail end position adjusting instruction to the robot position control unit;
the position feedforward unit is used for sending the current reference track to the robot position control unit; iteratively updating the position of the current reference track according to the error between the actual contact force and the expected contact force, and calculating the posture of the current reference track based on the updated reference track;
the robot is a position control unit of the robot, and the position and the posture of the robot are controlled to be correspondingly adjusted according to the received tail end position adjusting instruction of the robot and the current reference track;
in addition, the expected force in the figure is the preset expected contact force.
Optionally, the position feedforward unit iteratively updates the position of the current reference trajectory according to the following formula:
Figure 879731DEST_PATH_IMAGE016
wherein the content of the first and second substances,
Figure 589061DEST_PATH_IMAGE017
in order to refer to the position of the track,
Figure 274120DEST_PATH_IMAGE018
for the number of iterations to be performed,
Figure 422204DEST_PATH_IMAGE019
in order to iterate the scaling factor,
Figure 495727DEST_PATH_IMAGE020
in order to iterate the differential coefficients, the coefficients are,
Figure 907117DEST_PATH_IMAGE021
the error of the expected contact force from the actual contact force.
Optionally, the method for calculating the attitude of the position feedforward unit based on the updated reference trajectory includes:
carrying out interpolation and difference on the updated reference track to obtain a speed vector of each control period;
and converting the actual contact force vector of each control period into a base coordinate system, and calculating the projection of the actual contact force vector on a plane perpendicular to the velocity vector of the corresponding period in the base coordinate system to be used as the attitude of the updated reference track.
Optionally, the force sensor in this embodiment is a 3-dimensional force sensor, and the robot end-of-line processing tool is fixedly mounted on the 3-dimensional force sensor.
As can be seen from fig. 1, in this embodiment, a position feedforward unit is introduced into a currently-used force control processing control system, and on one hand, the unit stores a current reference trajectory and continuously sends the current reference trajectory to a position control unit in a robot movement process; meanwhile, in the preprocessing process, the position of the current reference track is continuously iteratively corrected through iterative learning, and the normal posture of the robot terminal processing tool is calculated based on the corrected reference track. After the final correction of the reference track is completed, in formal processing, the reference track (including the position and the attitude) recorded in the position feedforward unit is only required to be continuously sent to the position control unit.
Therefore, the contour position and normal posture of the surface of the workpiece can be obtained, the tail end of the robot is always perpendicular to the surface of the workpiece in the machining operation process, and the force tracking precision of the force control unit in a complex curved surface environment is greatly improved.
The effects are as follows:
given a desired force of 10N, the curve is constant-force tracked using a conventional force tracking method and a normal constant-force tracking method as described in the first embodiment, respectively, and the comparison of the actual contact force and the desired contact force is shown in fig. 5. It can be seen that, by adopting the normal constant force tracking method described in this embodiment, the actual contact force is substantially identical to the expected contact force, and compared with the prior art, the stability of the normal force in the robot machining operation is significantly improved, thereby improving the machining precision.
The foregoing is merely an illustrative embodiment of the present invention, and any equivalent changes and modifications made by those skilled in the art without departing from the spirit and principle of the present invention should fall within the protection scope of the present invention.

Claims (11)

1. A robot machining operation normal constant force tracking method comprises the following steps:
giving an initial reference trajectory comprising a position and a pose;
controlling the robot to move along the initial reference track, and ensuring that a tool at the tail end of the robot is always in contact with a workpiece in the moving process;
according to the error between the actual contact force and the expected contact force, iteratively calculating and updating the position of the current reference track to be used as the reference track of the next movement;
carrying out interpolation and difference on the updated reference track to obtain a speed vector of each control period;
converting the actual contact force vector of each control period into a base coordinate system, and calculating the projection of the actual contact force vector on a plane perpendicular to the velocity vector of the corresponding period in the base coordinate system to be used as the attitude of the updated reference track;
and controlling the robot to move according to the reference track obtained after the iteration, including the position and the posture, and using the reference track for formally processing the workpiece.
2. The normal constant force tracking method of claim 1, wherein the initial reference trajectory is derived from teach point locations, model derivation, or pull teaching.
3. The normal constant force tracking method of claim 1, wherein a force control method based on impedance or admittance control is used to control the robot to move along the initial reference trajectory and ensure that the robot end tool and the workpiece remain in contact at all times during the movement.
4. The normal constant force tracking method of claim 1, wherein the iteratively calculating and updating the position of the current reference trajectory as the reference trajectory for the next movement according to the error between the actual contact force and the expected contact force during the movement comprises:
collecting the actual contact force between the robot tail end tool and the workpiece in the motion process;
calculating an error between the actual contact force and the desired contact force;
updating the position of the current reference track according to the error;
the robot moves next time along the updated reference track;
and repeating the steps until the error between the actual contact force and the expected contact force converges to a set value or the movement times reach the set value, and finishing the iteration.
5. The normal constant force tracking method of claim 1, wherein the position of the current reference trajectory is iteratively calculated and updated according to the following rules:
Figure 65638DEST_PATH_IMAGE001
wherein the content of the first and second substances,
Figure 470075DEST_PATH_IMAGE002
in order to refer to the position of the track,
Figure 836858DEST_PATH_IMAGE003
for the number of iterations to be performed,
Figure 617733DEST_PATH_IMAGE004
in order to iterate the scaling factor,
Figure 134165DEST_PATH_IMAGE005
in order to iterate the differential coefficients, the coefficients are,
Figure 709502DEST_PATH_IMAGE006
the error of the expected contact force from the actual contact force.
6. The normal constant force tracking method of claim 1, wherein the interpolating and differentiating the updated reference trajectory to derive the velocity vector for each control cycle comprises:
smoothing the updated reference track;
carrying out spline curve interpolation to obtain the position information of each control period;
and obtaining a velocity vector according to the change difference of the position.
7. The normal constant force tracking method of claim 6, wherein the method of differentiating the velocity vector as a function of position is:
assume that the position at time T is
Figure 311385DEST_PATH_IMAGE007
The position at time T-1 is
Figure 646683DEST_PATH_IMAGE008
Velocity vector at time T
Figure 17621DEST_PATH_IMAGE009
Wherein
Figure 29439DEST_PATH_IMAGE010
Indicating a control period.
8. A robotic work normal constant force tracking device applying the method of any one of claims 1-7, comprising: robot force control unit, robot position control unit, actual contact force collection system, position feedforward unit, wherein:
the actual contact force acquisition device is used for measuring the actual contact force between the tail end processing tool of the robot and the workpiece and feeding back the actual contact force to the robot power control unit;
the robot force control unit is used for generating a robot tail end position adjusting instruction according to the error between the actual contact force and the expected contact force and sending the robot tail end position adjusting instruction to the robot position control unit;
the position feedforward unit is used for sending the current reference track to the robot position control unit; iteratively updating the position of the current reference track according to the error between the actual contact force and the expected contact force, and calculating the posture of the current reference track based on the updated reference track;
and the robot position control unit controls the position and the posture of the robot to make corresponding adjustment according to the received robot tail end position adjustment instruction and the current reference track.
9. The robotic work normal constant force tracking device of claim 8, wherein the position feed forward unit iteratively updates the position of the current reference trajectory according to:
Figure 587460DEST_PATH_IMAGE001
wherein the content of the first and second substances,
Figure 224983DEST_PATH_IMAGE002
in order to refer to the position of the track,
Figure 184849DEST_PATH_IMAGE003
for the number of iterations to be performed,
Figure 367569DEST_PATH_IMAGE004
in order to iterate the scaling factor,
Figure 944043DEST_PATH_IMAGE005
in order to iterate the differential coefficients, the coefficients are,
Figure 604832DEST_PATH_IMAGE006
the error of the expected contact force from the actual contact force.
10. The robotic work normal constant force tracking device of claim 8, wherein the method of the position feed forward unit calculating its pose based on the updated reference trajectory comprises:
carrying out interpolation and difference on the updated reference track to obtain a speed vector of each control period;
and converting the actual contact force vector of each control period into a base coordinate system, and calculating the projection of the actual contact force vector on a plane perpendicular to the velocity vector of the corresponding period in the base coordinate system to be used as the attitude of the updated reference track.
11. A robotic work operation normal constant force tracking device as defined in claim 8, wherein said actual contact force pick-up means employs a 3-dimensional force sensor, and wherein the robotic end-of-line work tool is fixedly mounted to said 3-dimensional force sensor.
CN202010103489.0A 2020-02-20 2020-02-20 Normal constant force tracking method and device for robot machining operation Active CN110948504B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010103489.0A CN110948504B (en) 2020-02-20 2020-02-20 Normal constant force tracking method and device for robot machining operation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010103489.0A CN110948504B (en) 2020-02-20 2020-02-20 Normal constant force tracking method and device for robot machining operation

Publications (2)

Publication Number Publication Date
CN110948504A CN110948504A (en) 2020-04-03
CN110948504B true CN110948504B (en) 2020-06-19

Family

ID=69985781

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010103489.0A Active CN110948504B (en) 2020-02-20 2020-02-20 Normal constant force tracking method and device for robot machining operation

Country Status (1)

Country Link
CN (1) CN110948504B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111722628B (en) * 2020-06-19 2021-07-09 江南大学 Point-to-point tracking control method for multi-agent track updating iterative learning
CN114274047B (en) * 2020-09-27 2023-09-12 中国科学院沈阳自动化研究所 Efficient precise polishing track optimization method based on force sensing measurement
CN112405536B (en) * 2020-11-10 2021-12-28 东南大学 High-precision constant force control method combining offline compensation and online tracking hybrid strategy
CN113110051B (en) * 2021-04-14 2022-03-04 南开大学 Polishing machine manpower/position hybrid control method and system considering error constraint
CN113459085A (en) * 2021-05-24 2021-10-01 南京航空航天大学 Complex curved surface robot fitting method based on force feedback
CN113910232B (en) * 2021-10-27 2022-12-20 苏州艾利特机器人有限公司 Self-adaptive attitude tracking method and device, storage medium and electronic equipment
CN114019798B (en) * 2021-11-03 2023-08-11 中国科学院深圳先进技术研究院 Robot track tracking control method, magnetic medical robot and storage medium

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102363301A (en) * 2011-10-19 2012-02-29 浙江工业大学 Method for adaptively tracking and controlling fingertip force of robot anthropomorphic finger
US10018238B2 (en) * 2013-11-01 2018-07-10 Sabanci University Variable negative stiffness actuation
CN106483964B (en) * 2015-08-31 2019-12-31 中南大学 Robot compliance control method based on contact force observer
CN109084722B (en) * 2018-06-20 2019-08-13 华中科技大学 A kind of adaptively sampled complex-curved contact measurement method

Also Published As

Publication number Publication date
CN110948504A (en) 2020-04-03

Similar Documents

Publication Publication Date Title
CN110948504B (en) Normal constant force tracking method and device for robot machining operation
CN108748159B (en) Self-calibration method for tool coordinate system of mechanical arm
CN108908327B (en) Robot positioning error grading compensation method
CN108515519B (en) Grinding path self-adaptive correction method based on force sensor
CN109782601B (en) Design method of self-adaptive neural network synchronous robust controller of coordinated mechanical arm
CN111347423B (en) Dynamic tracking gluing method for industrial robot conveyor belt
CN109159151A (en) A kind of mechanical arm space tracking tracking dynamic compensation method and system
CN110142762B (en) Robot joint position control method and device and robot
CN111546334B (en) Industrial robot online pose error compensation method for reducing contour error
CN111975579B (en) Robot constant-force polishing system based on polishing model and iterative algorithm
CN108115690A (en) A kind of robot adaptive control system and method
CN112405536B (en) High-precision constant force control method combining offline compensation and online tracking hybrid strategy
CN111515928B (en) Mechanical arm motion control system
CN114290147B (en) Automobile hub polishing system and method based on cooperation of duplex robot
CN114454060B (en) Robot self-adaptive curved surface tracking constant force polishing method and system
CN114505865A (en) Pose tracking-based mechanical arm path generation method and system
JP7307263B2 (en) Deburring device and control system
CN114310914A (en) Fuzzy self-adaptive iterative trajectory tracking control method and system for multi-degree-of-freedom mechanical arm
JP5765557B2 (en) Trajectory tracking device and method for machining robot
CN109397293B (en) Ground level error modeling and compensating method based on mobile robot
CN114378830B (en) Robot wrist joint singular avoidance method and system
CN114309926B (en) Three-dimensional complex surface-oriented laser marking method and system
CN112975960B (en) Method for establishing robot tail end fine control model and calibrating parameters
Zhang et al. Research on the algorithm of constant force grinding controller based on reinforcement learning PPO
JPH07210230A (en) Pipe surface copying control method using force control robot

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