CN113110051B - Polishing machine manpower/position hybrid control method and system considering error constraint - Google Patents

Polishing machine manpower/position hybrid control method and system considering error constraint Download PDF

Info

Publication number
CN113110051B
CN113110051B CN202110401790.4A CN202110401790A CN113110051B CN 113110051 B CN113110051 B CN 113110051B CN 202110401790 A CN202110401790 A CN 202110401790A CN 113110051 B CN113110051 B CN 113110051B
Authority
CN
China
Prior art keywords
force
contact force
target
model
actual
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
CN202110401790.4A
Other languages
Chinese (zh)
Other versions
CN113110051A (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.)
Nankai University
Original Assignee
Nankai University
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 Nankai University filed Critical Nankai University
Priority to CN202110401790.4A priority Critical patent/CN113110051B/en
Publication of CN113110051A publication Critical patent/CN113110051A/en
Application granted granted Critical
Publication of CN113110051B publication Critical patent/CN113110051B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

The utility model provides a polishing machine manpower/position hybrid control method and system considering error constraint, comprising: establishing a model of contact force between an end effector of the polishing robot and the environment; obtaining an actual contact force between the environment and the robot end effector based on the model, and adjusting a target position in a force control direction according to an error between the actual contact force and a target contact force so that the actual contact force can track the target contact force; and the position control is realized through a high-precision servo driver packaged in the industrial robot. In consideration of the fact that in an actual polishing system, the accurate value of the environmental rigidity is difficult to obtain, certain uncertainty exists, unknown disturbance and other unmodeled dynamics exist, a contact force model is provided when the robot end effector is in contact with the environment, and therefore description of the contact force is closer to the actual situation. The force/position hybrid control method provided by the invention can realize accurate track tracking and force tracking and ensure that the force tracking error is always within a set limit.

Description

