Abstract

In recent years, the evolution of artificial intelligence techniques has widely grown such that it gives new ways to improve human life, not only at work but also living. Nowadays, to the human being, physical human-robot interactions (PHRIs) have been presented very important and present itself as a major challenge for the current engineering. Therefore, this work designs and analyses a two-degree-of-freedom robotic arm with flexible joints driven by a DC motor. Due to the interaction between the robot links and flexible joints, the arm may present overshoots when it is moved such that it becomes difficult to manipulate the arm. Therefore, Magnetorheological dampers (MR damper or MR brake) are attached to the links of the arm in order to control such overshoot and provide a way to adjust the mechanical limitations of the arm. The dynamics of the system will be investigated, showing the appearance of chaotic behavior due to the coupling of the manipulator to the motors. After that, the feedback control is obtained through the state-dependent Riccati equation (SDRE) aiming the control of the positioning of the manipulator and the torque applied on the MR damper. Numerical results showed that the proposed control using hybrid actuators, DC motor, and MR brake was effective to control the position and behavior of the flexible joints of the manipulators.

1. Introduction

Although in recent years, the human interaction with intelligent systems, such as voice or video recognition devices, has grown exponentially due to the evolution of artificial intelligence techniques, physical human-robot interaction (PHRI) presents itself as a major challenge for current engineering. Nowadays, the fact that an industrial that works only with robots is not feasible, much less the industry that works only with human workers in activities that cause the degradation of health. Therefore, a model of integration, physical, and cognitive logic between devices and people sharing the workspace is very important.

PHRIs have being designed to coexist and collaborate with operators in handling, assembling, cutting, and other tasks, without presenting a risk in this interaction [16].

There are several attempts to ensure the safety of humans within a workspace shared with machines. A large number of research studies have focused on the development of manipulators that are intrinsically safe. That is, manipulators in which can guarantee some level of collision safety in the absence of a controller through their mechanical properties.

In particular, vibrations which appear during the positioning of the robotic arm should be controlled to improve safety PHRI, which is also important for increasing efficiency and operation precision.

Many researchers have concentrated their efforts to study about manipulators with flexible links due to their advantage related to rigid ones. Such advantages include faster response, lower energy consumption, smaller actuators, less overall mass, and in general, smaller final cost [79]. Due to its natural flexibility, control of these systems takes into account both rigid body and elastic degree of freedom, so that their mathematical models have to consider the interactions between the actuators and load to be handled.

Therefore, to improve the efficiency of using the manipulators, control strategies are required. The SDRE control is being applied in many nonlinear systems due to its easy application and advantage of considering the influence of nonlinearities of the system, i.e., there is no need to linearize the system to be applied [1014]. Such control has been widely used in rigid and flexible robotic manipulators as the works of authors [8, 1423].

In addition, the links of the manipulators generally are driven by a DC motor; however, another kind of actuator which has demonstrated to be a good alternative to suppress vibrations or even be used as a drive device is the magnetorheological (MR) brake. According to [1, 24], the MR device consists of a MR fluid composed of microsized magnetic particles, located inside a liquid carrier, which forms chain-like structure when an external magnetic field is applied, resulting in an increase of the apparent viscosity of the fluid. The MR actuator is usually used as a damper and may be used as a passive or semiactive actuator.

In [25], the authors demonstrated the efficiency of the application of the magnetorheological (MR) brake in the positioning control of the two-degree-of-freedom robotic arm designed with flexible joints. The considered control is composed of two controls: a feedforward and a feedback by using the SDRE, and the torque of the MR damper is modelled by means of a neural network.

The present paper is a continuation of the previous developments [25]; however, the modelling of the MR damper is performed by the use of the explicit mathematical model. In this way, this work considers the positioning control of the dynamical behavior of a robot manipulator arm with flexible joints driven by a DC motor and MR brake, controlled for a feedback control obtained by the SDRE control, and considering a nonideal load carrying, and the control of the chaotic behavior. The MR brake torque is modelled by considering the behavior of a Bingham fluid. The main objective here is to study and control of the dynamics of a robot manipulator arm with flexible joints driven by a DC motor and MR brake, controlled by the SDRE control. The main contribution and new approach of this work is the inclusion of the flexible cables, and a new degree of freedom was included to the force on the load.

