This paper presents the formulation of an impedance controller for regulating the contact force with the environment. To achieve an accurate force tracking control, uncertainties in both robot dynamics and the environment require to be addressed. As part of the framework of the proposed force tracking formulation, a neural network is introduced at the desired trajectory to compensate for all uncertainties in an on-line manner. Compensation at the input trajectory leads to a remarkable structural advantage in that no modifications of the internal force controllers are required. Minimizing the objective function of the training signal for a neural network satisfies the desired force tracking performance. A neural network actually compensates for uncertainties at the input trajectory level in an on-line fashion. Simulation results confirm the position and force tracking abilities of a robot manipulator.
1. Introduction
Robot tasks have become increasingly sophisticated and complicated as our desire for robots has grown. Robots are gradually being used in our daily lives in more varied ways. Through their ability to manipulate objects, service robots are now required to interact more frequently with humans, beyond simple house cleaning chores. The corresponding technologies are necessary for robots to perform more challenging and sophisticated tasks including not only position control but also force control for two-arm manipulation.
Indeed, in the near future, service robots should be able to handle objects to satisfy the specifications of their given tasks and to interact and cooperate with humans in a natural manner
[1]
. Robot interaction with humans and the environment requires active force control techniques.
In robot research communities, force control is a sophisticated control methodology for robots interacting with their environment, including humans. To achieve successful force tracking performances, several problems need to be solved
a priori
. First, a direct force tracking capability for following the desired force command is required for the formulation of a control law. Second, accurate position tracking control should be achieved by compensating for uncertainties in robot dynamics. Third, uncertainties in estimating the environment, such as stiffness and location, should be properly addressed.
Various control algorithms have been proposed to alleviate the aforementioned problems of force control tasks. From the pioneering works of impedance control and hybrid force control algorithms, to intelligent force control algorithms, many researches have been presented on this subject
[2
-
5]
, and force control algorithms have been modified for an improved performance
[6
-
10]
.
The trend of merging the concept of intelligence into a system has yielded methods of intelligent force control. Neural network, which is known to be an intelligent tool, is utilized along with robot controllers to improve the tracking performance
[11
-
22]
. Neural networks are well known for their nonlinear mapping, adaptation, and learning capabilities, and many successful results have been reported in the literature. Fuzzy logic is also a well-known intelligent tool that interprets human expressions for a machine system. Although fuzzy logic controllers are considerably practical and can be easily implemented through hardware, fuzzy logic suffers from the setting of optimal fuzzy rules. Determining the optimal fuzzy rules is a time-consuming process
[23]
.
In a force control framework, neural network algorithms have been used for industrial manipulators to address both unknown objects and unknown robot dynamics
[11
-
17]
. A combined control structure for the both a
H
∞
control method and a neural network has been proposed
[18]
. In addition, to accelerate the advantages of fuzzy logic and neural networks, a combined structure called a neuro-fuzzy control scheme was proposed
[19
,
20
,
24]
.
In our previous research
[11]
, a neural network was used for impedance control formulation to nullify any uncertainties. Experimental studies on regulating the contact forces for an x-y table robot have shown that a neural network performs considerably well for force tracking tasks in an on-line manner. Neural networks compensate for uncertainties at the control input level. This has led to modifications of the internal force control structure. In reality, however, many robots were designed for position control using sealed control structures that do not allow modifications of the control algorithms.
In this paper, a different structure for the use of a neural network in a force-controlled robot manipulator
[11
,
13]
is proposed. Here, a neural network is used to compensate for all uncertainties at the input trajectory level. This scheme is known as reference compensation technique used for the position control of robot manipulators
[25
,
26]
. This structure provides a remarkable advantage from a structural point of view in that it does not require a modification of the pre-installed controllers in many applications used. Extensive simulations were conducted to show the feasibility of the proposed control method.
2. Review of Impedance Control
A dynamic equation of an
n
degree-of-freedom robot manipulator in the joint space coordinates can be given by
where vectors
q
,
and
are the
n
× 1 joint angle,
n
× 1 joint angular velocity, and
n
× 1 joint angular acceleration, respectively;
D
(
q
)is the
n
×
n
symmetric positive definite inertia matrix;
C
(
q
,
)
is the
n
× 1 vector of the Coriolis and centrifugal torques;
G
(
q
) is the
n
× 1 gravitational torque; 𝜏is the
n
× 1 vector of the actuator joint torque; and
𝜏e
is the
n
× 1 vector of the external disturbance joint torque.
Denoting
h
=
C
(
q
,
)
+
G
(
q
) can simplify Eq. (1) as
The Jacobian relationship between the joint velocity and Cartesian velocity allows the development of a robot dynamic equation model in the Cartesian space. The Jacobian relationship for the acceleration is
Substituting (3) in (2) yields the following Cartesian dynamic equation:
where
D
* =
J
T–1
DJ
–1
,
h
* =
J
T
–1
h
–
D
*
J
–1
,
Fe
is the external force, and
F
is the control input force.
The impedance force control method regulates the contact force by correctly selecting the impedance parameters
[10]
. The force tracking impedance function can be given by
where
E
=
Xe
−
X
,
Xe
is the environment position, and
M
,
B
,
K
are the impedance parameters. Setting
K
= 0 in (5) and assuming
Fe
= −
KeE
yield a stable impedance function.
In this formulation, without knowing the exact environment stiffness
Ke
, the force tracking
Fe
=
Fd
is guaranteed under a steady state. If the environment position
Xe
is not accurately available such that
X'e
=
Xe
+
δ
Xe
, impedance function (6) with uncertainty can be represented as
where
E'
=
E
+
δ
Xe
, and
δ
Xe
is uncertainty in the environment position.
However, to achieve force tracking
Fe
=
Fd
by realizing the ideal impedance function, uncertainties in robot dynamics have to be concurrently compensated. Herein, we propose the use of a neural network to handle the uncertainties in both robot dynamics and the environment.
3. Neural Network Force Control
The role of a neural network is to generate signals to compensate for uncertainties to minimize the tracking errors of position and force control. The force control law in the Cartesian space can be given by
[9
,
10]
Further, the control input is given as
Based on the impedance law in (5) and (6),
can be modified by adding compensating signals from a neural network. The position control can be written as
where
Mp
,
Bp
,
Kp
are the position control gains, and
ϕp
is the output signal of the neural network used to compensate for uncertainties in the position controlled direction.
The force control can be written as
contact space,
where
ε
=
Xd
−
X
,
Xd
is the desired trajectory,
ϕf
is the output of the neural network used for the compensation of the force controlled direction, and
, where
Vp
indicates the position controlled direction, and
Vf
is the force controlled direction.
Substituting the control law (8) in the Cartesian robot dynamic Eq. (4) yields
where
and
which are considered to be modeling errors. Arranging (12) provides the following closed loop error equation:
The force controllable direction is considered separately by substituting
Vf
of the contact in (11) in (13). We then have the following equation:
where the uncertainty terms are
Thus, Eq. (14) can be simplified as a closed loop force error equation:
Therefore, the neural network compensating signal
ϕf
can compensate for those dynamic uncertainties,
as
After driving a neural network to converge to zero, the neural network output becomes equal to the dynamic uncertainty.
The desired impedance function can then be realized as
where
Fe
= −
KeE
.
In the same manner, we can obtain the following equation for the position controlled direction:
where
ϕp
is a neural network output for the position controlled direction. After convergence, the neural network output for the position controlled direction becomes
The desired position control can then be realized as
where
Mp
=
I
for a typical case.
The proposed neural network force control structure is shown in
Figure 1
. There are two control parts: a compensation control part and an impedance force control part. The robot manipulator is controlled using an impedance force control method. The compensation part is a totally separable structure from the impedance force control part such that it can be easily separated. The idea here is to modify the input trajectory signals to have effects of modifying gains in the internal controller. Therefore, next is how to drive neural network to generate compensation signals to make tracking errors go to zero.
Neural network force control structure.
4. Neural Network Learning Algorithm
Next is to design the training signal for driving the neural network to satisfy the goal. Our goal is to achieve
Fe
=
Fd
in the force controlled direction and
X
=
Xd
in the position controlled direction. A neural network is trained and learned in an on-line adaptive manner by minimizing the objective function composed of training signals.
The learning algorithm is similar to those presented in
[11
,
13]
. Therefore, we can determine the training signal from Eq. (7) as
Eq. (16) then becomes
where
If the environment position profile is not flat, good force tracking results cannot be achieved owing to the
,
terms. To overcome this problem, we use a neural network to cancel out these terms in (23).
Hence, the training signal for a neural network should be properly designed such that the force tracking error is minimized. Two separate training signals, 𝜐
position
, 𝜐
force
, were designed for the position control and force control, respectively. The training signals for 𝜐
force
are obtained from Eq. (5) for two cases: one in a free space, and the other in a contact space.
The objective function to be minimized can be defined as
where
Employing the definition of v in Eqs. (24) and (25) yields the gradient of as 𝔍
The neural network output is
The back-propagation update rule for the weights with a momentum term is
where 𝜂 is the update rate and 𝛼 is the momentum coefficient.
A two-layered feed-forward neural network is used as a compensator, as shown in
Figure 2
. The output of the hidden units is filtered using a nonlinear function,
Neural network structure.
while the output units are linear. We chose six hidden neurons for our experiments. The back propagation algorithm parameter 𝜂 was optimized, and 𝛼 = 0.9 was used. In addition, weights with small values were randomly selected.
5. Simulation Results
- 5.1 Simulation Setup
To validate the proposed force control algorithm, simulation studies on a two-link robot manipulator were conducted. The link length is 0.4 m and the weight is 5 kg for two links. Robot dynamic uncertainties include cases in which the robot dynamics model is assumed to be unknown and each joint has friction terms. The environment was assumed to have an unknown stiffness of 10,000 N/m, and the desired force was set to 20 N. The force normal to the environment along the x axis was regulated. The sampling time was 0.005 sec. The robot was required to follow the environment along the
y
axis while regulating the desired force along the
x
axis, as shown in
Figure 3
.
Force tracking environment.
- 5.2 No Uncertainties in Robot Dynamics
First, the robot was required to track through an environment with a stiffness of 10,000 N/m. The desired force was 20 N. The force tracking results are shown in
Figure 4
. The position controller gains were
kp
= 100 and
kd
= 20, and the force controller gains were
m
= 1 and
b
= 100. From its initial position, the robot moved slowly and made contact with the environment at about 0.13 sec.
Force tracking performance.
Without knowing the environment stiffness or the position information, the impedance force control algorithm was sufficiently robust to perform force tracking control well. Tracking performances of x axis position and y axis sinusoidal trajectory are shown in
Figures 5
and
6
, respectively.
X axis position tracking result.
Y axis position tracking result.
- 5.3 Uncertainties in Robot Dynamics
However, when uncertainties in robot dynamics such as joint friction and model mismatches are present, the force tracking performance is significantly degraded, as shown in
Figure 7
. The position tracking results for the y axis show a notable tracking error, as presented in
Figure 8
. This error should be alleviated to achieve a better force tracking performance.
Force tracking performance under robot dynamics uncertainty.
X axis position tracking results under robot dynamics uncertainty.
After compensating for these uncertainties in robot dynamics, the force tracking performance was improved, as shown in
Figure 7
. The force overshoot was reduced to within 0:5 sec. The corresponding position tracking results in
Figure 8
indicate that the environment position is estimated inside the environment. The position tracking along the y axis was also improved by the neural network controller, as shown in
Figure 9
. The initial tracking errors were also quickly minimized as the neural network learned.
Figures 10
and
11
show the neural network compensation signals for the force and position controls, respectively.
Y axis position tracking results under robot dynamics uncertainty.
Neural network compensation signal for force control direction.
Neural network compensation signal for position control direction.
- 5.4 Different Environment Stiffness
The next simulation was conducted to determine the effect of different environment stiffness. The desired force was set to 20 N. As expected, a larger force overshoot could be observed for a stiffer environment. For a stiffness of
ke
= 50,000 N/m, we obtained the largest force overshoot, as shown in
Figure 12
. However, it reduced quickly. For a stiffness of
ke
= 1, 000 N/m, which is considered to be a soft environment, the force response time was slower and a smaller force overshoot was obtained. The force tracking performance in
Figure 12
shows that the controller is sufficiently robust to handle all cases of environment stiffness. The force overshoot caused the robot to exert more force on the environment than desired, which may have caused an undesirable contact with the environment.
Force tracking results for different environments.
- 5.5 Different Force Tracking Tasks
In the next simulation, the robot was tasked to regulate different desired forces for the same environment stiffness of
ke
= 10,000 N/m. Different forces should be regulated under the same conditions.
Figure 13
shows the tracking performance for each desired force tracking task. The proposed neural controller could handle different forces with the same controller gains within the same environment.
Different force tracking when ke= 10,000 N/m.
6. Conclusion
When the robot used force control, its performance was greatly affected by the robustness of the position controller. Robot dynamics uncertainties are one of the important problems that need to be solved in advance. Because a neural network is a nonlinear controller, uncertainties can be compensated in terms of not only the position controller but also the force controller. The performance of the proposed controller was confirmed through extensive simulations. One advantage of the proposed control scheme is that there are no modifications required for a pre-designed controller. Uncertainties can be compensated at the input trajectory level, which may lead to many advantages in real applications such as teleoperation control, haptic devices, and other nonlinear control systems. Future research will seek advantages by applying the proposed algorithms to applications.
This paper was presented in part at WCICA 2010.
Acknowledgements
This research was supported by the Korea Research Foundation (KRF) through its general research program (2010-0024904) in Korea, and by the center for autonomous intelligent manipulation for service robots of the Ministry of Knowledge Economy (MKE), Korea, under the Human Resources Development Program for the Convergence Robot Specialists support program supervised by the National IT Industry Promotion Agency (NIPA-2013-H1502-13-1001).Conflict of InterestNo potential conflict of interest relevant to this article was reported.
BIO
Dr. Seul Jung received the B.S. degree in Electrical&Computer Engineering fromWayne State University, MI, USA and the M.S & Ph.D. degrees from University of California, Davis, USA, both in Electrical & Computer Engineering. Dr. Jung has joined the Department of Mechatronics Engineering at the Chungnam National University, Daejeon, Korea from 1997. While at Chungnam National University, he has engaged in research and teaching in the areas of robotics, intelligent systems, digital control, and signal processing. He has focused his efforts in robotics and intelligent control systems. He developed a graduate program in intelligent control and robot control, and established an Intelligent Systems and Emotional Engineering (ISEE) Laboratory for both theoretical and experimental studies. The Lab focuses on the validation of theories by experimental studies of Mechatronics systems. His robotics research includes robot force control, multi-arm coordination, neural network applications to robotics, and robot education. More recently, he has been engaged in outreach program of introducing robots to young students from local schools. Dr. Jung has been a member in the Institute of Electrical and Electronics Engineers (IEEE) Robotics and Automation Society, IEEE Control System Society, IEEE Industrial Electronics Society, Institute of Control, Robotics, and Systems, Korean Institute of Intelligent Systems, Institute of Electronics Engineers of Korea, Korean Institute of Electrical Engineers, and Institute of Embedded Engineering of Korea. He has served as a program committee member in many international conferences. He also has been an executive office member in the Institute of Control, Robotics, and Systems (ICROS) and Korean Institute of Intelligent Systems (KIIS) in Korea
Kim D. M.
,
Choi H. J.
,
Kim J. S.
,
Lee W. K.
,
Song D. H.
,
Jung S.
2007
“Tracking control of a moving object for robokers with stereo visual feedback,”
in IEEE International Conference on Integration Technology
Shenzhen, China
March 20-24, 2007
http://dx.doi.org/10.1109/ICITECHNOLOGY.2007.4290363
52 -
57
DOI : 10.1109/ICITECHNOLOGY.2007.4290363
Hogan N.
1985
“Impedance control: an approach to manipulation. Part ITheory,”
Journal of Dynamic Systems, Measurement, and Control
http://dx.doi.org/10.1115/1.3140702
107
(1)
1 -
7
DOI : 10.1115/1.3140702
Hogan N.
1985
“Impedance control: an approach to manipulation. Part IIImplementation,”
Journal of Dynamic Systems, Measurement, and Control
http://dx.doi.org/10.1115/1.3140713
107
(1)
8 -
16
DOI : 10.1115/1.3140713
Hogan N.
1985
“Impedance control: an approach to manipulation. Part IIIApplications,”
Journal of Dynamic Systems, Measurement, and Control
http://dx.doi.org/10.1115/1.3140701
107
(1)
17 -
24
DOI : 10.1115/1.3140701
Raibert M. H.
,
Craig J. J.
1981
“Hybrid position/force control of manipulators,”
Journal of Dynamic Systems, Measurement, and Control
http://dx.doi.org/10.1115/1.3139652
103
(2)
126 -
133
DOI : 10.1115/1.3139652
Anderson R.
,
Spong M. W.
“Hybrid impedance control of robotic manipulators,”
in Proceedings of the IEEE International Conference on Robotics and Automation
Raleigh, NC
March 31-April 3, 1987
http://dx.doi.org/10.1109/ROBOT.1987.1087919
1073 -
1080
DOI : 10.1109/ROBOT.1987.1087919
Liu G. J.
,
Goldenberg A. A.
1991
“Robust hybrid impedance control of robot manipulators,”
in Proceedings of the IEEE International Conference on Robotics and Automation
Sacramento, CA
April 9-11, 1991
http://dx.doi.org/10.1109/ROBOT.1991.131589
287 -
292
DOI : 10.1109/ROBOT.1991.131589
Seraji H.
“Adaptive admittance control: an approach to explicit force control in compliant motion,”
in Proceedingsof the IEEE International Conference on Robotics and Automation
San Diego, CA
May 8-13, 1994
http://dx.doi.org/10.1109/ROBOT.1994.350927
2705 -
2712
DOI : 10.1109/ROBOT.1994.350927
Jung S.
,
Hsia T. C.
“Adaptive force tracking impedance control of robot for cutting nonhomogeneous workpiece,”
in Proceedings of the IEEE International Conference on Robotics and Automation
Detroit, MI
May 10-15, 1999
http://dx.doi.org/10.1109/ROBOT.1999.770370
1800 -
1805
DOI : 10.1109/ROBOT.1999.770370
Jung S.
,
Hsia T. C.
,
Bonitz R. G.
2004
“Force tracking impedance control of robot manipulators under unknown environment,”
IEEE Transactions on Control Systems Technology
http://dx.doi.org/10.1109/TCST.2004.824320
12
(3)
474 -
483
DOI : 10.1109/TCST.2004.824320
Jung S.
,
Yim S. B.
,
Hsia T. C.
“Experimental studies of neural network impedance force control for robot manipulators,”
in Proceedings of the IEEE International Conference on Robotics and Automation
Seoul, Korea
May 21-26, 2001
http://dx.doi.org/10.1109/ROBOT.2001.933152
3453 -
3458
DOI : 10.1109/ROBOT.2001.933152
Dapper M.
,
Maass R.
,
Zahn V.
,
Eckmiller R.
“Neural force control (NFC) applied to industrial manipulators in interaction with moving rigid objects,”
in Proceedings of the IEEE International Conference on Robotics and Automation
Leuven, Belgium
May 16-20, 1998
http://dx.doi.org/10.1109/ROBOT.1998.680618
2048 -
2053
DOI : 10.1109/ROBOT.1998.680618
Jung S.
,
Hsia T. C.
2000
“Robust neural force control scheme under uncertainties in robot dynamics and unknown environment,”
IEEE Transactions on Industrial Electronics
47
(2)
403 -
412
DOI : 10.1109/41.836356
Hu S.
,
Ang V. M. H.
,
Krishnan H.
“NN controller of the constrained robot under unknown constraint,”
in 26th Annual Conference of the IEEE Industrial Electronics Society
Nagoya, Japan
October 22-28, 2000
http://dx.doi.org/10.1109/IECON.2000.972604
2123 -
2128
DOI : 10.1109/IECON.2000.972604
Mallapragada V.
,
Erol D.
,
Sarkar N.
“A new method of force control for unknown environments,”
in IEEE/RSJ International Conference on Intelligent Robots and Systems
Beijing, China
October 9-15, 2006
http://dx.doi.org/10.1109/IROS.2006.282089
4509 -
4514
DOI : 10.1109/IROS.2006.282089
Zhao Y.
,
Cheah C. C.
“Position and force control of robot manipulators using neural networks,”
IEEE Conference on Robotics, Automation and Mechatronics
Singapore
December 1-3, 2004
http://dx.doi.org/10.1109/RAMECH.2004.1438935
300 -
305
DOI : 10.1109/RAMECH.2004.1438935
Passold F.
,
Stemmer M. R.
“Force control of a Scara robot using neural networks,”
in Proceedings of the Fourth International Workshop on Robot Motion and Control
Puszczykowo, Poland
June 17-20, 2004
247 -
252
Hwang M. C.
,
Hu X.
2000
“A robust position/force learning controller of manipulators via nonlinear Hinfinity control and neural networks,”
IEEE Transactions on Systems, Man, and Cybernetics, Part B: Cybernetics
http://dx.doi.org/10.1109/3477.836379
30
(2)
310 -
321
DOI : 10.1109/3477.836379
Kiguchi K.
,
Fukuda T.
1997
“Intelligent position/force controller for industrial robot manipulators-application of fuzzy neural networks,”
IEEE Transactions on Industrial Electronics
http://dx.doi.org/10.1109/41.649935
44
(6)
753 -
761
DOI : 10.1109/41.649935
Kiguchi K.
,
Watanabe K.
,
Izumi K.
,
Fukuda T.
“Application of multiple fuzzy-neuro force controllers in an unknown environment using genetic algorithms,”
in Proceedings of the IEEE International Conference on Robotics and Automation
San Francisco, CA
CA, April 24-28, 2000
http://dx.doi.org/10.1109/ROBOT.2000.846340
2106 -
2111
DOI : 10.1109/ROBOT.2000.846340
Song D. H.
,
Lee G. H.
,
Jung S.
2008
“Neural network compensation technique for standard PD-like fuzzy controlled nonlinear systems,”
International Journal of Fuzzy Logic and Intelligent Systems
8
(1)
68 -
74
DOI : 10.5391/IJFIS.2008.8.1.068
Cho H. T.
,
Kim S. S.
,
Jung S.
2008
“Experimental studies of real-time decentralized neural network control for an x-y table robot,”
International Journal of Fuzzy Logic and Intelligent Systems
8
(3)
185 -
191
DOI : 10.5391/IJFIS.2008.8.3.185
Kim H. W.
,
Jung S.
2012
“Fuzzy logic application to a two-wheel mobile robot for balancing control performance,”
International Journal of Fuzzy Logic and Intelligent Systems
http://dx.doi.org/10.5391/IJFIS.2012.12.2.154
12
(2)
154 -
161
DOI : 10.5391/IJFIS.2012.12.2.154
Lee G. H.
,
Jung S.
2009
“Neuro-fuzzy control of inverted pendulum system for intelligent control education,”
International Journal of Fuzzy Logic and Intelligent Systems
9
(4)
309 -
314
DOI : 10.5391/IJFIS.2009.9.4.309
Jung S.
,
Hsia T. C.
2000
“Neural network inverse control techniques for PD controlled robot manipulator,”
Robotica
18
(3)
305 -
314
DOI : 10.1017/S0263574799002064
Jung S.
,
Cho H. T.
2004
“Decoupled neural network reference compensation technique for a PD controlled two degrees-of-freedom inverted pendulum,”
International Journal of Control, Automation, and Systems
2
(1)
92 -
99