Abstract

This paper presents an approach to estimating joint torques in a four-bar closed-chain mechanism with prescribed kinematics and redundant actuation, i.e., with more actuators than degrees of freedom. This problem has several applications in industrial robots, machine tools, and biomechanics. The inverse dynamics problem is formulated as an optimal control problem (OCP). The dynamical equations are derived for an open-chain mechanism, what keeps the formulation simple and straightforward. Sets of constraints are explored to force the three-link open-chain to behave as a four-bar mechanism with a crank rotating at a constant velocity. The controls calculated from the OCP are assumed to be the input joint torques. The standard case with one torque actuator is solved and compared to cases with two and three actuators. The case of two actuators presented the smallest peak and mean torques, using one specific set of constraints. Such torques were smaller than the solution obtained using an alternative method existing in literature that solves the redundancy problem by means of the pseudo-inverse matrix. Comparison with inverse dynamics solutions using well-established methods for the one-actuator closed-loop four-bar were equal. Reconstructed kinematical trajectories from forward integration of the closed-loop mechanism with the OCP obtained torques were essentially similar. The results suggest that the adopted procedure is promising, giving solutions with lower torque requirements than the regularly actuated case and redundantly actuated computed with other approaches. The applicability of the method has been shown for the four-bar mechanism. Other classes of redundantly actuated, closed-loop mechanisms could be tested using a similar formulation. However, the numerical parameters of the OCP must be chosen carefully to achieve convergence.

References