Polishing machine manpower/position hybrid control method and system considering error constraint
Technical Field
The disclosure belongs to the technical field of automatic control of industrial robots, and particularly relates to a manual/position hybrid control method and system for a polishing machine.
Background
The statements in this section merely provide background information related to the present disclosure and may not necessarily constitute prior art.
With the rapid development of modern industry, the production requirements cannot be met by simple manual operation, and the defects are gradually revealed. Nowadays, the automation level is continuously improved, the application field of the robot is continuously widened, and the robot also gradually occupies an indispensable position in industrial production. In the initial stage, the robot only needs to complete some work (such as stacking, spray painting and the like) requiring accurate position control, and along with the occurrence of more contact operations (such as grinding, polishing, assembling, medical treatment and the like), not only certain requirements on position control are required, but also the interaction relationship between the robot and the environment needs to be considered, namely the flexibility of the robot.
Compliance studies can be divided into passive compliance and active compliance. Active compliance (force control), namely, a certain control strategy is designed by utilizing feedback information, so that the control on the position and the contact force is realized. In recent years, many force control methods have been proposed by many scholars, most of which can be classified into two types, impedance control and force/bit hybrid control.
The force/bit hybrid control performs force control in the desired direction and position control in the remaining direction. Therefore, the force control and the position control are independently carried out, and on one hand, the controller design in practical application is more flexible. On the other hand, by analyzing common contact type operations (grinding, polishing and the like), the contact force needing to be controlled is generally vertical to the surface of the workpiece, which also conforms to the theoretical characteristics of force/position mixed control.
Initially, the force/position hybrid control method directly designs the robot joint torque, so as to track the target position and the target force. This method is possible theoretically, but takes into account the following practical situations of today's industrial robots: 1) for safety and privacy concerns, the manufacturer does not open the source of the robot joint torque control part and the user cannot access it. 2) The complete dynamics of industrial robots (especially high-degree-of-freedom robots) are not accurately available and the models are too complex to be used for controller design. It seems to be very difficult to directly control the joint moment of the industrial robot. In such cases, some methods that are not based on kinetic models are proposed.
In summary, the present application is directed to the following problems: how to realize accurate positioning and reach the tracking target force in actual production by the polishing robot, and guarantee that the force tracking error is in a certain range, the accurate polishing of the robot is effectively realized.
Disclosure of Invention
In order to overcome the deficiencies of the prior art, the present disclosure provides a polishing machine manual/position hybrid control method considering error constraints, which can realize accurate force tracking and ensure that the force tracking error is always kept within a preset limit.
In order to achieve the above object, one or more embodiments of the present disclosure provide the following technical solutions:
in a first aspect, a method of hybrid error-constrained human/machine force/position control for a grinding machine is disclosed, comprising:
establishing a model of contact force between an end effector of the polishing robot and the environment;
and obtaining an actual contact force between the environment and the robot end effector based on the model, and adjusting the target position in the force control direction by using a force controller according to the error between the actual contact force and the target contact force so that the actual contact force can track the target contact force.
According to the further technical scheme, after the target position in the force control direction is obtained, the target track of the position control subspace is combined with the target position in the force control subspace through setting the selection matrix, and the force/position mixed target track is obtained.
According to the further technical scheme, the force/position mixed target track is sent to the polishing robot, the polishing robot obtains a target joint angle through inverse kinematics, and then a high-precision servo driver packaged in the polishing robot drives the joint to reach the target angle, so that position control is achieved. And then according to the current joint angle, obtaining the actual track of the current robot end effector and the position of the current robot end effector in the force control direction through positive kinematics of the robot.
In the present disclosure, consider first that the environment is represented directly by a simple rigid model. On the basis, the final contact force model is established by considering the unmodeled dynamics such as unknown disturbance and the like in the contact process of the polishing robot and the environment and the difficulty in obtaining the accurate value of the environmental rigidity.
In a further technical scheme, a model of the contact force of unmodeled dynamics is considered, specifically:
f(t)=ks[xtf(t)-xe]+d(t),
where t denotes time, the variable is followed by (t) denotes the variable as a function of time t, f (t) denotes the actual contact force, ksIs the environmental stiffness, xtf(t) is the robot end effector position in the force control direction, xeRepresenting the environment position, d (t) is unmodeled dynamics such as unknown disturbance.
According to the further technical scheme, k is defined based on the fact that an accurate value of environmental rigidity cannot be obtained in actual productionsK is k + Δ ksIs an unknown difference, the model of the contact force is arranged to
f(t)=k[xtf(t)-xe]+Δk[xtf(t)-xe]+d(t)
=k[xtf(t)-xe]+b(t),
Where b (t) represents the unknown part of the model.
According to the further technical scheme, a force controller is constructed according to the error between the actual contact force and the target contact force, and the force controller is as follows:
Figure GDA0003077956080000031
where t denotes time, the variable is followed by (t) denotes that the variable is a function with respect to time t, some of the variables are left out by (t) for the sake of clarity, sgn is a sign function, k is the nominal value of the stiffness of the environment, e is the force tracking error,
Figure GDA0003077956080000032
is the first derivative of e with respect to time, fdWhich is indicative of the target contact force,
Figure GDA0003077956080000033
is fdFirst derivative with respect to time, α ∈ R+Representing actual industrial applicationPreset limit of force tracking error, k0,k1Are both positive control gains and η is a positive gain. Furthermore, k1Need to satisfy
Figure GDA0003077956080000034
Where σ is a positive upper bound constant.
In a second aspect, a hybrid error-constrained grinding robot force/position control system is disclosed, comprising:
the model building module is used for building a model of contact force between the polishing robot end effector and the environment;
and the force tracking module is used for obtaining an actual contact force between the environment and the robot end effector based on the model, and adjusting the target position in the force control direction according to an error between the actual contact force and the target contact force, so that the actual contact force can track the target contact force.
The above one or more technical solutions have the following beneficial effects:
in consideration of the fact that in an actual polishing system, the accurate value of the environmental rigidity is difficult to obtain, certain uncertainty exists, unknown disturbance and other unmodeled dynamics exist, a contact force model is provided when the robot end effector is in contact with the environment, and therefore description of the contact force is closer to the actual situation.
The invention provides a force/position hybrid control method considering error constraint based on an established contact force model by fully considering the actual situation of a robot during polishing, and particularly provides a force controller which can realize accurate force tracking and ensure that the force tracking error is always kept within a preset limit. In addition, the method can ensure the stability of the whole force control closed loop system, and is suitable for the track tracking and the target force tracking of contact robots such as industrial grinding, polishing and the like.
Advantages of additional aspects of the invention will be set forth in part in the description which follows, and in part will be obvious from the description, or may be learned by practice of the invention.
Drawings
The accompanying drawings, which are included to provide a further understanding of the disclosure, illustrate embodiments of the disclosure and together with the description serve to explain the disclosure and are not to limit the disclosure.
FIG. 1 is a block diagram of the control architecture of the hybrid force/bit control method of the present invention;
FIG. 2 is a numerical simulation result of the force control method of the present invention, in which the contact force and force tracking error correspond to f and e, respectively;
FIG. 3 is a numerical simulation result of prior art 1 in a comparative simulation, where contact force and force tracking error correspond to f and e, respectively;
fig. 4 is the result of numerical simulation of prior art 2 in a comparative simulation, where contact force and force tracking error correspond to f and e, respectively.
Detailed Description
It should be noted that the following detailed description is exemplary and is intended to provide further explanation of the disclosure. 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 disclosure belongs.
It is noted that the terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of example embodiments according to the present disclosure. As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, and it should be understood that when the terms "comprises" and/or "comprising" are used in this specification, they specify the presence of stated features, steps, operations, devices, components, and/or combinations thereof, unless the context clearly indicates otherwise.
The embodiments and features of the embodiments in the present disclosure may be combined with each other without conflict.
Example one
The embodiment discloses a grinding machine manpower/position hybrid control method considering error constraint, which comprises the following steps:
providing a model of the contact force between the polishing robot and the environment;
giving an integral structure of a force/position hybrid control method considering error constraint, and providing a force controller;
setting system parameters of a polishing system;
obtaining an actual contact force between the tail end of the robot and the environment according to the contact force model;
acquiring a force control input signal for controlling the robot end effector according to the force controller;
and accurately tracking the target force according to the force control input signal, ensuring that the force tracking error is within a set limit, and simultaneously realizing position control through a high-precision servo driver packaged in the industrial robot.
System parameters of the robotic polishing system include: environmental position, environmental stiffness, and unmodeled dynamics such as unknown disturbances.
The control targets include: 1) controlling the robot end effector to track a target track; 2) controlling the contact force between the robot end effector and the environment to accurately track the contact force of the target; 3) the limiting force tracking error does not exceed a preset limit throughout the control process. The invention can realize accurate track tracking and force tracking and ensure that the force tracking error is always within a set limit.
In the specific implementation example, regarding the environment model:
for sanding tasks, a suitable sanding force is necessary, but in reality it is difficult to measure the sanding force directly. Through analysis of the sanding force generation process, the end effector is found to be always perpendicular to the surface of the workpiece, thereby generating a normal contact force (i.e., pressure) and a sanding force. Furthermore, sanding force is directly proportional to normal contact force. Based on this physical relationship, the contact force is usually directly analyzed and controlled to obtain a suitable sanding force.
During the sanding process, the environment is directly represented by a simple rigid model. On the basis, the following contact force model is obtained by considering the unmodeled dynamics such as unknown disturbance in the contact process:
f(t)=ks[xtf(t)-xe]+d(t), (1)
where t represents time and the variable is followed by (t) a variable that is a function of time t. f (t) tableShowing the actual contact force, ksIs the environmental stiffness, xtf(t) is the robot end effector position in the force control direction, xeRepresenting the environment position, d (t) is unmodeled dynamics such as unknown disturbance.
Considering that it is difficult to obtain an accurate value of the environmental rigidity in practical production, we define ksK is k + Δ ksIs an unknown difference. Then (1) can be arranged into
Figure GDA0003077956080000061
Where b (t) represents the unknown part of the model, which is physically bounded in practical applications.
With regard to implementation of specific force/bit hybrid control:
the control target is to make the robot end effector track the target track to realize the target force tracking.
Regarding the structure of the force/bit hybrid control method, the invention provides a force/bit hybrid control method considering error constraint, and the structure is shown in fig. 1. In the figure, fdFor the target contact force, f is the actual contact force, e ═ f-fdRepresenting force tracking error, xpTarget trajectory, x, representing a position control subspacefRepresenting the target position, x, of the force control subspacedRepresenting a force/position hybrid target trajectory, x being the actual trajectory of the robot end-effector, xtfThe robot end effector position in the force control direction.
The structure of the whole control method is explained from the following four aspects:
1) the actual contact force. As discussed previously, the actual contact force f between the environment and the robotic end effector is described using a contact force model (2) that accounts for unmodeled dynamics and environmental stiffness uncertainties.
In the scheme of the disclosure, both the contact force model and the environment model refer to the same model.
2) A force controller. According to the actual contact force f and the target contact force fdError e between, force controller adjusting force controlTarget position x in directionfEnabling f to track the target contact force fd. The controller designed will be described in the next subsection.
3) Force/position mixes the target trajectory. The position is controlled to the target trajectory x of the subspace by setting selection matrices S and S '(S' ═ I-S, I is an identity matrix)pWith a target position x in the force control subspacefCombined to obtain a force/position mixed target track xd
4) And controlling the position of the robot. Target locus x in Cartesian spacedProviding the target joint angle q to the robot body and obtaining the target joint angle q by using the inverse kinematics of the robotd. The servo driver packaged in the industrial robot can drive the robot joint to the target joint angle qd. According to the current joint angle q, the actual track x and the position x in the force control direction of the current robot end effector can be obtained through positive kinematics of the robottf. Since the servo driver is directly packaged in the industrial robot and the control precision is high, the part is not designed for the moment, and the invention assumes that x is xd,xtf=xf
About force controller
Based on the model and the above control structure, a position-based force controller is proposed. First, the force tracking error e is expressed as follows:
Figure GDA0003077956080000088
where t represents time and the variable is followed by (t) a variable that is a function of time t. k is the ambient stiffness ksNominal value of (a), xf(t) target position in force control subspace, xeRepresenting the position of the environment, b (t) representing the unknown part of the model, fd(t) is the target contact force. By deriving e with respect to time, it is obtained
Figure GDA00030779560800000810
The following were used:
Figure GDA0003077956080000081
where t represents time, the variable being followed by (t) a variable representing the variable as a function of time t,
Figure GDA0003077956080000082
is the first derivative of b (t) with respect to time. Based on
Figure GDA0003077956080000083
Is designed as the following force controller
Figure GDA0003077956080000084
Figure GDA0003077956080000085
Where t denotes time, and a variable followed by (t) denotes that the variable is a function of time t, and some variables followed by (t) are omitted for simplicity. sgn is a sign function, k is the nominal value of the ambient stiffness, e is the force tracking error,
Figure GDA0003077956080000089
is the first derivative of e with respect to time, fdWhich is indicative of the target contact force,
Figure GDA0003077956080000086
is fdFirst derivative with respect to time, α ∈ R+Preset limit, k, representing force tracking error in practical industrial applications0,k1Are both positive control gains and η is a positive gain. Furthermore, k1Need to satisfy
Figure GDA0003077956080000087
Where σ is a positive upper bound constant.
Example two
This embodiment discloses a hybrid control system of a grinding robot power/position considering error constraints, comprising:
the model building module is used for building a model of contact force between the polishing robot end effector and the environment;
and the force tracking module is used for obtaining an actual contact force between the environment and the robot end effector based on the model, and adjusting the target position in the force control direction according to an error between the actual contact force and the target contact force, so that the actual contact force can track the target contact force.
EXAMPLE III
The embodiment aims to provide a simulation platform.
In order to achieve the purpose, the invention adopts the following technical scheme:
the embodiment provides a manual control simulation platform of a grinding machine, which is built under the environment of MATLAB/Simulink. The method comprises the following steps: the touch force model, the parameter setting module, the controller, the output display and the like.
When the simulation platform verifies the control method, the following steps are realized:
receiving set system parameters and target contact force;
acquiring an actual contact force between the tail end of the robot and the environment according to the contact force model;
and acquiring a force control input signal for controlling the robot end effector according to the force controller, realizing accurate tracking of the target force and ensuring that the force tracking error is within a set limit.
And (3) simulation results:
in order to verify the effectiveness of the force controller designed by the invention, simulation is carried out on a built simulation platform. In the simulation, nominal values for the environmental position and the environmental stiffness are given as follows:
xe=10-3m,k=2000N/m,
wherein m represents rice and N represents cattle.
Further, it is considered that in actual production, in order to ensure product quality, it is necessary to limit the force tracking error to a certain range. The present simulation defines the upper error bound α as 1.88N. And consider the system unknown part as follows:
b(t)=e0.1sin(0.3t)cos(t). (7)
in order to start the robot smoothly and avoid sudden impacts, the following target contact forces are chosen:
fd(t)=20-20e-10t. (8)
the simulation uses a proportional-integral controller (PI) and a force control method proposed by Ma, etc. (B.Ma, Y.Fang, X.Huang, and S.Wu, Adaptive hybrid force/position control for an industrial robot: the Theory and experience, High technology letters, vol.16, No.2, pp.171-177,2010) as a comparison method.
First, the control gain of the force controller proposed by the present invention is
k0=4,k1=2,η=1.5.
Through parameter adjustment, the gain in the proportional-integral controller is selected as follows:
kp=-3×10-3,ki=-5×10-3.
likewise, the gain of the force control method proposed by Ma et al is:
ke=0.8,kλ=0.1.
FIGS. 2, 3 and 4 show simulation results of the force control method proposed by the force controller, proportional-integral controller and Ma, etc., respectively, of the present invention, in which the contact force and force tracking error correspond to f and e, respectively, and the dotted line of the 1 st sub-graph (from top to bottom) represents the target contact force f of fd. By utilizing the force control method provided by the invention, the contact force can quickly track the target force and is stabilized at 20N without overshoot, which is very important for safe and accurate grinding. Forces exceeding a preset value can cause damage to the workpiece surface. And, it can be seen that the force tracking error is always within preset limits throughout the control process. However, under the action of the proportional-integral controller and the control method proposed by Ma, etc., the target force tracking can also be realized, but the problems of tracking delay and large initial error respectively exist. Furthermore, the maximum error exceeds 1.88N.
In conclusion, the method of the invention can obtain more satisfactory control effect, effectively realize accurate force tracking and ensure that the force tracking error is within the preset limit.
Those skilled in the art will appreciate that the modules or steps of the present disclosure described above can be implemented using general purpose computer means, or alternatively, they can be implemented using program code executable by computing means, whereby the modules or steps may be stored in memory means for execution by the computing means, or separately fabricated into individual integrated circuit modules, or multiple modules or steps thereof may be fabricated into a single integrated circuit module. The present disclosure is not limited to any specific combination of hardware and software.
The above description is only a preferred embodiment of the present disclosure and is not intended to limit the present disclosure, and various modifications and changes may be made to the present disclosure by those skilled in the art. Any modification, equivalent replacement, improvement and the like made within the spirit and principle of the present disclosure should be included in the protection scope of the present disclosure.
Although the present disclosure has been described with reference to specific embodiments, it should be understood that the scope of the present disclosure is not limited thereto, and those skilled in the art will appreciate that various modifications and changes can be made without departing from the spirit and scope of the present disclosure.