The study of vibrations in robot arms is of utmost importance. Robot arms are used for manipulations of objects, tools, and even for surgical purposes, and sometimes, vibrations are not allowed due to the needed precision in the manipulation operation. Then, the investigation and control of such vibrations become very important to robot arms.

This work is organized as follows: first section is the introduction; second and third sections discuss the dynamics of the manipulator with the modelling of the system and dynamical analysis through Poincaré maps and Lyapunov’s exponent analysis; fourth section shows the control proposal and development; fifth section shows the use of MR brake with the DC motor to control the system; and last section is the conclusions of this work.

2. Dynamics of the Manipulator with Flexible Joint

The dynamics of a robot manipulator is composed typically by an open kinematic chain, where each segment of their links, being rigid or flexible, has links from the base to the extreme of the actuator. In this way, the positioning and orientation of the coordinate system of the manipulator are defined by a universal coordinate system, which is considered as a Cartesian plane coordinate system.

A vector position is established as a (3-dimension) vector to define the motions of the robotic arm at X, Y, and Z coordinates in a plane {A}. The individual elements of are defined by

The graphical representation of the vector position is illustrated in Figure 1.

In addition, the vector position can be rotated by a matrix rotation represented by in the following equation:

As the plane of reference {A} does not coincide with any other coordinates in a plane {B}, the displacements between such planes are called translation given by the vector , where represents the translation between {A} and {B} planes, whose vectors are expressed in the following equation:

Therefore, the translation of the coordinates can be expressed in a new notation with both translation and rotation of a vector, according to equation (4), where the matrix is incorporated in the new notation.

In equation (4), the matrix represents the homogeneous transformation matrix, in this case, composed of the rotation matrix and the translation matrix . The result of the operation of equation (4) is graphically represented by Figure 2.

In the generalized form, the homogeneous transformation can be expressed by successive rotations and translations and can be found by calculating the product of the successive transformations of , as given bywhere is the orientation vector of the i reference related to the base 0.

The model of the manipulator with flexible joints with a load, illustrated in Figure 3, consists of two rigid links, l1 and l2, and two flexible joints with ks flexibility coefficient. The load of the manipulator is represented by a nonideal coupling of the cable flexibility, which is represented by kc.

The flexibility behavior of the manipulator between the DC motor and the link of the system is given by the components of flexibility between the motor and the motor reduction box or even the motor axis. In addition, the magnetorheological dampers MR1 and MR2 are coupled in the joints of the robotic arm, where they will act to control the movement of the arms.

The manipulator model is modelled through the energy method of Lagrange, which uses the function of Lagrange, which is based on kinetic and potential energies, and Euler–Lagrange equation.

The kinetic energy is defined by the motion of the links of the manipulator, as given bywhere the load coupling equation to the handler is given by representing the coupling with flexible cargo characteristics.

The kinetic energy in terms of the generalized coordinates θi, where , of the manipulator model, by introducing the matrices in equation (6), is given by the following equation:where , , and .

The interaction between the engine and the handler presents nonoptimal characteristic, expressed by the spring component ks; hence, the potential energy is given by the gravity force acting on each link and the torsional stiffness of each link, denoted by the following equation:

Introducing the matrices , the full equation of potential energy becomes

Given kinetic and potential energies, Lagrange’s function is defined, and Euler–Lagrange equation is applied to find the equations of motion of the system, considering the derivation of the coordinates as given by the following equation:where generalized coordinates are in function of θi and the nonideal coupling .

The equations of motion of the system can be expressed in the matrix form, denoted by the following equation:where the matrices M, C, and K arewhere , , , , , , , , , , , , , , , , , , , , , ,

The mechanical equations of the DC motor are described as in [5], denoted by equation (13). To the DC motor model, the flexible torque component is added; hence, the equation of motion of the motor coupled to the manipulator can be denoted by the following equation:where the electric part of the DC motor is given by the following equation:

For a better relation between torque and velocity, the motors have an engine reduction box; the schematic of the reduction box model is illustrated in Figure 4, where JL is the inertia of the link [5].

The relation constant between the magnitudes of the system is defined by the following equation:

