5.1. Comparison between Block Diagram and Bond Graph Models
The simulation results from the block diagram and bond graph models are presented and discussed in this section. While the block diagram dynamic model of the exoskeleton robotic system is simulated via MATLAB software, the simulation of the bond graph modeling is carried out via 20-sim software [
7]. The results from both simulation softwares are plotted with MATLAB.
The exoskeleton system, presented and discussed in previous sections, has been fed with an input torque of and a human trunk velocity of with a delay of . The simulations are carried out based on the torque sensed by the torque sensor as an effort variable in the terminology of the bond graph modeling and also the rotational velocity of the brushless DC motor shaft (gearbox transmission input velocity) is a flow variable in the terminology of the bond graph modeling. However, the simulation tests can be extended and implemented for all the system variables.
A comparison between the torque applied on the torque sensor through results from block diagram and bond graph models is demonstrated in
Figure 10. From
Figure 10, it can be inferred that the results from the bond graph model for the torque implemented on the torque sensor is very similar and close to that from the block diagram; however, the accuracy is slightly reduced as the robotic platform (human trunk) moves. The whole average error for the simulation test is around
over 1
.
In addition, the difference between the rotational velocity of the brushless DC motor shaft through results from block diagram and bond graph models is shown in
Figure 11. It can be concluded from
Figure 11 that the two models are very close to each other and the overall average error is about
during the first second. Accordingly, the error at the start of the movement slightly increases, but then it starts to approach zero over time.
Finally, an excellent agreement between the block diagram model developed in MATLAB and bond graph model developed in 20-sim can be inferred from both
Figure 10 and
Figure 11. It should be pointed out that using different numerical differential equation solvers with diverse configurations by MATALB and 20-sim is the main reason of the small errors between the simulation results [
7].
5.2. Implementation of Kalman Filter Observer and Performance Analysis
The theory described in the forgoing sections means that both the dynamic model of the exoskeleton and Kalman observer can be implemented. The performance of the observer has been evaluated by comparing the values of the state variables computed by the simulator with the observer estimates on a test case using of a linear quadratic regulator (LQR) controller [
31] with integral action. It is important to note that the synthesis and application of the Linear-Quadratic-Integral control is not described in detail as it is not pertinent to the Kalman observer design and performance assessment. All the simulation results have been executed by means of MATLAB.
The following state-space equations for the LQR controller with integrator action are taken into consideration:
where
is the reference torque of the closed-loop control system and
z is the auxiliary state corresponding to
. Thereby, the optimal state-feedback control law is obtained in the form:
where
represents the optimal feedback matrix gain,
is the proportional matrix gain and
indicates the integral gain.
and
are positive definite symmetric weighing matrices of the LQR cost function corresponding to the states from the Kalman observer and the human trunk velocity. It is worth mentioning that the states from the observer contains estimated values corresponding to
and the estimated torque on the human body.
Varying
and
matrices cause changes in the location of the closed-loop poles which effects the performance of the system. While the large value of
causes smaller control inputs and thereby larger values of the states, a faster convergence of the states could be obtained by larger elements of
. The following consideration are used to achieve a proper feedback matrix:
where
is equal to the difference between estimated and reference torque on the human body. To reject the ramp trajectories arising from the human trunk position during the constant human velocity, the LQR requires a double integrator. Hence, the following formulation is derived:
The LQR optimal control law of Equation (
12) can be written as:
in which
t represents the instantaneous time and
is the variable of the integration associated with the time.
The controllability condition of the pair (
) is an adequate condition for the presence of a state feedback gain
in a way that (
) be asymptotically stable.
, the controller matrix, can be calculated by minimizing the quadratic performance index of the LQR controller for Equation (
12).
Figure 12 demonstrates the block diagram of the closed-loop control system. In
Figure 12,
is the gain related to the integrator term corresponding to the torque on the human trunk (last array of
) while the estimated torque on the human trunk is indicated by
.
A simulation to evaluate the observer performance has been carried out. The main assumption of this simulation is that the exoskeleton works in assistive mode. That is, the human trunk moves with a constant velocity ( ) and an assistive torque is applied on the human body by the exoskeleton. This simulated scenario is archived by applying a step reference as the system input with an amplitude of 10 and a delay of for a time period of .
It is worth noting that the resulting
and
matrices and weighting matrices (
and
) associated with LQR related to Equation (
12) are:
The final state feed-backs are extracted as follows:
Essentially, controllers based on state feedback which are implemented through state observers can have disappointing properties regarding relative stability even when the state feedback and state observers demonstrate good and robust stability characteristics [
32]. On this basis, stability margins have been evaluated by Nyquist plot (
Figure 13 and
Figure 14) of the loop gain, from the motor plant input (point
in
Figure 12) to the computed torque signal from the controller (point
in
Figure 12). We can see that the plot in
Figure 13, does not encircle the critical point (
), so the system is stable.
Figure 14 shows the Nyquist plot in the neighborhood of the critical point. The nominal design has a minimum gain margin of approximately
and minimum phase margin of about 59
with a delay margin of around
which indicates that the minimum sampling frequency of the control unit should be almost 143
to guarantee stability.
The bode plot of the transfer function from the input disturbance (human trunk velocity) to the estimated torque on the human body is shown in
Figure 15 to assess the disturbance rejection bandwidth. This determines how quickly the effects correlated with the human trunk motion decline to an acceptable level, for the exoskeleton platform. By considering the bandwidth as the first frequency in which the gain descends to below
of its DC value, it can be inferred that the bandwidth for tracking disturbance (human trunk velocity) rejection is almost 52
; nevertheless, it can be concluded that the human motion with the frequency range of 4∼6.2
has the most destructive effect on the estimated torque.
The first evidence of the observer’s effectiveness is reported in
Figure 16 where a comparison is made between the step responses of the closed-loop control system using the proposed state observer and the linear dynamic model of the system. As it can be inferred from
Figure 16, the step response of the observer and the linear model are very similar.
Figure 17 shows the error on
that is, the error between the linear model and the estimator in terms of torque on the human body. This is very small with the mean-squared error of about
and approaches zero over time. Another interesting finding from
Figure 16 is the undershoot at the beginning of the human motion. This occurs because of the phase delay between the human trunk motion velocity and the estimated torque (non-minimum phase system).
The DC motor velocity is shown by
Figure 18 and
Figure 19. While
Figure 18 shows a comparison between the measured and estimated values of the motor velocity, the error between these values (
) over time is reported in
Figure 19. Regarding these figures, the mean-squared error is around
which implies a good agreement between the measured and estimated variables.
Furthermore, according to
Figure 20, the overall torque produced by the brushless DC motor is in the defined torque limit range (
).