Claims (5)

1. A polishing machine manpower/position hybrid control method considering error constraint is characterized by comprising the following steps:
establishing a model of contact force between an end effector of the polishing robot and the environment;
obtaining an actual contact force between the environment and the robot end effector based on the model, and adjusting a target position in a force control direction by using a force controller according to an error between the actual contact force and a target contact force so that the actual contact force can track the target contact force;
the contact force model specifically comprises:
f(t)=ks[xtf(t)-xe]+d(t),
where t denotes time, the variable is followed by (t) denotes the variable as a function of time t, f (t) denotes the actual contact force, ksIs the environmental stiffness, xtf(t) is the robot end effector position in the force control direction, xeRepresenting the environment position, d (t) is unmodeled dynamics such as unknown disturbance and the like;
defining k based on the fact that an accurate value of the environmental rigidity cannot be obtained in actual productionsK is k + Δ ksIs an unknown difference, the model of the contact force is arranged to
Figure FDA0003462228910000011
Wherein b (t) represents the unknown part of the model;
constructing a force controller according to the error between the actual contact force and the target contact force, wherein the force controller is as follows:
Figure FDA0003462228910000012
where t denotes time, the variable is followed by (t) denotes that the variable is a function with respect to time t, some of the variables are left out by (t) for the sake of clarity, sgn is a sign function, k is the nominal value of the stiffness of the environment, e is the force tracking error,
Figure FDA0003462228910000013
is the first derivative of e with respect to time, fdWhich is indicative of the target contact force,
Figure FDA0003462228910000021
is fdFirst derivative with respect to time, α ∈ R+Preset limit, k, representing force tracking error in practical industrial applications0,k1Are all positive control gains, eta is a positive gain, and k is1Need to satisfy
Figure FDA0003462228910000022
Where σ is a positive upper bound constant.
2. A method as claimed in claim 1 for error constrained hybrid control of a grinding machine tool, wherein after the target position in the force control direction is obtained, the target trajectory in the position control subspace is combined with the target position in the force control subspace by setting the selection matrix to obtain a force/position hybrid target trajectory.
3. The method as claimed in claim 1, wherein the force/position mixed target trajectory is transmitted to the polishing robot, the polishing robot obtains a target joint angle through inverse kinematics, the joint is driven to the target angle through a high-precision servo driver encapsulated inside the polishing robot, so as to realize position control, and then the actual trajectory and the position of the current robot end effector in the force control direction are obtained through the robot positive kinematics according to the current joint angle.
4. Consider machine people power/position hybrid control system that polishes of error constraint, characterized by includes:
the model building module is used for building a model of contact force between the polishing robot end effector and the environment;
the force tracking module is used for obtaining an actual contact force between the environment and the robot end effector based on the model, and adjusting a target position in a force control direction according to an error between the actual contact force and a target contact force so that the actual contact force can track the target contact force;
the contact force model specifically comprises:
f(t)=ks[xtf(t)-xe]+d(t),
where t denotes time, the variable is followed by (t) denotes the variable as a function of time t, f (t) denotes the actual contact force, ksIs the environmental stiffness, xtf(t) machines in force-controlled directionHuman end effector position, xeRepresenting the environment position, d (t) is unmodeled dynamics such as unknown disturbance and the like;
defining k based on the fact that an accurate value of the environmental rigidity cannot be obtained in actual productionsK is k + Δ ksIs an unknown difference, the model of the contact force is arranged to
Figure FDA0003462228910000031
Wherein b (t) represents the unknown part of the model;
constructing a force controller according to the error between the actual contact force and the target contact force, wherein the force controller is as follows:
Figure FDA0003462228910000032
where t denotes time, the variable is followed by (t) denotes that the variable is a function with respect to time t, some of the variables are left out by (t) for the sake of clarity, sgn is a sign function, k is the nominal value of the stiffness of the environment, e is the force tracking error,
Figure FDA0003462228910000033
is the first derivative of e with respect to time, fdWhich is indicative of the target contact force,
Figure FDA0003462228910000034
is fdFirst derivative with respect to time, α ∈ R+Preset limit, k, representing force tracking error in practical industrial applications0,k1Are all positive control gains, eta is a positive gain, and k is1Need to satisfy
Figure FDA0003462228910000035
Where σ is a positive upper bound constant.
5. Machine manual control simulation platform polishes, characterized by includes: a controller configured to perform the steps of the method of any of claims 1-3.
CN202110401790.4A 2021-04-14 2021-04-14 Polishing machine manpower/position hybrid control method and system considering error constraint Active CN113110051B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110401790.4A CN113110051B (en) 2021-04-14 2021-04-14 Polishing machine manpower/position hybrid control method and system considering error constraint

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110401790.4A CN113110051B (en) 2021-04-14 2021-04-14 Polishing machine manpower/position hybrid control method and system considering error constraint