Thus, it is explicit that the velocity ratio of the system is given by . The viscous friction constant and inertia of the DC motor with the reduction box can be expressed by equation (16), considering the reflection effect of the variables by the ratio of the gears and [5]:

Therefore, the equations of motion of the system with mechanical and electrical parts of the DC motor coupled to the manipulator are given by the following equation:

To demonstrate the interaction between the subsystems, manipulator, and tool or load, the energy exchange between each element will be analysed. For the first model of the manipulator with nonideal load, it is intended here to analyse the interaction between the manipulator and the coupled load, where the motor axis is at an arbitrary position such as and .

To obtain the steady-state energy of the model, it is considered , where the steady-state energy is given by . A small perturbation will be added in the system to analyse the interaction between the manipulator and load; thus, , where is a small fraction of . Based on , the initial conditions to analyse the interaction between the systems can be obtained.

The kinetic energy exchange between manipulator and load is shown in Figure 5. The kinetic energy of the manipulator is shown in red and kinetic energy of the cargo/load in black. It is observed that to the increase of energy of the load entails in the reduction of the energy of the manipulator, this event is given by the exchange of energy between the systems, in addition, showing the nonideality of the system.

The nonideal coupling characteristic, which for the first example of the manipulator is presented by the coefficient of elasticity of the element connecting the load to the manipulator, brings a new dynamics to the system in comparison to the ideal system.

3. Dynamical Analysis

The dynamic analyses of the system and all the numerical simulations, which will be carried out in this work, considered the parameters of Table 1. Such analyses will consider the use of tools such as Poincaré maps, phase planes, and Lyapunov exponent analysis.

The dynamical analysis consists of the interaction of links with the axes where the DC motor is coupled. Therefore, the axes are fixed, and arbitrary is chosen with an initial condition of and .

Table 1 shows the whole nomenclature of the manipulator system and control strategy, which will be developed in the next section.

Figure 6 displays the phase plane of the two manipulators links θ1 and θ2, with their velocities and , as shown in Figures 7(a) and 7(b), respectively. A small variation of steady-state energy was added to the initial conditions as . The surface of the Poincaré map for Figures 6(a) and 6(b), in red, shows a quasiperiodic behavior. This behavior, demonstrated in Figure 6, expresses the dynamics of the manipulator with flexible links without the addition of the load at the end of the effector.

To analyse the system with the nonideal load coupled to the manipulator, the same dynamical analysis of Figure 6 is carried out; however, the load dynamics is added. By setting the axes θ4 and θ5, the energy is defined, where . Figure 7 presents the system dynamics with the nonideal load coupled to the end of the manipulator. These Figures 7(a) and 7(b) show the nonperiodic orbits that represent the behavior of the system, since the phase plane crosses the surface of Poincaré in several different points. Such behavior, in the analysis of dynamic systems, can be classified with evidence of chaotic behavior; however, it is necessary to use another analytical tool to verify the chaos.

The Lyapunov exponent method consists of the analysis of the sensitivity of the initial conditions of a dynamical system being able to show if a system has periodic, quasiperiodic, or chaotic behavior. Applying this method to the model of manipulator with nonideal load coupled to its end, Figure 8 shows the three most relevant exponents. The system showed to be very sensitive to their initial conditions due to the existence of a positive exponent, which is λ1 = 3.2 in red. In addition, as there is at least one positive exponent, the behavior of the system is characterized as chaotic.

Next, a control strategy is proposed to suppress the chaotic behavior.

4. Control Strategy

The control strategy to be considered is the SDRE (state-dependent Riccati equation). The well-known SDRE controller has become very popular within the control community in the last decade, providing a very effective algorithm solution to synthesize nonlinear feedback controls by allowing nonlinearities in the states of the system in addition to offer great design flexibility through that of the dependent-state weighting matrices.

4.1. Discrete Time SDRE Controller Design

The control strategy proposed here is based on continuous time SDRE; however, in this actual application, it is necessary to incorporate the control into a digital device; thus, one should adjust the design to the DSDRE (discrete-time state-dependent Riccati equation) topology.

The first step is to define the error vector in which it should be minimized. In this work, typically, the error vector is composed of the states related to a new coordinate in which the manipulator must reach; thus, the error equation should be defined aswhere is the error vector, represents the desired coordinate, and is obtained by finding the static equilibrium point for the positioning coordinates.

