This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution license(http://creativecommons.org/licenses/by/3.0/).
In this paper, two interlaced studies are presented. The first is directed to the design and construction of a dynamic 3D force/moment sensor. The device is applied to provide a feedback signal of forces and moments exerted by the robotic end-effector. This development has become an alternative solution to the existing multi-axis load cell based on static force and moment sensors. The second one shows an experimental investigation on the performance of four different adaptive nonlinear ℋ_{∞} control methods applied to a constrained manipulator subject to uncertainties in the model and external disturbances. Coordinated position and force control is evaluated. Adaptive procedures are based on neural networks and fuzzy systems applied in two different modeling strategies. The first modeling strategy requires a well-known nominal model for the robot, so that the intelligent systems are applied only to estimate the effects of uncertainties, unmodeled dynamics and external disturbances. The second strategy considers that the robot model is completely unknown and, therefore, intelligent systems are used to estimate these dynamics. A comparative study is conducted based on experimental implementations performed with an actual planar manipulator and with the dynamic force sensor developed for this purpose.
constrained manipulatorsℋ_{∞} controlneural networksfuzzy systemsvariable structure controlload cellmulti-axis force sensorIntroduction
The first robotic manipulators were developed in order to perform positioning tasks. They were then specifically designed to be robust enough so as to not be affected by external disturbances. This physical robustness of robot manipulators has enabled researchers to obtain accurate positioning systems based on simple control laws. Decades later, the popularization of industrial robotics has heightened researchers' interest in creating a much wider range of applications for robotic manipulators in various environments.
Nowadays, many applications demand robotic manipulators to perform tasks subject to force and motion constraints. For example, the process of milling a piece requires accurate incidence angles, paths, forces and moments exerted by the drill in the milled material. Additionally, in industrial assembly lines, the objects must be assembled along certain paths with predetermined forces and moments. In sheet metal cutting, the cutting angles, paths and forces exerted on the material are also important. Moreover, on surfaces where polishing disks must always be perpendicular to the surface being polished, predetermined force must be applied. Consequently, new concepts of position and force control for lighter and more flexible robots have been created [1,2].
The problem defined in these applications involves three stages: the approach phase, the impact moment and the sustained contact tracking. The approach phase has been addressed in many works and defines the problem of positioning the tool without, or before, touching the environment. The second phase requires controlling the initial impact and damping out the vibrations generated during the event. After the initial impact, sustained contact is desired in many operations. In these cases, not only the motion of the end-effector is required to follow a prescribed path, but also the force exerted by the end-effector is required to follow a predefined reference. In these constrained systems, forces and moments generated between the end-effector and the target must be controlled, rather than being treated as disturbances and rejected. Addressing manipulators subject to model uncertainties and disturbances, the work considered in this paper is concentrated on the sustained contact tracking phase of the problem.
The great majority of solutions presented in the literature for the problem of constrained systems control require knowing the forces and moments of interaction between the robot end-effector and the environment where it is acting. The problem of force control undertaken in this paper was also considered in [1,3–7]. However, only simulation results were presented.
As a differential and important contribution, this paper addresses an experimental investigation on robust force control as a result of the development of a modular sensor device. The proposed device is designed and built to measure dynamic forces and moments in three orthogonal axes based on unidirectional force sensor units. As a consequence of its independent architecture on the type of sensitive material, static or dynamic force sensors can be applied. Piezoelectric or piezoresistive force sensors are effective solutions for the applications involved in this study due to their inherent dynamic response characteristics.
This paper is organized as follows: next section presents preliminary concepts and relevant results found in the literature; Section 3 introduces the model description of the constrained robot manipulator; Section 4 presents the problem formulation; Section 5 describes the solutions for the nonlinear ℋ_{∞} control problems based on the linear parametrization property of the model, neural networks and fuzzy systems; Section 6 demonstrates the 3D dynamic force and moment sensor; and Section 7 presents the experimental results for a three-link manipulator.
Preliminary Concepts
The concept of stiffness control was introduced by Salisbury [8]. It is based on the resistance of the environment in which the robotic end-effector applies the force. The problem is modeled as a mass-spring system and this method made possible the simultaneous position/force control. However, it considers constant desired position and force. In many robotic applications, such as when milling a piece, the end-effector must follow a trajectory along the surface of an object while applying a desired force, which is not necessarily constant. In this case, the stiffness control application does not work properly.
To address this type of limitation, Raibert and Craig [9] partitioned the control problem into two subtasks: one task is for controlling the position trajectory and the other task for controlling the desired force. This approach has been evolutionary for controllers, as proposed by Paul et al. [10], and became the conceptual basis of the hybrid trajectory of position and force control currently found in the literature.
It was shown by McClamroch and Wang [11], that when a manipulator is in contact with a surface, the position degrees of freedom are reduced. In this case, force constraint is added to motion equations through Lagrange multipliers. Thus, the order of the state vector is reduced in the dynamic equations of the manipulator.
Since the phase of controlling robotic systems with restricted position and force has been overcome, researchers began to focus on variables that could degrade the stability of the proposed models. The load on the end-effector that can fluctuate while the manipulator performs various tasks, friction and parameter uncertainties, are some examples that have required much research effort [12–15]. However, only a few studies have dealt with adaptive and robust control of robotic systems subject to constraints [16–20]. Using the basis developed by [9,11], the work performed by Chang and Chen [21] submitted an adaptive controller with ℋ_{∞} robust performance criterion for robotic systems with position and force constraints.
On the development of adaptive robust controllers, neural networks, combined with a nonlinear ℋ_{∞} control law, were applied by Chang and Chen [22] to control robotic systems subject to parametric uncertainties and external disturbances. A smooth response was achieved with a simple and computationally efficient implementation. Neural networks were applied to estimate the unknown dynamics of the system, thereby not requiring mathematical modeling knowledge. A variable structure controller (VSC) is added to this formulation by Chang and Chen [23]. The inclusion of VSC in the control law weakens the hypothesis used by the authors in [22] that the estimation error should be integrable, and limits it to be only a state-dependent function. Following this approach, the authors in [24] developed an adaptive ℋ_{∞} controller based on fuzzy systems and VSC for robots with position and force constraints.
Karayiannidis and Doulgeri proposed adaptive controllers in [5,6] for force and position trajectory tracking in environments with little or no constraint knowledge. In these papers, the main purpose is to explore the workspace using measurements of position, speed and force in a robotic end-effector, to attenuate impacts caused by unknown environments. In order to improve estimates of these models, the use of a camera was proposed by Cheah et al. [4] to provide a better estimate of the contact constraint through computer vision. However, these works are more interested in exploring the environmental constraint, rather than a repetitive task control with great tracking precision.
To satisfy the need of measuring the forces and moments of interaction between the robot end-effector and the environment, devices known as multi-axis load cell or multi-axis force and moment sensor are used. There are several patents on devices whose purpose is to measure forces and moments in three axes.
Force sensors, such as strain gages, have been generally used as the basic unit of measurement, as shown by the illustrative examples in Figure 1. The multi-axis load cell developed by Meyer and Lowe [25] was built in one piece with internal and external parts that are connected by a pair of axially spaced beams. The beams are fixed in the center of the piece, where the strain gages are attached, and an outside tunnel. The loads are measured by the curvature of the connectors. The load transducer developed by Meyer et al. [26] measures linear forces in three axes and moments of about two axes. The transducer has encapsulations connected by internal and external arms-sensitive loading. The device described by Sommerfeld et al. [27] consists of an external annular body, a hub and four beams that hold the hub to the radially outward portion. Strain gages are fixed to the faces of the beams, with a 90 degree lagging. Forces and moments exerted on the hub are transmitted to the four beams, and consequently, to the strain gages. Differently from [25,26], this device described by Sommerfeld et al. [27] is able to measure forces and moments in three orthogonal axes. However, all the devices mentioned above have an extrusion completely dependent upon the type of sensitive material being used.
Model Description
Let a constrained robot manipulator be defined by an n-link serial-chain rigid manipulator whose end-effector is in contact with a rigid environmental constraint, according to Figure 2.
The links of the manipulator are numbered from 1 to n: J_{i} is the joint connecting the (i − 1)-th and i-th links, l_{i} is the vector connecting J_{i} and J_{i}_{+1}, q_{i} is the angle of the i-th link around joint J_{i}, C_{i} is the center of mass of the i-th link and l_{ci} is the vector connecting J_{i} and C_{i}. The constraint surface is represented by S and α is the angle of contact between the end-effector and S.
Remark 1Assume that the end-effector is already in contact with the constraint surface, and the control exerted over the constraint force is such that the force will always maintain the end-effector in contact with the constraint surface.
Robot Dynamics
The dynamic equations of a constrained robot is given from Lagrange theory as
M(q)q¨+C(q,q˙)q˙+G(q)=τ+f+τdwhere M(q) ∈ ℜ^{n × n} is the symmetric positive definite inertia matrix, C(q, q˙) ∈ ℜ^{n × n} is the Coriolis and centripetal matrix, G(q) ∈ ℜ^{n} is the vector of the gravitational torques, τ ∈ ℜ^{n} is the torque vector acting upon the manipulator joint, f ∈ ℜ^{n} denotes the vector of joint-space generalized forces on the environmental constraint exerted by the end-effector, and τ_{d} defines finite energy unknown disturbances.
Model uncertainties in Equation (1) can be introduced dividing the matrices M(q), C(q, q˙), G(q), and f into a nominal and a perturbed part:
M(q)=M0(q)+ΔM(q)C(q,q˙)=C0(q,q˙)+ΔC(q,q˙)G(q)=G0(q)+ΔG(q)f=f0+Δf
where M_{0}(q), C_{0}(q, q˙), G_{0}(q), and f_{0} are nominal matrices and ΔM(q), ΔC(q, q˙), ΔG(q), and Δf represent the uncertainties.
Constraint Modelling
Considering Remark 1, the m-dimensional surface constraint is described by the holonomic relationship
ϕ(q)=0where ϕ(q) : ℜ^{n}→ ℜ^{m} is a smooth function.
Constraint forces are given by
f=JcT(q)λwhere
Jc(q)=δϕ(q)δq∈ℜm×n is the Jacobian matrix that relates the constraint to the controlled variables of the robot and λ ∈ ℜ^{m} is a vector of generalized Lagrangian multipliers associated with the constraint.
In this paper, it is considered that parametric uncertainties may also be included into the constraint model since the constraint surface may be not perfectly rigid, frictionless or even that its geometric description may not be exactly known. Thus, consider
ϕ(q)=Δϕ(q)Jc(q)=Jc(q)+ΔJc(q)and assume that Δϕ and ΔJ_{c} are implicit in Δf, described in Equation (2).
Reduced Order Model
The presence of m constraints causes the manipulator to lose m degrees of freedom, and therefore, n – m linearly independent coordinates are sufficient to characterize the constrained movement. Therefore, to formulate a reduced order dynamics for the constrained system, the formulation presented in this paper follows the assumptions made by McClamroch and Wang [11] and posteriorly by Chang and Chen [24].
Define
q=[q1q2]where q^{2} = σ(q^{1}) and ϕ(q^{1}, σ(q^{1})) = 0.
The following reduced model formulation is obtained for the constrained manipulator as the model proposed by Chang and Chen [24]:
AL(q1)q¨1+LT(q1)CL(q1,q˙1)q˙1+LT(q1)G(q1)=LT(q1)(τ+τd)where
L(q1)=[I(n−m)∂σ(q1)∂q1]and
CL(q1,q˙1)q˙1=M(q1)L˙(q1)+C(q1,q˙1)L(q1)
The necessary structure and properties of the model for controller formulation are maintained since A_{L}(q^{1}) = L^{T}(q^{1})M(q^{1})L(q^{1}) is symmetric positive definite and the matrix A˙_{L}(q^{1}) − 2L^{T}(q^{1})C_{L}(q^{1}, q˙^{1}) is skew symmetric.
Problem Formulation
Let q_{d}(t) ∈ ℜ^{n} and q˙_{d}(t) ∈ ℜ^{n} be the desired reference trajectory and the corresponding velocity for the joints, respectively Assume that q_{d}(t) and its derivatives q˙_{d}(t) and q¨_{d}(t) are bounded. Define a bounded f_{d} ∈ ℜ^{n} as the desired reference contact force. To be consistent with the imposed restrictions, we need to assure that ϕ(q_{d}) = 0 and
fd=JcT(qd)λd.
Since q^{2} = σ(q^{1}), it is only necessary to find a control law that makes
q1→qd1 when t → ∞. Therefore, define the position tracking error x̄_{1}(t) and the filtered link tracking error x̄_{2}(t), as in [24]:
x¯(t)=˙[x¯1(t)x¯2(t)]=˙[q1(t)−qd1(t)q˙1(t)−q˙d1(t)+p(q1(t)−qd1(t))]for some constant p > 0.
From Equations (6) and (7), the error dynamic equations can be obtained as
x¯˙=[x¯˙1x¯˙2]=Ax¯+Bu+Bwwhere
A=[−pII0−AL−1(q1)CL(q1,q˙1)],B=[0−(M(q1)L(q1))−1]u=F(xe)−τ,ω=τd,andF(xe)=˙M(q1)L(q1)(q¨d1−px¯˙1)+CL(q1,q˙1)(q˙d1−px¯1)+G(q1)
Within this problem formulation, the torques applied to the joints to guarantee the task execution are given by
τ=F(xe)−uwhere the term F(x_{e}) refers to the dynamics of the controlled variables and u is the control law provided by the adaptive ℋ_{∞} controller proposed by Chang and Chen [24].
The term F(x_{e}) can be divided in a nominal and uncertainty part, that is,
F(xe)=F0(xe)+ΔF(xe)where term ΔF(x_{e}) contains the uncertainties from parametric Equations (2) and (5).
In this paper, the control problem is solved based on two different approaches. In the first approach, an adaptive intelligent system is applied to estimate only the term ΔF(x_{e}), considering that the nominal model of the robot is well known. In the second approach, it is considered that the system model or the term F_{0}(x_{e}) + ΔF(x_{e}) is completely unknown, then the adaptive intelligent system is applied to estimate it. The nonlinear ℋ_{∞} control and VSC are applied in both approaches to attenuate the effects of estimation errors and external disturbances.
Adaptive Nonlinear <italic>ℋ<sub>∞</sub></italic> Controller Based on Intelligent Systems
The adaptive control laws presented as follows are based on two different learning methods to estimate uncertain parameters and also the behavior of unmodeled dynamics. Neural networks and fuzzy systems based on the Takagi–Sugeno model are considered. The structure of these intelligent systems can be seen in details in [28].
Let F̂(x_{e}, Θ) = Ξ(x_{e})Θ be the output of the adaptive intelligent system, where x_{e} is the input vector and Θ is a vector of adjustable parameters such that Θ^{T}Θ ≤ M_{θ}|M_{θ} > 0. Two different cases are considered in the following:
Estimation of Model Uncertainties Based on Intelligent Systems
In this case, the nominal model of the robot is considered as well known, the intelligent system then estimates only the model uncertainties, such asF^1(xe,Θ)≈ΔF(xe)
Therefore u and ω in Equation (8) will be rewritten asu=F0(xe)+F^1(xe,Θ)−τω=(ΔF(xe)−F^1(xe,Θ))+τdso that ω includes the estimation error from the intelligent system.
Estimation of Complete Model Based on Intelligent Systems
In this case, however, the nominal model of the robot is considered completely unknown, so the intelligent system estimates the complete model, such asF^2(xe,Θ)≈F0(xe)+ΔF(xe)
Therefore u and ω in Equation (8) is rewritten asu=F^2(xe,Θ)−τω=(F(xe)−F^2(xe,Θ))+τdso that ω includes the estimation error from the intelligent system.
Regarding the nonlinear ℋ_{∞} control solution proposed by Chang and Chen [24] for constrained systems, define u = ū where ū = u_{P} + u_{F}, such that
uP=k0Ex¯2−k(xe)sgn(Lx¯2)uF=JcTλcwhere u_{P} is the ℋ_{∞}+VSC control term for the position enforcement and u_{F} is the ℋ_{∞} control law for the force tracking procedure, with
E:=[I(n−m)0m×(n−m)]andλc=˙λd−kλ∫0T(λ−λd)dtfor some constant gain k_{0}, k(x_{e}) > 0 and k_{λ} > 0.
Theorem 1 presented in the following is a variation of the results presented in [21,23,24] with the difference that the nominal model and an intelligent system are considered rather than the linear parametrization of the robot. Thus, this theorem defines an adaptive ℋ_{∞} controller to solve the same problem's position/force tracking control problems presented in these papers but with the advantage of using the known model of the robot.
Theorem 1Given a desired disturbance attenuation level γ > 0, a weighting matrix Q and the Lyapunov candidate function V(t), the following performance criterion∫0T||x¯(t)||Q2≤V(0)+γ2∫0T||ω(t)||2,∀T≥0is satisfied, for ω(t) ∈ L_{2} [0,∞), if there exists a dynamic state feedback controllerΘ˙={−ρ−TΞTLx¯2if‖Θ‖<Mθor(‖Θ‖=Mθandx¯2TLTΞΘ≥0)−ρ−TΞTLx¯2+−ρ−Tx¯2TLTΞΘ‖Θ‖2Θif‖Θ‖=Mθandx¯2TLTΞΘ<0τ=F0(xe)+ΞΘ−k0Ex¯2+k(xe)sgn(Lx¯2)−JTλcwhich is the solution of the adaptive nonlinear ℋ_{∞} control problem subject to Equation (6) for the cases 1 and 2.
The stability proof of this dynamic controller follows the line of the proof presented by Chang and Chen [24].
Force/Moment Sensor Development
The controllers proposed in Section 5 require the inferred force and moment measures in the robotic end-effector. The most accurate way to obtain such information is by measurements obtained through a multi-axes load cell.
This section presents a detailed description on the modular 3D dynamic force/moment sensor device developed for this application purpose. Its modular architecture is shown in Figure 3.
Mechanical Description
The 3D dynamic forces/moments sensor essentially comprised of two parts: a moving part and a fixed part. The moving part is shown in yellow in Figure 3(1). It is composed of a base (outside the sensor body) and a body of force transmission (inside the sensor body), which is responsible for transmitting forces and moments to the unidirectional force sensor units mounted on the fixed part, Figure 3(2). The device has an aluminum-made sensor board where twelve force sensor units are disposed in order to measure force and moment in all directions. The sensor units are arranged in pairs, for example, sensors 1A and 1B as shown in Figure 4, which illustrates the body of forces transmission (4) and identifies the sensor units.
Each pair of sensor units measures the force in one direction. This setting is tensioned proportionally to the movement performed by (4) in that axis. Therefore, forces and moments normal to the plane of the base are calculated by the composition of measured forces in the three axes. Figure 5 demonstrates the sensor units operation schematic, and identifies the force measurements.
The formulation of the resultant forces/moments composition is obtained as follows.
Three pairs of sensor units, (1A,1B), (2A,2B) and (3A,3B), define, respectively, the force measurements (F_{1A},F_{1B}), (F_{2A},F_{2B}) and (F_{3A},F_{3B}). The resultant forces of these three points can be expressed as
F1=F1A−F1BF2=F2A−F2BF3=F3A−F3B
It can be seen in Figure 5 that F_{1}, F_{2}, and F_{3} form an equilateral triangle, whose side is given by d_{1}. In [29], Doebelin demonstrated that if three load cells, measuring force in one direction, are arranged triangularly as the vertices of the triangle (the measurement direction normal to the plane formed by the triangle), the following physical quantities can be calculated:
Fx=F1+F2+F3My=d1F1−F2−(F3−F1)23Mz=d1(F3−F2)2where F_{x}, M_{y}, and M_{z} are the force along x-axis and the moments along axes y and z, respectively.
In the same way, F_{4}, F_{5}, and F_{6} also form an equilateral triangle, whose side is given by d_{2}. Thus, the resultant forces of these three points can be expressed as
F4=F4A−F4BF5=F5A−F5BF6=F6A−F6Band therefore,
Fy=F5−F4−(F4−F6)2Fz=3(F5−F6)2Mx=−d2(F4+F5+F6)23where F_{y}, F_{z}, and M_{x} are the forces along axes y and z and the moment along axis x, respectively. The sensor parts and the assembled device is shown in Figure 6.
The applied sensor unit provides a measurement range of 0 to 1.5 kgf, or a maximum load of 14.7 N. By means of Equations (18)–(20) and (24)–(26), the built sensor presents measurements characteristics as shown in Table 1.
Electronic Description
The signal from each pair of unidirectional sensors are conditioned by an electronic circuit based on Instrumentation Amplifiers (INA). The electrical schematic of the signal conditioning circuit is summarized in Figure 7.
The sensors are powered by a symmetric supply (+ Vcc and −Vcc) and provide differential output signals (for example, F_{1Ax} and F_{1Ay}).
Six INA comprise the printed circuit board (PCB). Each INA is responsible for conditioning output signals from a pair of force sensors. With this configuration it became possible to measure the differential forces applied on the moving part of the proposed device. The resultant force is then given by the following equation as described in Figure 7.
FI=kFIA−kFIB
The signals generated by the INAs are directed to a data acquisition board that interfaces with the computer.
Experimental Results
The designed 3D dynamic forces/moments sensor operation is validated in a set of experimental applications, where a three-link planar manipulator is subject to a holonomic constraint defined by a straight rule. The proposed intelligent adaptive robust controllers are applied to this plant for position and force trajectory tracking. The experimental manipulator UARM (UnderActuated Robot Manipulator), whose nominal parameters are given in Table 2, is composed of a DC motor in each joint, a break and an optical encoder with quadrature decoding used to measure joint positions, Figure 8(a). Joint velocities are obtained by numerical differentiation and filtering [30,31]. Modeling matrices for the UARM, M(q), C(q, q˙), and G(q), can be seen in [30]. In Figure 8(b), the designed force sensor is coupled to the UARM end-effector which is constrained in a straight rule. A graphical user interface, whose software was developed using MATLAB^{®} platform, is used to implement control laws and interface with the experimental setup. It was implemented in a modular form, since any new controller can be easily developed and applied.
Implementation of Control Law
The constraint surface for the robot end-effector is a segment of a straight line on the X–Y plane. The angle α between the end-effector and the constraint line is defined in this application example as π/2. It means that the orientation must remain in a constant value c given through the line inclination β and α, where c = π + atan(β) − α. Hence, the equation of the m = 2 constraints is given by
ϕ(q)=[−l1s1−l2s12−l3s123+β[l1c1+l2c12+l3c123]+bq1+q2+q3−c]=[00]where b is the linear coefficient of the constraint line, s_{ij} = sin(q_{i} + q_{j}), c_{ij} = cos(q_{i} + q_{j}). Hence, ϕ: ℜ^{3}→ ℜ^{2}, and the Jacobian matrix, J_{c}(q) = ∂ϕ/∂q, is given by
Jc=[Jc11Jc12Jc13Jc21Jc22Jc23]with
Jc11=l1c1+l2c12+l3c123+β[l1s1+l2s12+l3s123]Jc12=l2c12+l3c123+β[l2s12+l3s123]Jc13=l3c123+β[l3s123]Jc21=Jc22=Jc23=1
Defining q^{1} = [q_{1}] and q^{2} = [q_{2}q_{3}], the matrix L(q) of the constraint line is
L(q)=[1−[l1cos(q1)+l2cos(q1+q2)+β(l1sin(q1)+l2sin(q1+q2))]l2[cos(q1+q2)+βsin(q1+q2)][l1cos(q1)+l2cos(q1+q2)+β(l1sin(q1)+l2sin(q1+q2))]l2[cos(q1+q2)+βsin(q1+q2)]−1]
Initial and final coordinates of the movement are (x_{0},y_{0}) = (0.46,0.38) m and (x(T),y(T)) = (0.53, 0.13) m, respectively. In this case, β = −3.57, b = 2.02, and c = 15.6°. The reference trajectory for the joint variables
qd(t)=qd1(t) is a fifth-degree polynomial, with trajectory duration time T = 4 s. It is desired that no force acts on the normal direction of the constrain line and no moment acts on the z-direction, that is, λ_{d} = [(F_{x})_{d} (M_{z})_{d}]^{T} = [0 0]^{T}.
We use as benchmarking for comparison of the proposed controllers, a controller with no intelligent adjust adaptation, that is, only the nominal parameters are used. In other words, we use the controller of Equation (14) without the ΞΘ term.
During the experiment, a limited disturbance was introduced at t_{i} = 1.0s in the following form:
τd=[0,01e−(t−td)22μ2sen(3,6πt)−0,01e−(t−td)22μ2sen(2,7πt)0,01e−(t−td)22μ2sen(1,8πt)]
If compared with the nominal torque, the disturbance τ_{d} is approximately 64% of its peak value, see Figure 9.
The selected gains are defined in Table 3.
Neural Networks Configuration
For the nonlinear ℋ_{∞} controllers via neural network, Cases 1 and 2, proposed in Section 5, let n = 3 be the number of joints of manipulator. Define
F^NNi(xe,Θ)=[F^NNi1(xe,Θ1)F^NNi2(xe,Θ2)F^NNi3(xe,Θ3)]T=ΞΘwith p_{1} = p_{2} = p_{3} = 7 neurons in the hidden layer and the bias vector b_{1} = b_{2}= b_{3} = [−3 −2 −1 0 1 2 3]. Using the reduced model, the input vector x_{e} is defined by
xe=[q1q˙1qd1q˙d1q¨d1]. In order to provide an input related to the error values, the weighting matrix for the first layer of the neural networks is defined by
Wi1=Wi2=Wi3=[Wij1]=[Wij2]=[Wij3]=[11−1−1−1]. The activation function of the neurons in the hidden layer is chosen as the hyperbolic tangent, G(.) = tanh(.). The uncertain vector Θ is defined as
Θ=[Θ1TΘ2TΘ3T]T and the matrix
Ξ=[ξ1Tξ2Tξ3T]T as Pazelli et al. and Siqueira et al. showed in [28,30]. Θ values are updated at each control iteration by the adaptive law given in Equation (13). The neural networks outputs are given by
F^NNik(xe,Θk)=∑i=1pkθkiG(∑j=1qkwijkxej+bik)=ξkTΘk
Experimental results for the Case 1 (NN1) with neural network are shown in Figures 10(a), 11(a), and 12(a). For the Case 2 with neural network plus nominal model (NN2), experimental results are shown in Figures 10(b), 11(b), and 12(b).
Remark 2Although NN1 and NN2 use the same structure and the same input data, their outputs are different. The online adaptation law provides the update of Θ values in distinct ways for each case. The contribution of NN1 output to the final torque signal is lower than the contribution of NN2 output, since NN1 estimates the value of ΔF(x_{e}) and NN2 estimates the value of F(x_{e}) + ΔF(x_{e}). Thus, Θ values must achieve that requirement for each case.
Fuzzy Systems Configuration
For the proposed adaptive fuzzy nonlinear ℋ_{∞} controllers, Cases 1 and 2 (Section 5), a set of n = 3 fuzzy systems may be defined by
F^FSi(xe,Θ)=[F^FSi1(xe,Θ1)F^FSi2(xe,Θ2)F^FSi3(xe,Θ3)]T=ΞΘwhere F̂_{FSi}_{1}(.,.), F̂_{FSi}_{2}(.,.), and F̂_{FSi}_{3}(.,.) correspond to the estimate of the uncertain part of the dynamic behavior of joints 1, 2, and 3, respectively. The input vector x_{e} is defined as
xe=[q˜1q˜˙1]. The fuzzy sets
A(xe)=[A1(q˜1)A2(q˜˙1)] are defined according to Figure 13 and the number of linguistic variables in U_{1} and U_{2} are defined as r_{1} = r_{2} = 3. They are applied to both F̂_{FSi}_{1}(.,.), F̂_{FSi}_{2}(.,.) and F̂_{Fsi}_{3}(.,.) for the universe of discourse of position errors,
u21=u12=u13=q˜1∈U11=U12=U13=U1, and for the universe of discourse of velocity errors,
u21=u22=u23=q˜˙1∈U21=U22=U23=U2.
During the control loop, these graphics are used to determine the grade of membership associated to x_{e}, which defines the value of μ in the output of the Takagi–Sugeno fuzzy model; for more details see [28],
F^FSik(xe,Θk)=∑i=1pkμikYik∑i=1pkμik=∑i=1pkμik(θi0k+θi1ku1+θi2ku2)∑i=1pkμik=ξkTΘk
A fuzzy rule base is defined with p_{k} = r_{1}r_{2} = 9 rules as
Ri:IF(u1isAr1i1)and(u2isAr2i2)THENYi
The vector of adjustable components Θ is defined as
Θ=[Θ1TΘ2TΘ3T]T, with
Θ1T=[θ101θ111θ121⋯θ901θ911θ921]Θ2T=[θ102θ112θ122⋯θ902θ912θ922]Θ3T=[θ103θ113θ123⋯θ903θ913θ923]and are updated at each control iteration by the adaptive law in Equation (13).
The matrix
Ξ=[ξ1Tξ2Tξ3T]T is computed with
ξ1T=[ξ101ξ111ξ121⋯ξ901ξ911ξ921]ξ2T=[ξ102ξ112ξ122⋯ξ902ξ912ξ922]ξ3T=[ξ103ξ113ξ123⋯ξ903ξ913ξ923]
Figures 10(c), 11(c), and 12(c) show the experimental results for Case 3. Figures 10(d), 11(d), and 12(d) show the experimental results of fuzzy system plus nominal model for Case 4.
Results Discussion
Figure 10 shows the applied torques in the robotic manipulator joints. Note that for the range of the disturbance inserted, the controllers act strongly on the system, reversing the directions of the torques of joints 1 and 2 and increasing the torque of joint 3. In this analysis, it appears that the controllers using neural networks, NN1 and NN2, oscillate less, therefore, they have a slightly slower response time.
The charts of Figure 11 are important because they show the behavior of the end effector during the controller actions, and represent the measurements of force and moment in the robotic end-effector. As expected, it was observed that during the period in which the disturbance appeared in the system, there was a higher intensity of forces and moments which decreased gradually, tending to zero, until the final time (4 s). The proposed configuration for the device sensor proves its effectiveness in providing these data with the required accuracy and without delay to the implementation of the control laws under study.
Figure 12 shows the tracking angles of three joints of the robotic manipulator. Notice that the largest deviation is in the range where the disturbance appeared. Nonetheless, the experiment showed good tracking of the trajectories desired. Again, we can see that for the controller without the intelligent system, NOM, the control actuation is slower, providing greater tracking error of reference signals.
Three performance indexes are used to compare the nonlinear ℋ_{∞} controllers: the ℒ_{2} norm of the state vector
ℒ2[x˜]=(1(tr−t0)∫t0tr||x˜(t)||22dt)1/2where ‖ · ‖_{2} is the Euclidean norm, the sum of the applied torques
E[τ]=∑i=13(∫t0tr|τi(t)|dt)and the sum of areas of contact forces
E[λ]=∑i=13(∫t0tr|λi(t)|dt)where λ_{i}(t) the ith component of the contact forces. As the desired values of contact forces are zero, the lower the value of E [λ], the better the controller will be with respect to contact force control.
The results that are shown in Table 4 present the mean value of five experiments.
From Table 4 we can conclude that the controller based only on the nominal model presents a higher state error and greater forces. Although the fuzzy controllers exhibit the best performance, this performance difference with respect to controllers based on neural networks deserves more in-depth study, which will be carried out in future works.
Conclusions
In this work, the control problem of trajectory tracking with ℋ_{∞} guaranteed performance was considered for manipulators with force and position constraint. Five controllers were evaluated:
The first controller, called nominal, considers that the term F(x_{e}) is completely known, i.e., it does not take into account parametric uncertainties of the model.
The second and third controllers have neural network-based estimators, where the second considers the known nominal model of the manipulator and estimates only parameter uncertainties, and the third estimates the full model.
The fourth and fifth controllers have fuzzy logic-based estimators which estimate only parametric uncertainties and the full model, respectively.
According to experimental results presented in Section 7, controllers NN1 and FS1 have better tracking trajectory compared, respectively, with the NN2 and FS2. Moreover, it also appears they are more stable because of the lower oscillations after the introduction of disturbance, and this feature occurs for the trajectory tracking in Cartesian space in order to follow the trajectory of joint angles. Comparing the results of intelligent systems it is noted that the controllers via neural networks (NN2 and NN1) have a smoother control action and, consequently, have smaller oscillations than the fuzzy systems (FS1 and FS2), which can be verified by comparing the graphics of torque (Figure 10). On the other hand, the controllers NN1 and NN2 are slower than the FS1 and FS2, hence they tend to have a greater tracking error. In addition, when the system is subject to disturbances, all controllers respond well.
Analyzing the proposed performance indices, it was shown that the state error in the fuzzy system-based controllers (FS1 and FS2) tend to be smaller than those based on neural networks (NN2 and NN1). A possible explanation for this is due to the fact that fuzzy systems acted faster than neural networks. It was observed that choosing values of k_{λ} more directly influence the adjustment of the forces, while the values of ρ influence the tracking errors in the state variables.
The development of the proposed sensor was of crucial importance for the realization of the experimental analysis, a differential of this paper. The measurement results shown proved the effectiveness of the proposed structure. Still, its modular feature enables the application of sensor units of various kinds, such as piezoelectric sensors.
As future work, a comparative study will be performed between the developed sensor and commercially available ones. Furthermore, the use of genetic algorithms to adjust controller gains is a current and ongoing project.
This work was supported by Coordenação de Aperfeiçoamento de Pessoal de Nível Superior (CAPES) and Fundação de Apoio à Pesquisa do Estado de São Paulo (FAPESP), under grant 2012/05552-9.
ReferencesKilicaslanS.ÖzgörenM.K.IderK.Hybrid force and motion control of robots with flexible linksLewisF.L.AbdallahC.T.DawsonD.M.BechlioulisC.P.DoulgeriZ.RovithakisG.A.Neuro-adaptive force/position control with prescribed performance and guaranteed contact maintenanceCheahC.C.HouS.P.ZhaoY.SlotineJ.J.E.Adaptive vision and force tracking control for robots with constraint uncertaintyKarayiannidisY.DoulgeriZ.Adaptive control of robot contact tasks with on-line learning of planar surfacesKarayiannidisY.DoulgeriZ.Robot contact tasks in the presence of control target distortionsKumarN.PanwarV.SukavanamN.BormS.P.S.J.H.Neural network based hybrid force/position control for robot manipulatorsSalisburyJ.K.Active Stiffness Control of a Manipulator in Cartesian CoordinatesProceedings of the 19th IEEE Conference on Decision and Control including the Symposium on Adaptive ProcessesAlbuquerque, NM, USA10–12 December 1980Volume 1995100RaibertM.CraigJ.Hybrid position/force control of manipulatorsPaulR.ShimanoB.Compliance and ControlProceedings of the Joint Automatic Control ConferencePurdue, IN, USA27–30 July 1976694699McClamrochN.H.WangD.Feedback stabilization and tracking of constrained robotsOrtegaR.SpongM.W.Adaptive motion control of rigid robots: A tutorialSlotineJ.J.E.LiW.Composite adaptive control of robot manipulatorsSlotineJ.J.E.LiW.SpongM.W.VidyasagarM.CarelliR.KellyR.An adaptive impedance/force controller for robot manipulatorsJeanJ.H.FuL.C.Adaptive hybrid control strategies for constrained robotsPanteleyE.V.StotskyA.A.Adaptive trajectory/force control scheme for constrained robot manipulatorsSuC.Y.StepanenkoY.LeungT.P.Combined adaptive and variable structure control for constrained robotsSuC.Y.LeungT.P.ZhouQ.J.Force/motion control of constrained robots using sliding modeChangY.C.ChenB.S.Adaptive tracking control design of constrained robot systemsChangY.C.ChenB.S.A nonlinear adaptive ℋ_{∞} tracking control design in robotic systems via neural networksChangY.C.Neural network-based ℋ_{∞} tracking control for robotic systemsChangY.C.ChenB.S.Robust tracking designs for both holonomic and nonholonomic constrained mechanical systems: Adaptive fuzzy approachMeyerR.A.LoweA.E.Multiple Axis Load Sensitive TransducerU.S. Patent 46401381987MeyerR.A.OlsonD.J.Load TransducerU.S. Patent 48215821989SommerfeldJ.L.MeyerR.A.LarsonB.A.OlsonD.J.Multi-Axis Load CellU.S. Patent 59692681999PazelliT.F.P.A.T.TerraM.H.SiqueiraA.A.G.Experimental investigation on adaptive robust controller designs applied to a free-floating space manipulatorDoebelinE.O.SiqueiraA.A.G.TerraM.H.BergermanM.SiqueiraA.A.G.TerraM.H.Nonlinear and Markovian ℋ_{∞} controls of underactuated manipulatorsFigures and Tables
(a) Image taken from [25]; (b) Image taken from [26]; (c) Image taken from [27].
Constrained robot manipulator.
Design of the 3D dynamic forces/moments sensor: (1) Moving part; (2) Fixed part.
Body of force transmission (4) and arrangement of sensor units: (a) Top view; (b) Bottom view.
Schematic of sensor operation.
3D dynamic forces/moments sensor.
Electronic diagram.
(a) UnderActuated Robot Manipulator; (b) Force sensor device coupled to the UARM end-effector.