Publications (2)

Publication Number Publication Date
CN113110051A CN113110051A (en) 2021-07-13
CN113110051B true CN113110051B (en) 2022-03-04

Family

ID=76716893

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110401790.4A Active CN113110051B (en) 2021-04-14 2021-04-14 Polishing machine manpower/position hybrid control method and system considering error constraint

Country Status (1)

Country Link
CN (1) CN113110051B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114800505B (en) * 2022-04-25 2024-02-20 珠海格力智能装备有限公司 Robot operation control method and device

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4860215A (en) * 1987-04-06 1989-08-22 California Institute Of Technology Method and apparatus for adaptive force and position control of manipulators
CN105242677A (en) * 2015-07-31 2016-01-13 中国人民解放军国防科学技术大学 Quadruped robot biped support phase force hybrid force control method
CN105729305A (en) * 2016-03-23 2016-07-06 吉林大学 Force position coupling micro-motion precise polishing device and online force detection and control method
CN106041926A (en) * 2016-06-12 2016-10-26 哈尔滨工程大学 Industrial mechanical arm force/position mixed control method based on Kalman filter
CN107107951A (en) * 2014-12-25 2017-08-29 日本精工株式会社 Electric power-assisted steering apparatus
CN107263541A (en) * 2017-06-19 2017-10-20 中山长峰智能自动化装备研究院有限公司 Robot and control method and system for force tracking error of robot
EP3291032A1 (en) * 2016-09-05 2018-03-07 Omron Corporation Model predictive control device, control method of model predictive control device, information processing program and recording medium
WO2018083008A1 (en) * 2016-11-02 2018-05-11 Kuka Roboter Gmbh Calibrating a model of a process robot and operating a process robot
CN108439209A (en) * 2018-04-28 2018-08-24 南开大学 Position control method, apparatus and system in drive lacking marine hoist finite time
CN108519739A (en) * 2018-04-20 2018-09-11 电子科技大学 Based on the multi-time Delay remote control system stability control method to power and position prediction
CN108594656A (en) * 2018-04-04 2018-09-28 东南大学 One kind is bilateral to lift the anti-interference continuous sliding-mode control of robot system high-precision
EP3476724A2 (en) * 2017-10-31 2019-05-01 The Boeing Company Adaptive feedback control of force fighting in hybrid actuation systems
CN110948504A (en) * 2020-02-20 2020-04-03 中科新松有限公司 Normal constant force tracking method and device for robot machining operation
CN111176318A (en) * 2020-02-10 2020-05-19 南开大学 Positioning and swing eliminating method and system for flying handling system for eliminating steady-state error

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100517880B1 (en) * 2003-11-20 2005-09-28 학교법인 포항공과대학교 Off-line feed rate scheduling for reduction of machining time and enhancement of machining accuracy in cnc machining
US10133246B2 (en) * 2014-09-12 2018-11-20 Canon Kabushiki Kaisha Position control device and position control method, optical device, and image pickup apparatus
CN106965187B (en) * 2017-05-25 2020-11-27 北京理工大学 Method for generating feedback force vector when bionic hand grabs object
JP6934173B2 (en) * 2017-07-12 2021-09-15 国立大学法人九州大学 Force control device, force control method and force control program

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4860215A (en) * 1987-04-06 1989-08-22 California Institute Of Technology Method and apparatus for adaptive force and position control of manipulators
CN107107951A (en) * 2014-12-25 2017-08-29 日本精工株式会社 Electric power-assisted steering apparatus
CN105242677A (en) * 2015-07-31 2016-01-13 中国人民解放军国防科学技术大学 Quadruped robot biped support phase force hybrid force control method
CN105729305A (en) * 2016-03-23 2016-07-06 吉林大学 Force position coupling micro-motion precise polishing device and online force detection and control method
CN106041926A (en) * 2016-06-12 2016-10-26 哈尔滨工程大学 Industrial mechanical arm force/position mixed control method based on Kalman filter
EP3291032A1 (en) * 2016-09-05 2018-03-07 Omron Corporation Model predictive control device, control method of model predictive control device, information processing program and recording medium
WO2018083008A1 (en) * 2016-11-02 2018-05-11 Kuka Roboter Gmbh Calibrating a model of a process robot and operating a process robot
CN107263541A (en) * 2017-06-19 2017-10-20 中山长峰智能自动化装备研究院有限公司 Robot and control method and system for force tracking error of robot
EP3476724A2 (en) * 2017-10-31 2019-05-01 The Boeing Company Adaptive feedback control of force fighting in hybrid actuation systems
CN108594656A (en) * 2018-04-04 2018-09-28 东南大学 One kind is bilateral to lift the anti-interference continuous sliding-mode control of robot system high-precision
CN108519739A (en) * 2018-04-20 2018-09-11 电子科技大学 Based on the multi-time Delay remote control system stability control method to power and position prediction
CN108439209A (en) * 2018-04-28 2018-08-24 南开大学 Position control method, apparatus and system in drive lacking marine hoist finite time
CN111176318A (en) * 2020-02-10 2020-05-19 南开大学 Positioning and swing eliminating method and system for flying handling system for eliminating steady-state error
CN110948504A (en) * 2020-02-20 2020-04-03 中科新松有限公司 Normal constant force tracking method and device for robot machining operation

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Improvement of dynamic characteristics during transient response of force-sensorless grinding robot by force/position control;Ken Adachi,等;《IEEE》;20131231;第710-715页 *
抗扭式机械臂系列汇总与总装应用研究;马涛,等;《客车技术》;20171231;第35-37页 *