The optimal control problem for the system with coefficients of the state matrix and infinite horizon condition can be formulated as a function of the new error coordinates, as in the following equation:

The solution of the optimal control problem is obtained by the Riccati equation, given by the following equation:

Although the solution of equation (20) provides an optimal control solution, in the SDRE control, this solution is presented as suboptimal because each interaction recalculates the local optimal value for the control, based on the error state arrays and B.

The matrices Q and R are semidefinite and positive, Q > 0, R > 0, guaranteeing that the system is asymptotically stable [26]. Therefore, the dynamic equation of the error can be rewritten as follows:

The matrix of controller gains is given by , defined by the following equation:

Besides, the choosing of the parameter of performance matrices Q and R is an important factor to ensure optimality, a dynamic system does not always have full controllability of the states; in this way, it should be verified the controllability matrix for each interaction, according to the controllability theorem.

A dynamic system such as equation (21) is completely controllable if and only if the controllability matrix station is equal to n, which is defined bywhere represents the dimension of the state matrix .

However, the proposal presented above applies to continuous time ; thus, the controller must be adapted to be shipped in a digital device.

In a digital device, the time relationship is limited to the physical characteristics of a microcontrollable device; for example, the conversion time from the analogue to the digital system can set the minimum time of operation of the variables for a real-time representation. At this discrete time unit, the denomination of sampling time is given by .

According to [15], since there is a u(t) for , where , it can be substituted to . In this way, the discretization of a system of dynamic equations can be rewritten bywith , where , consequently, the transformation matrix for discretization of the system is given by the following equation:

For Ts significantly small in reaction to the dynamics of the system, it is obtained the discretized system matrix through the first order of the Taylor series, given aswhere I is an identity matrix.

Once the matrices of the discretized system are defined, it is possible to state the minimization function of the controller error for discrete time, which is

The solution of equation (27) can be obtained through the DARE (algebraic solution of the Riccati discrete equation), which is demonstrated by the following equation:

The equation of controller gains Kk for each discrete time interaction k is then defined by the following equation:

For a better visualization of the controller calculation steps, the control Algorithm 1 is shown. The Algorithm 1 recalculates the control vector Kk at each interval of Ts, obtaining the local optimal value of the system.

Data: Continuous time variables A, B, Q, R, Pk−1
Results: Kk control vector
Initiating;
Read the arrays A, B, Q, R, Pk−1;
if  = n then
while do
  Calc Matrix Ak and Bk;
  Calc Pk in equation (28);
  Find the controller gains;
  
 end
else
end

Considering the dynamics of the manipulator, the DC motor is coupled in the axis , giving the equations of motion of the controlled system denoted by the following equation:

For the application of state-space control, it is necessary to isolate the system acceleration vector of equation (30) described by the following equation:

After isolating the accelerations, the system is transformed in state-space notation, being that x is , whose system in state-space notation in the matrix form is given by the following equation:where A is the state matrix, B is the control matrix, and G(x) is the gravitational change. The controller design matrices are presented by the following equation:where I is the identity matrix.

The closed-loop control represented in block diagrams is illustrated in Figure 9.

Defining the positions of the desired coordinates as , where and , the results of the control can be observed in Figure 9. It should be noted that the goal of xd refers to the final position of the axes θ1 and θ2, where the inclusion of the nonideal load has a disturbing effect on the system.

Figure 10 shows and . It can be seen that response of Figure 10 has a steady-state error. The disturbance oscillation was absorbed by the manipulator.

5. Magnetorheological Actuator

The MR fluids belong to a family of rheological materials that undergo phase change under the application of magnetic fields. Typically, MR fluids are composed of ferromagnetic or soft paramagnetic particles (0.03 to 10 μm) dispersed in a carrier fluid. Due to design issues, magnetizable particles must have low levels of magnetic coercivity, and then, various types of materials have been applied to coat the ER (electrorheology) fluid [27] with ceramics and metal alloys.

The dynamic behavior of the MR fluids, from the theory of fluid mechanics, shows that with the absence of a magnetic field on the fluid, it is classified as a Newtonian fluid, whereas when exposed to a magnetic field exhibits Bingham [28] viscoelastic behavior, as represented in Figure 11. The electromagnetic field is typically generated by electric coils.