1.
Haug
,
E.
, 1989,
Computer Aided Kinematics and Dynamics of Mechanical Systems—Volume 1: Basic Methods
,
Allyn and Bacon
,
MA
.
2.
Udwadia
,
F.
, and
Kalaba
,
R.
, 1996,
Analitical Dynamics; A New Approach
, (
Cambridge University
,
Cambridge
).
3.
Cheng
,
H.
,
Yiu
,
Y.
, and
Li
,
Z.
, 2003, “
Dynamics and Control of Redundantly Actuated Parallel Manipulators
,”
IEEE/ASME Trans. Mechatro.
,
8
(
4
), pp.
483
491
.
4.
Nakamura
,
Y.
, and
Ghodoussi
,
M.
, 1989, “
Dynamics Computation of Closed-Link Robot Mechanisms With Nonredundant and Redundant Actuators
,”
IEEE Trans. Rob. Autom.
,
5
(
3
), pp.
294
302
.
5.
Lee
,
Y.
,
Han
,
Y.
,
Iurascu
,
C.
, and
Park
,
F.
, 2002, “
Simulation-Based Actuator Selection for Redundantly Actuated Robot Mechanisms
,”
J. Rob. Syst.
,
19
(
8
), pp.
379
390
.
6.
Ganovski
,
L.
,
Fisette
,
P.
, and
Samin
,
J.
, 2004, “
Piecewise Overactuation of Parallel Mechanisms Following Singular Trajectories: Modeling, Simulation and Control
,”
Mech. Mach. Theory
,
12
(
4
), pp.
317
343
.
7.
Muller
,
A.
, and
Maisser
,
P.
, 2007, ”
Generation and Application of Prestress in Redundantly Full-Actuated Parallel Manipulators
,”
Multibody Syst. Dyn.
,
18
(
2
), pp.
259
275
.
8.
Silva
,
O.
, and
Menegaldo
,
L.
, “
Inverse Dynamics of a Redundantly Actuated Four–Bar Mechanism Using a Differential Algebraic Equation Approach
” , Proceedings of the 20th International Congress of Mechanical Engineering, Gramado-RS, Brazil, edited by ABCM - Brazilian Society of Mechanical Sciences and Engineering, November 15-20.
9.
Valasek
,
M.
,
Bauma
,
V.
,
Sika
,
Z.
,
Belda
,
K.
, and
Pisa
,
P.
, 2005, “
Design-By-Optimization and Control of Redundantly Actuated Parallel Kinematics Sliding Star
,”
Multibody Syst. Dyn.
,
14
(
3–4
), pp.
251
267
.
10.
Schwartz
,
A. L.
, and
Polak
,
E.
, and
Chen
,
Y.
, “
RIOTS Manual—Recursive Integration Optimal Control Trajectory Solver
,”
A matlab toolbox for solving optimal control problems
, version 1.0 ed.
Department of Electrical Engineering and Computer Science, University of California
,
Berkley
.
11.
Jennings, L.S., Fisher, M.E., Teo, K.L., and Goh, C.J., 1991. MISER3: “Solving Optimal Control Problems: an Update”, Adv. Eng. Software , Vol. 13, 190-196.
12.
Kraft
,
D.
, 1994, “
Algorithm 733: Tomp—Fortran Modules for Optimal Control Calculations
,”
ACM Trans. Math. Softw.
,
20
(
3
), pp.
262
281
.
13.
Betts
,
J.
,
Carter
,
M.
, and
Huffman
,
W.
, 1997, “
Software for Nonlinear Optimization, Mathematics and Engineering Analysis
,”
Boeing Information and Support Services
,
The Boeing Company, Library Report mea-lr-83 r1
.
14.
Lee
,
S.-H.
,
Kim
,
J.
,
Park
,
F.
,
Kim
,
M.
, and
Bobrow
,
J.
, 2005, “
Newton-Type Algorithms for Dynamics-Based Robot Movement Optimization
,”
J. Rob. Syst.
,
21
(
4
), pp.
657
667
.
15.
Schwartz
,
A.
, 1996, “
Theory and Implementation of NumericalMethods Based on Runge-Kutta Integration for Solving Optimal Control Problems
,” Ph.D. thesis, EECS Department, University of California, Berkeley.
16.
Citron
,
S.
, 1969,
Elements of Optimal Control
,
Holt, Rinehart and Winston, Inc.
,
New York
.
17.
Menegaldo
,
L.
, 2001, “
Modelagem Biomecânica e Controle Ótimo da Postura Humana Através de Algoritmos Baseados na Teoria das Aproximações Consistentes
,” Ph.D. thesis, University of São Paulo, Sao Paulo, Brazil.
18.
Bottasso
,
C.
,
Croce
,
A.
,
Ghezzi
,
L.
, and
Faure
,
P.
, 2004, “
On the Solution of Inverse Dynamics and Trajectory Optimization Problems for Multibody Systems
,”
Multibody Syst. Dyn.
,
120
(
1
), pp.
1
22
.
19.
Schwartz
,
A. L.
, and
Polak
,
E.
, 1997, “
Family of Projected Descent Methods for Optimization Problems with Simple Bounds
,”
J. Optim. Theory Appl.
,
92
(
1
), pp.
1
31
.
20.
Polak
,
E.
, 1997,
Optimization: Algorithms and Consistent Approximations
,
Springer-Verlag
,
New York
.
21.
Byrne
,
G.
, and
Hindsmarsh
,
A.
, 1987, “
Stiff ODE Solvers - A Review of Current and Coming Attractions
,”
Journal of Computational Physics.
, Vol.
70
pp.
1
62
.
22.
Gill
,
P.
,
Murray
,
W.
,
Saunders
,
M.
, and
Wright
,
M.
, 1998,.
User’s Guide for NPSOL 5.0: A FORTRAN Package for Nonlinear Programming
.
1998, Systems Optimization Laboratory
,
Department of Operations Research, Stanford University, Technical Report No. sol 86-2
.
23.
Brenan
,
K.
,
Campbell
,
S.
, and
Petzold
,
L.
, 1989,
Numerical Solution of Initial-Value Problems in Differential-Algebraic Equations
,
North-Holland, New York
.
24.
Yu
,
Q.
, and
Chen
,
I.-M.
, 2000, “
A Direct Violation Correction Method in Numerical Simulation of Constrained Multibody Systems
,”
Comput. Mech.
,
26
(
1
), pp.
52
57
.
25.
Pennestri
,
E.
, and
Vita
,
L.
, 2004, “
Strategies for the Numerical Integration of DAE Systems in Multibody Dynamics
,”
Comput. Appl. Eng. Educ.
,
12
(
2
), pp.
106
116
.
26.
Yamaguchi
,
G.
, and
Zajac
,
F.
, 1990, “
Restoring Unassisted Natural Gait to Paraplegics via Functional Electrical Stimulation: A Computer Simulation Study
,”
IEEE Trans. Biomed. Eng.
,
37
(
9
), pp.
886
902
.
27.
Anderson
,
F.
, and
Pandy
,
M.
, 1999, “
A Dynamic Optimization Solution for Vertical Jumping in Three Dimensions
,”
Comput. Methods Biomech. Biomed. Eng.
,
2
(
3
), pp.
201
231
.
28.
Anderson
,
F.
, and
Pandy
,
M.
, 2001, “
Static and Dynamic Optimization Solutions for Gait are Practically Equivalent
,”
J. Biomech.
,
34
(
2
), pp.
153
161
.
29.
Menegaldo
,
L.L.
,
Fleury
,
A.T.
, and
Weber
,
H.I.
, “
Optimal control of human posture using algorithms based on consistent approximations theory
” In:
F.
Udwadia
,
G.
Leitmann
, and
H. I.
Weber
. (Org.).
Dynamical Systems and Control.
Boca Raton, FL
:
CRC Press
, 2004, pp.
407
419
.
30.
Modares
,
H.
, and Sistani, M.-B. N., 2011, “
Solving Nonlinear Optimal Control Problems Using a Hybrid ipso-sqp Algorithm
,”
Eng. Applic. Artif. Intell.
,
24
(
3
), pp.
476
484
.
31.
Menegaldo
,
L.
,
Fleury
,
A.
, and
Weber
,
H.
, 2006, “
A “Cheap” Optimal Control Approach to Estimate Muscle Forces in Musculoskeletal Systems
,”
J. Biomech.
,
39
(
10
), pp.
1787
1795
.
You do not currently have access to this content.