Also Published As

Publication number Publication date
CN113110051A (en) 2021-07-13

Similar Documents

Publication Publication Date Title
CN109382828B (en) Robot shaft hole assembling system and method based on teaching learning
US7340323B2 (en) Industrial robot with controlled flexibility and simulated force for automated assembly
Nagata et al. Development of CAM system based on industrial robotic servo controller without using robot language
Cao et al. Smooth adaptive hybrid impedance control for robotic contact force tracking in dynamic environments
CN108628188A (en) Control system, controller and control method
Mesmer et al. Robust design of independent joint control of industrial robots with secondary encoders
CN112405536B (en) High-precision constant force control method combining offline compensation and online tracking hybrid strategy
CN113110051B (en) Polishing machine manpower/position hybrid control method and system considering error constraint
US20240208053A1 (en) Autonomous robust assembly planning
Wen et al. A novel 3D path following control framework for robots performing surface finishing tasks
Haviland et al. A purely-reactive manipulability-maximising motion controller
CN114290147A (en) Automobile hub polishing system and method based on cooperation of duplex robot
CN115723137A (en) Compliant task control method based on plane constant force
Pedrocchi et al. Design of fuzzy logic controller of industrial robot for roughing the uppers of fashion shoes
Cervantes et al. A robust velocity field control
CN114055467A (en) Space pose online simulation system based on five-degree-of-freedom robot
Chen et al. Robotic compliant grinding of curved parts based on a designed active force-controlled end-effector with optimized series elastic component
Mills Hybrid control: A constrained motion perspective
Owen et al. Stiffness optimization for two‐armed robotic sculpting
Bo et al. Review of robotic control strategies for industrial finishing operations
CN114310571B (en) Intelligent control method in robot automatic grinding operation process
Huang et al. Compliant motion adaptation with dynamical system during robot-environment interaction
Yovchev Finding the optimal parameters for robotic manipulator applications of the bounded error algorithm for iterative learning control
Korayem et al. Hardware implementation of a closed loop controller on 6R robot using ARM microcontroller
JP2020055095A (en) Control device and control system

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