The equation that defines the behavior of a Bingham fluid is given by equation (34):where τc represents the shear stress, η is the Newtonian viscosity coefficient, γ is the shear rate, τy is the stress related to the dynamic behavior of the fluid MR, and is the velocity gradient in the direction of the magnetic field.

As previously mentioned, when a magnetic field is applied in the fluid, the shear stress ratio can change; hence, the function τy has a dependence on the intensity of the magnetic field, defined by H. The multidisc composite MR brake is adopted here, such approach is due to the lack of several discs increasing the contact region with the oil, allowing the reductions of spacing lf.

Therefore, equation (34) is rewritten as equation (35), considering the magnetic field H and the radius r of the circumference of the disk:where the term ω represents the speed of rotation of the disk.

The variation of torque produced by a circumferential element of the rotational brake of the MR of radius r is given by the following equation:

The geometric relation of r is given by the relation r = R2 – R1. In this way, it is possible to integrate equation (35) as a function of the circle radius of the disk, according to the following equation:where represents the number of disks in the engine.

The above equations present the dynamics related to the MR fluid mechanics; however, for this work, the hybrid actuator composition will be considered, being that the MR actuator aims at damping undesired vibrations in the robotic manipulator, as well as the coupling of the motor for positioning of the manipulator.

The equation that couples the MR actuator to the system is denoted by the following equation:

At last, finalizing equation (38), it is necessary to define the relation between τy and the magnetic field generated by the coils of the MR actuator. In this context, there are two fundamental laws of magnetic field and flux: Ampere’s law and Gauss’ law. This deduction is made typically for a MR project, where it can be related to the magnetic field lines that pass through the MR fluid; however, the described curve of authors in [29] was adopted, where the fluid dynamics is found by the following equation:where α and β are obtained from the experimental curve of the MR fluid.

Then, equation (39) is rewritten, denoted by the following equation:

The MR actuator has two control inputs: , the motor voltage for positioning, and H(t), for control of the viscosity component in order to eliminate the vibration of the system.

As a proposal to improve the manipulator for nonideal loading, the model where the MR actuator is coupled is presented, according to the following equation:

For the application of state-space control, it is necessary to isolate the system acceleration vector, equation (41), becoming

In this way, after isolating the accelerations, the system is transformed state-space form, being that . The state-space system in the matrix form is given by equation (43), where A is the state matrix, B is the control matrix, and G(x) is the gravitational change:

The controller design matrices are presented by the following equation:where I is the identity matrix.

The closed-loop control for the MR brake represented in block diagrams is illustrated by Figure 12.

The values for the desired trajectory xd are maintained as in the previous case. Likewise, the goal of xd refers to the final position of the axes θ1 and θ1, where the inclusion of the nonideal load is presented as a perturbation effect to the system. Then, the system response is shown by Figure 13.

It can be seen that the MR utilization caused the system to not oscillate and caused less error in the steady-state regime, as Figure 14.

In Figure 15, the robot displacement trajectory in 5(s) can be seen, considering the robot displacement trajectory by control without and with MR brake.

Figure 16 shows the DC motor control input.

Figure 17 shows the control torque to joints.

The current curves to be applied to the MR can be seen in Figure 18.

As can be observed in the simulation results, with the use of the MR brake, it was possible to reduce the oscillations of the suspended mass.

6. Conclusions

This work presented the efficiency of the SDRE controller technique using a DC motor and the DC motor with a MR brake coupling to control a robot manipulator of flexible links and joints with a free load at its end.

Using only the DC motor, it was possible to control the system leading the manipulator arms to the desired trajectory, and the error was very small. Using the DC motor and MR brake, the arms also led to the desired trajectory; however, the error was minimized almost to zero, showing that using multiple actuators improve the control performance and minimize the interference of external disturbances.

Data Availability

The authors declare that data are available for researchers upon request to the corresponding author.

Conflicts of Interest

The authors declare that they have no conflicts of interest.

Acknowledgments

The authors acknowledge financial support by the CNPq, CAPES, and FA, all Brazilian research funding agencies. In addition, the authors thank the organizing committee of the International Mechanical Engineering Congress and Exposition (ASME 2016), where part of this work was presented.