ORIGINAL RESEARCH article

Front. Neurorobot., 09 May 2025

Volume 19 - 2025 | https://doi.org/10.3389/fnbot.2025.1562519

Motion control and singular perturbation algorithms for lower limb rehabilitation robots


Yanchun Xie&#x;Yanchun Xie1Anna Wang&#x;Anna Wang2Xue ZhaoXue Zhao3Yang JiangYang Jiang4Yao WuYao Wu4Hailong Yu
Hailong Yu1*
  • 1Department of Orthopaedics, General Hospital of Northern Theater Command, Shenyang, China
  • 2Department of Burns and Plastic Surgery, General Hospital of Northern Theater Command, Shenyang, China
  • 3Daniel L. Goodwin College of Business, Benedictine University, Chicago, IL, United States
  • 4Faculty of Robot Science and Engineering, Northeastern University, Shenyang, China

To better assist patients with lower limb injuries in their rehabilitation training, this paper focuses on motion control and singular perturbation algorithms and their practical applications. First, the paper conducts an in-depth analysis of the mechanical structure of such robots and establishes detailed kinematics and dynamics models. An optimal S-type planning algorithm is proposed, transforming the S-type planning into an iterative solution problem for efficient and accelerated trajectory planning using dynamic equations. This algorithm comprehensively considers joint range of motion, speed constraints, and dynamic conditions, ensuring the smoothness and continuity of motion trajectories. Second, a zero-force control method is introduced, incorporating friction terms into the traditional dynamic equations and utilizing the LuGre friction model for friction analysis to achieve zero-force control. Furthermore, to address the multi-scale dynamic system characteristics present in rehabilitation training, a control method based on singular perturbation theory is proposed. This method enhances the system's robustness and adaptability by simplifying the system model and optimizing controller design, enabling it to better accommodate complex motion requirements during rehabilitation. Finally, experiments verify the correctness of the kinematics and optimal S-type trajectory planning. In lower limb rehabilitation robots, zero-force control can better assist patients in rehabilitation training for lower limb injuries, while the singular perturbation method improves the accuracy, response speed, and robustness of the control system, allowing it to adapt to individual rehabilitation needs and complex motion patterns. The novelty of this paper lies in the integration of the singular perturbation method with the LuGre friction model, significantly enhancing the precision of joint dynamic control, and improving controller design through the introduction of a torque deviation feedback mechanism, thereby increasing system stability and response speed. Experimental results demonstrate significant improvements in tracking error and system response compared to traditional methods, providing patients with a more comfortable and safer rehabilitation experience.

1 Introduction

With the global aging trend and evolving lifestyles, the demand for lower limb rehabilitation following injuries has surged, driving the widespread adoption of rehabilitation robots in medical applications. Notably, these robots exhibit significant potential in lower limb rehabilitation training (Qassim and Wan Hasan, 2020). Traditional rehabilitation relies heavily on specialized therapists to manually guide patients through passive exercises, a process that struggles to ensure consistency and continuity due to the limited availability of qualified therapists and variations in their skill levels stemming from individual differences. These factors represent key bottlenecks in current rehabilitation technology. Flexible lower limb rehabilitation robots address these challenges by simulating natural human movement patterns, offering personalized training programs, and facilitating the gradual restoration of motor functions, thereby alleviating the shortage of skilled trainers. However, technical challenges persist, particularly in achieving real-time responsiveness and precise trajectory planning in practical applications. The system models of lower limb rehabilitation robots typically exhibit complex characteristics, such as high order, non-linearity, and strong coupling. Additionally, the accuracy of these models is often challenging to ensure ultimately, which complicates the control structure. However, the singular perturbation method can simplify system models (Kevorkian and Cole, 2012) by partitioning the system into fast and slow subsystems based on time scales (Yu and Chen, 2015). Subsequently, controller design is conducted separately for these two subsystems. This approach reduces the order of the robot model and significantly decreases the computational burden. Li et al. (2021) developed an image-driven control strategy for the slow dynamic part involving rigid body motion to reduce visual errors, while compensating for errors in the approximated Jacobian matrix. For the fast dynamic part related to elastic vibrations, they designed an observer to predict the fast dynamic state to avoid relying on direct vibration state measurements. Based on these predicted states, a control feedback mechanism was developed to mitigate vibrations in the flexible robot. However, this system requires extra visual sensors, which introduces additional failure points. These visual sensors may experience malfunctions or degraded performance due to lighting conditions and dust.

The trajectory planning methods for rehabilitation robots have evolved from traditional robotic arms. Additionally, literature 0 introduced a smooth algorithm for trajectory planning of spray guns to address trajectory connection issues (From et al., 2010). Literature 0 explored the trajectory planning for the robot end effector (Dhanaraj et al., 2022). While literature 0 investigated the robot kinematic model using neural network approaches (Gao, 2020). However, due to the model complexity and the lengthy computation time, its engineering applications are limited. Motion control and singular perturbation control are critical technologies in rehabilitation robot control systems, directly impacting rehabilitation training effectiveness and safety. Further optimization of these control strategies significantly enhances the performance and clinical rehabilitation robot value.

This paper explores the development of kinematic and dynamic models for lower limb rehabilitation robots, providing a theoretical basis for trajectory planning. By applying maximum acceleration constraints to S-type trajectory planning, the study generates optimal acceleration trajectories that consider joint motion ranges, speed limits, and dynamic conditions, ensuring smooth and efficient robot operations. The integration of the LuGre friction model into the dynamic equations enables zero-force control, enhancing patient comfort during rehabilitation. Additionally, the combination of singular perturbation control and motor current-based joint torque control improves system performance, offering precise regulation and rapid response to dynamic changes. These advancements enhance the robustness and stability of the control system under external disturbances, supporting personalized rehabilitation treatments and expanding the clinical applicability of lower limb rehabilitation robots.

2 Motion control of lower limb rehabilitation robot

As shown in Figure 1, this system employs a hierarchical open architecture design Based on the human lower limb structure and its regular movement mechanisms to enhance patients' efficiency and enjoyment during rehabilitation training while allowing for personalized adjustments based on individual differences. Regarding safety, the robot legs can be equipped with flexible tactile sensor modules, which enhance the robot's interactivity and the precision of rehabilitation training. The robot also incorporates multiple safety mechanisms, including force feedback, position limits, and emergency stop buttons, ensuring rapid response in abnormal situations to protect patient safety.

Figure 1
www.frontiersin.org

Figure 1. Coordinate system and connecting rod diagram of flexible lower limb rehabilitation robot.

2.1 Kinematic model

In Figure 1, represent the lengths of the three links, while β denotes the angle between the extension line of link 3 and link 2. Let the height of the rise at joint 1 be h, and the rotational angles at the three joints be θ1, θ2, θ3. These three rotational angles collectively determine the spatial position and orientation. By adjusting the angles, the robot can navigate to different points in three-dimensional space, providing versatile functionality for patient interaction and treatment.

The DH parameters (as shown in Table 1) are used to describe the geometric relationship between adjacent joints in robotic manipulators, consisting of four key parameters: θ (joint angle), d (link offset), a (link length), and α (link twist angle). Specifically, θ represents the rotation angle about the Z-axis, describing the rotational displacement of the current joint and is typically a variable; d denotes the translation distance along the Z-axis, indicating the linear displacement of the current joint along the Z-axis and is usually a constant; a signifies the translation distance along the X-axis, representing the linear displacement of the current joint along the X-axis and is generally a constant; and α represents the rotation angle about the X-axis, describing the twist angle between adjacent joint axes and is typically a constant. Together, these parameters define the relative position and orientation between the joints of a robotic arm, providing a foundational framework for kinematic analysis.

TH0= T10 · 21T · 32T · 43T· H4 T =[nxoxaxpxnyoyaypynzozazpz0001]    (1)
{nx=C1S2C3 + S1C2C 3+ C1C2S3 + S1S2S3ny=0nz=S1S2C3  C1C2C3  S1C2S3  C1S2S3ox=C1S2S3  S1C2S3 + C1C2C3 + S1S2C3oy=0oz=0ax=0ay=1az=S1S2S3 + C1C2S3  S1C2C3  C1S2C3px=l1C1 + l2(C1S2 + S1C2) + l3(C1S2C3 + S1C2C3 + C1C2S3 + S1S2S3)py=0pz=hl1S1 + l2(S1S2  CIC2) + l3(S1S2C3C1C2C3  S1C2S3  C1S2S3)    (2)
Table 1
www.frontiersin.org

Table 1. Robot D-H parameters.

The known variables are:

{  C1=cosθ1   S1=sinθ1   C2=cosθ2 {S2=sinθ2 C3=cos(θ3+β) S3=sin(θ3+β)     (3)

The pose transformation matrix (Equation 1) can be obtained according to DH table, and the forward kinematics equation can be derived. In this matrix, the first three columns correspond to the projections of the new coordinate system's X-axis, Y-axis, and Z-axis direction vectors within the original coordinate system, represented as n=[nx,ny,nz]T o=[ox,oy,oz]T, respectively. These vectors collectively define the rotational (orientational) transformation of the new coordinate system relative to the original one. The fourth column p=[px,py,pz]T denotes the position vector of the new coordinate system's origin with respect to the original coordinate system, encapsulating the translational transformation. The final row [0, 0, 0, 1] serves as the normalization component of the homogeneous coordinates. Such transformation matrices are extensively utilized in robotic kinematics, where sequential multiplication facilitates the computation of the end-effector's pose relative to the base coordinate system.

2.2 Zero-force control

Set on the joint coordinates q=[h q1 q2 q3]T=[h θ1 θ1 + θ2 θ1 + θ2 + θ3]T. m1, m2 and m3 respectively, represent the mass of the three members, l1, l2 and l3 represent the length of the three members, d1, d2, d3 indicate the distance from the mass center to the axes of the three members, respectively.

(1) Rehabilitation of robot total potential energy

Potential energy P1 of rehabilitation robot rod 1

P1=m1g(h+d1cosq1)    (4)

The potential energy P2 of rehabilitation robot rod 2

P2 = m2 g (h + l1 cos q1 - d2 cos q2)    (5)

The potential energy P3 of rehabilitation robot rod 3

P=m3g(h+l1sinq1-l2sinq2+d3cos(q3+β))    (6)

The rehabilitation robot total potential energy as Equation 7.

P=P1+P2+P3    (7)

(2) The rehabilitation robot total kinetic energy of can be similarly obtained as follows

K=K1+K2+K3    (8)

The Lagrange function L is:

L=K-P=(K1+K2+K3)-(P1+P2+P3)    (9)

The known variables are:

{  C1=cosq1   S1=sinq1   C2=cosq2 {S2=sinq2 C3=cos(q3+β) S3=sin(q3+β)     (10)

The driving torque for each joint of the rehabilitation robot is then given by:

τ1=ddtLhLh=(m1+m2+m3)h¨+(m1d1+m2l1+m3l1)C1q¨1+(m2d2+m3l2)S2q¨2m3d3S3q¨3(m1d1+m2l1+m3l1)S1q˙12+(m2d2+m3l2)C2q˙22m3d3C3q˙32(m1+m2+m3)g    (11)

Similarly, we can get other joint driving torques. Take the friction term into the traditional dynamic equation and use the LuGre friction model for friction analysis and realize zero-force control. This study utilized a flexible lower-limb rehabilitation robotic experimental platform to approach enabled zero-force and high-precision control of the end effector force in the robot, achieving effective force feedback management.

M(q) q¨ + C(q, q˙) q˙ + G(q) + Tf(q˙) = τ    (12)

Tfis torque of LuGre friction, q˙ is angular velocity vector, q¨ is rotational angular acceleration vector.

This paper uses the LuGre friction model to compensate for joint dynamics. LuGre friction method not only enhances the fit of friction characteristics simulation but also improves the overall accuracy of the collision detection model. The LuGre friction model is

Tf(q˙) = {[fC + (fS - fc)exp(-(q˙q˙s)2)]} sgn(q˙) + σ2q˙    (13)

In order to obtain the real friction parameters, experiments are carried out on the vacuum manipulator platform to obtain the following data: among others, fC is Coulomb friction, fS is static friction; q˙(t) provides real-time speed for the joints; q˙s for Stribeck Speed δ is a parameter related to the shape of the contact surface; σ2 is the coefficient of viscous friction;τ(t) is the joint drive torque measured by a sensor. The sampling frequency is high enough to capture changes in friction over time.

In rehabilitation robotics, the LuGre friction model provides critical support for joint friction compensation. When a patient applies a minimal external force, the robot, based on real-time joint velocity measurements and identified friction parameters (such as static friction), generates an equivalent compensating torque through the controller to counteract the inherent friction resistance of the mechanical system. This process enables the end-effector to exhibit a “weightless” zero-force control effect for the patient, meaning that only a minimal force is required to drive the robot's motion. This significantly enhances the compliance of rehabilitation training and the safety of human-robot interaction. By experimentally calibrating parameters (e.g., low-speed sweep tests for static friction and high-speed constant velocity tests for viscous friction separation), the LuGre model further optimizes friction compensation accuracy, ensuring the robustness of zero-force control in complex motion scenarios.

2.3 Optimal S-type planning

Under optimal trajectory control, the lower limb rehabilitation robot significantly improves its trajectory planning ability and operational flexibility and maximizes the advantages of the lower limb rehabilitation robot. The trajectory interpolated core considers both kinematic constraints (such as joint angles and end-effector positions) and dynamic constraints (including forces, torques, and inertia). Optimal trajectory parameters that satisfy these constraints are computed using optimization algorithms.

A complete S-curve trajectory planning can be constructed based on Equations 14, 15.

J(t) is Jerk, A(t) is Acceleration and V(t) is Velocity:

J(t)={   J0t<t10 t1  t < t2J t2  t < t30 t3  t < t4J t4  t < t50 t5  t < t6J t6  t < t7    (14)
A(t)={      Jτ1 0t<t1     JT1t1t<t2JT1Jτ3t2t<t3       0t3t<t4   Jτ5t4t<t5   JT5t5t<t6JT5+Jτ7t6t<t7
V(t)={Vs+12Jτ120t<t1V01+JT1τ2t1t<t2V02+JT1τ312Jτ32t2t<t3V03t3t<t4V0412Jτ52t4t<t5V05JT5τ6t5t<t6V06JT5τ712Jτ72t6t<t7

Position is S(t):

S(t)={Vsτ1+16Jτ13 0t<t1                            S01+V01τ2+12JT1τ22  t1t<t2              S02+V02τ3+12JT1τ3216Jτ32 t2t<t3   S03+V03τ4  t3t<t4                             S04+V04τ516Jτ52 t4t<t5                  S05+V05τ612JT5τ62  t5t<t6              S06+V06τ712JT5τ72+16Jτ73  t6t<t7      (15)

An example of a planning segment from time node t0to t7is considered, where t0 represents the initial moment and t7 indicates the final moment. At both the start and end points, the robot velocity and acceleration are set to zero to ensure a smooth initiation and cessation of motion. Furthermore, it is essential to account for the limits of robot speed, acceleration, and jerk (the accelerated change rate) during the movement process. These include the max velocity vm, the max acceleration amu, the max deceleration amd, as well as the max jerk during the acceleration and deceleration phases, denoted as jmu, jmd. These parameters are directly related to robot safety and efficiency.

The states of trajectory planning at each discrete point (qi,q˙i,q¨i) are obtained using the robot S-type programming model. Based on the established dynamic model (Equation 16), the inverse dynamic IDy is used to solve the theoretical torque τi, cal of each joint demand.

τi,cal=IDy(qi,q˙i,q¨i)    (16)

The calculated moment value is compared with each manipulator joint's maximum output moment τi, max. If the calculated moment value exceeds the theoretical moment value, it indicates that the joint cannot provide the moment value and must be corrected to make the planning result conform to the moment limit. The corrected joint calculated moment is as follows Equation 17.

τi,calmax=sign(τi,cal)·min(τi,max,|τi,cal|)    (17)

The optimal trajectory control can be achieved only when the robot dynamics constraint is applied to the trajectory planning of the manipulator's end. According to the dynamic equation of the manipulator, the corresponding relationship between the joint torque and acceleration q¨newmax is obtained as follows Equation 18.

q¨newmax=M(q)(τi,calmax-q˙TC(q)q˙-g(q))    (18)

On this basis, the torque constraint is mapped to the acceleration constraint, the acceleration subject to the torque constraint is obtained, and the final acceleration constraint is obtained by comparing it with the joint acceleration in the initial state. The process is as follows Equation 19. q¨i,max is the maximum acceleration constraint in the initial state, q¨i,modified is the maximum acceleration of the i joint calculated by torque constraint.

q¨i,newmax=min(q¨i,max|q¨i,modified|)    (19)

q¨i,newmax is the maximum acceleration constraint adjusted by the dynamic constraint, and q¨ is the vector formed by the maximum joint acceleration calculated by the torque constraint. If the new acceleration constraint is substituted into the dynamic trajectory planning, the complete trajectory planning satisfies the dynamic constraint.

3 Singular perturbation method of lower limb rehabilitation robot

In the widespread robot application, a particular type of system is often encountered, characterized by significant differences in the rates of change between various states, exhibiting unique singularities and separated phenomena in motion (Weingartshofer et al., 2023; Amersdorfer and Meurer, 2022; Jiang et al., 2023; Wang et al., 2021; Pana et al., 2023; Cao et al., 2023; Zhang et al., 2024). Such systems, including electric motors, generators, precision robotic structures, and complex biological systems, are collectively called singularly perturbed systems or systems with dual time scales. For these dual time-scale dynamic systems, also known as singular perturbation systems, the design of control strategies must consider their multi-time-scale characteristics. Traditional control methods based on a single time scale are often inadequate, as the dynamic behaviors of such systems differ significantly across various time scales. To achieve precise control of these systems, it is common to utilize singular perturbation theory to decompose the original system into multiple subsystems that are temporally separated yet mutually coupled, with each subsystem corresponding to a specific time scale.

3.1 Singular perturbation model of robotics

This chapter focuses on transforming dynamic models into singular perturbation forms. Based on the inherent dynamic characteristics, mathematical transformation methods are applied to derive robot system models that comply with the requirements of singular perturbation theory analysis. During this derivation process, friction factors are temporarily excluded from consideration to simplify the analysis and highlight the core dynamic characteristics. The aim is to capture the essential dynamic behavior, it provides a theoretical framework for the design of subsequent controllers based on singular perturbation theory. The singular perturbation model is categorized into separate fast and slow subsystems. Typically, the fast subsystem reflects the high-frequency dynamic characteristics, while the slow subsystem characterizes the long-term behavior and primary motion trends.

By temporarily neglecting the influence of friction, a simplified dynamic model of the robotic joint torque system can be expressed as follows Equation 20, N is the accelerator transmission ratio, Jem is motor rotor inertia, is the electromotor torque formula, which from the AC permanent magnet synchronous motor torque model. τ is joint torque, τext is the external reaction torque.

{M(q)q¨+C(q˙,q˙)q˙+G(q)=τ+τextNJemq¨+τ=Nτemτem=32npyfisq    (20)

It can be observed as follows Equation 21.

τ=32Nnpψfisq-NJemdωdt    (21)

In the analysis of robotic dynamics, the electromotor torque τem serves as the driving source, and its output is transmitted to the robot joints through the transmission system, resulting in the joint torque τ. When the robot design includes joint torque sensors, this critical parameter can be directly measured. The expression for joint torque is given by Equation 22, where K represents the inherent stiffness of the joint, N−1θ is the equivalent joint angular displacement obtained by inversely transforming the motor angle θ through the gear ratio N, and q is the actual joint angle. This Equation illustrates the dynamic relationship between joint torque, motor angle, and joint angle, as well as the impact of stiffness K on system response. The motor angular acceleration is obtained from Equation 23.

τ=K(N-1θ-q)    (22)
θ¨=NK-1τ¨+Nq¨    (23)

Substituting Equations 22, 23 into the second equation in Equation 20, we get Equation 24.

N2JmK-1τ¨+τ=Nτm-N2Jmq¨    (24)

Since the inertia matrix is a symmetric positive definite matrix, the following equation can be obtained.

q¨=M(q)-1(τ+τext-C(q,q˙)q˙-G(q))    (25)

Substituting Equation 25 into Equation 24 gives Equation 26.

K-1τ¨+(Jm-1N-2+M(q)-1)τ=Jm-1N-1τm+M(q)-1    (26)
                                                         (C(q,q˙)q˙+G(q)-τext)

By introducing a small parameter ε, the system equations can be reformulated as a standard singular perturbation model. The joint stiffness K is often very high, so Kεε2 can be used instead of K. Kε is positive definite diagonal matrix. Substituting the expression of K and sorting it out, we can get the singular perturbation model of the system:

{M(q)q¨+C(q˙,q˙)q˙+G(q)=τ+τext ε2τ¨+Kε(Jem1N2+M(q)1)τ=KεJem1N1τem+KεM(q)1(C(q,q˙)q˙+G(q)τext )    (27)

The system boundary layer model is derived by introducing a new coordinate variable as follows Equation 28.

{h(q,q˙,t)=(Jem1N2+M1)1(Jem1N1τ¯em+M1(Cq¯˙+Gτ¯ext ))γ=τh(q,q˙,t),yn    (28)

Introduce a new time scale as follows Equation 29.

{v=(tt0)/εif ε=0    (29)

Equation 30 is derived from Equations 28, 29.

         d2γdt2+Ks(Jem-1N-2+M-1)(γ+h)    (30)
=KsJem-1N-1τem+KsM-1(Cq˙+G-τext)

At the time scale v, the state variables and the external inputs τext are regarded as static values. Equation 31 can be derived.

(Jem-1N-2+M-1)h=Jem-1N-1τ̄em    (31)
               +M-1(Cq˙+G-τ̄ext)

By substituting it into Equation 30, the final system boundary layer model is as follows Equation 32.

d2ydv2+Ks(Jem-1N-2+M-1)γ=KsJem-1N-1(τem-τ̄em)    (32)

3.2 Controller design based on singular perturbation

In robotic controller design, singular perturbation methods are often integrated into composite feedback strategies to optimize system performance, as shown in Figure 2. This decomposition strategy independently addresses the different time scale issues in the system dynamics, thereby enhancing system stability, improving response speed, and simplifying the controller complexity (Bhardwaj et al., 2021; Khan et al., 2022; Zheng et al., 2022; Iskandar et al., 2022).

Figure 2
www.frontiersin.org

Figure 2. Singular control structure diagram.

This design decomposes the control input into slow and fast system components, as shown in Equation 33.

τem=τem,slow+τem,fast    (33)

The slow subsystem represents the long-term behavior and primary motion trends of the robot. It is characterized by slower dynamics, such as the robot's overall trajectory and position control. The slow subsystem employs classical control strategies, such as computed torque control and torque feedforward control, which are commonly used in rigid robot models. These strategies ensure that the robot's motion is smooth and accurate over time.

For the selection of the control input τem, slow for the slow subsystem, it must be based on the assumption that the system has a standard form, meaning that the average time scale τ¯ in the quasi-steady-state model exists and has a unique solution. The key point is that the determination of τem, slow should depend solely on the state variables of the quasi-steady-state model (q,q˙), avoiding the direct introduction of instantaneous feedback from the joint torque τ, to ensure the independence and stability of the control input.

The fast subsystem captures high-frequency dynamics, such as vibrations and rapid adjustments in the robot's joints. These dynamics are critical for ensuring stability during rapid movements or when external disturbances are present.

In designing the control input τem, fast for the fast subsystem, it is essential to strictly adhere to the principle that it has no impact on the quasi-steady-state model when boundary layer effects are significant (ε = 0). This requires that the norm tends to zero under the limit condition (τem, fast|εto0 = 0). This design criterion aims to isolate potential disturbances from the fast subsystem on the dynamic behavior of the slow subsystem, ensuring the overall stability and accuracy of the system during rapid dynamic adjustments while optimizing performance in the boundary layer region. And we get the Equation 34.

{τem,slow=τem|calE0=τ¯τem,fast=τemτ¯=εDτγ˙    (34)

It becomes clear that this structure aligns with that of a rigid robot model. This alignment allows for the direct application of classical control strategies used for rigid manipulators, such as the computed torque method and torque feedforward control, for design slow subsystem.

The damping matrix Dτ is designed as a positive definite matrix to ensure the stability and convergence of the system. A positive definite damping matrix introduces an energy dissipation mechanism into the system, which helps to suppress oscillations and stabilize the system. This is particularly crucial for rehabilitation robots, as smooth and stable motion is vital for patient safety and comfort.

For the slow subsystem, the controller design follows the fundamental principles (Equation 35) of the rigid manipulator model. The variables q,q˙ represent the joint position and velocity. Considering the specificity of the boundary layer system, where time t and state variables can be treated as constants within a specific analytical framework, the original term -εDτγ˙ can be reasonably transformed into -εDττ˙. This transformation deepens the understanding of the system dynamic behavior under boundary conditions.

τem,slow=τrigid(q,q˙)    (35)

The design of the overall composite feedback controller for the robotic system integrates the control strategies of the aforementioned fast and slow subsystems. By adjusting the positive definite damping matrix, the control laws of the rigid manipulator model, and the dynamic adjustments under boundary layer effects, a robust and efficient control system framework is ultimately formed. This framework is capable of addressing complex and variable operational environments and task requirements.

τem=τrigid(q,q˙)-εDττ˙    (36)

It utilizes an increased damping term to act on the system. However, it does not address or optimize the dynamic characteristics of the boundary layer, which limits the system's overall performance improvement. To overcome this shortcoming, we introduce a torque deviation feedback mechanism. By monitoring and feeding back torque deviations in real-time, we can dynamically adjust the control strategy, enhancing system stability and significantly improving the boundary layer's dynamic response and adjustment capability, leading to more efficient system control.

The torque deviation feedback is Equation 37.

Kτγ=Kτ(τ-h(q,q,t))    (37)

Kτis gain matrix, which used to improve the boundary layer dynamic performance. Therefore, the entire controller can be expressed as follows:

τem=τrigid(q,q˙)-Kτγ-εDττ˙=τrigid(q,q˙)    (38)
                -Kτ(τ-h(q,q˙,t))-εDττ˙

3.3 Improved controller design

To implement an effective feedback mechanism, it is often necessary to accurately solve the steady-state function h(q,q˙,t). However, this can be quite challenging in practical applications, such as the difficulties in accurately measuring external torque τext and the complex computation of the inverse inertia matrix M(q). The Tychonov theorem states that for trajectory tracking errors, it ensures that the deviation from the quasi-steady state is bounded by a high-order infinitesimal quantity ε. This characteristic becomes significant only as ε approaches zero, highlighting the remarkable advantage of the boundary layer model over the quasi-steady state model in terms of dynamic response speed. By finely tuning the parameter ε, rapid convergence of the error to a range close to the quasi-steady state can be achieved. Its introduction enables us to decompose complex multi-timescale systems into two independent subsystems—the fast subsystem and the slow subsystem—thereby simplifying controller design. The fast subsystem is typically employed to address high-frequency dynamics (e.g., vibrations, rapid adjustments), while the slow subsystem is utilized to manage low-frequency dynamics (e.g., overall trajectory control, position control).

To lessen the complexity of the state function, the controller is broken down into the following structure.

τem=τss(q,q˙)-Kττ-εDττ˙    (39)

The positive definite control gain matrix Kτ, Dτ are crucial, as they ensure the system stability and responsiveness. The real-time control input τss(q,q˙) in the quasi-steady state model is dynamically adjusted based on the system state to achieve precise control. By replacing Kττ in the original Equation 39 with Kτy, it directly affects the dual time scale control strategy. On one hand, it directly acts on the fast system component, optimizing the computation of τm, fast to enhance the system rapid response capability and dynamic performance. On the other hand, this strategy also indirectly affects the control input of the slow system component τm, slow by optimizing the long-term control strategy, thereby improving the system robustness and steady-state accuracy. During the design process, careful adjustments to Kτ, Dτ are necessary, taking into account the interactions between the fast and slow systems to ensure that the overall control system can respond quickly to external changes while maintaining long-term stable operation.

τss(q̄,q̄)=N-1(I+Kτ)τd,τd    (40)
(M(q̄)+(I+Kτ)-1N2Jem)q̄̄+C(q̄,q̄)q̄+G(q̄)    (41)
          =(I+Kτ)-1Nτss(q̄,q̄)

τdas a new control input, it can be designed based on rigid robots to derive the steady-state system as follows Equation 41. Finally, we get the Equation 42 and Closed-loop control system Equation 43.

τem=τd-Kτ(τ-τd)-εDττ˙    (42)
    d2γdv2+KϵJem-1N-1Dτdγdv+kϵJem-1    (43)
(N-2+JemM(q)-1+N-1Kτ)γ=0

For the newly constructed quasi-steady state system, the design of the inertia matrix Kτ is closely related to the control gain matrix. We can dynamically configure the inertia distribution coefficient of the motor rotor by adjusting this parameter. This not only enhances the system resistance to external disturbances but also optimizes the response speed and stability of the control loop.

For the modified boundary layer system, the control input for the fast subsystem part is in the form of Equation 44.

τem,fast=-Kτ(τ̄-τ̄)-εDττ˙=-Kτγ-εDττ˙    (44)
    d2γdv2+KεJem-1N-1Dτdγdv+KεJem-1    (45)
(N-2+JemM(q)-1+N-1Kτ)γ=0

4 Experiment

4.1 Kinematics and trajectory planning

The kinematic experiment uses cylindrical helices and conical helices to verify the kinematic trajectories. The parametric equation for a cylindrical helix can be expressed as Equation 46.

{x(t)=R · cos(t)y(t)=R · sin(t)z(t)=c · t    (46)

Here, t is the parameter, R is the radius of the helix, and c is the pitch constant, which represents the distance the helix moves in the z direction for each complete turn.

The parametric equation for a conical helix can be expressed as Equation 47.

{x(t)=(R0+kt) · cos(t)y(t)=(R0+kt) · sin(t)z(t)=c · t    (47)

Here, R0 is the initial radius of the helix, k is the pheasant rate of change and c is the pitch constant.

As shown in Figure 3, by comparing the original end effector trajectory with the trajectory obtained from the forward kinematics calculations, the results indicate a high degree of consistency between the two. This not only verifies the correctness of the inverse and forward solution algorithms but also further demonstrates the accuracy and reliability of the robot kinematic model in design and practical applications.

Figure 3
www.frontiersin.org

Figure 3. Cylindrical helix and conical helix.

Figure 4 clearly illustrates the trajectory constraints of S-curve trajectory planning within a specified time frame and how to accurately generate trajectories that comply with preset acceleration limits, thereby validating the correctness of this planning method. The main advantage of trajectory planning in joint space is the direct control of the robotic joint movements. Compared to trajectory planning in operational space, this approach significantly enhances operational flexibility and accuracy. Furthermore, this method effectively avoids potential issues arising from motion singularities and operational complexities, thereby enhancing the robustness of the system.

Figure 4
www.frontiersin.org

Figure 4. S-type trajectory planning.

In this paper, the torque value obtained by the complete dynamic model is converted into the acceleration value, and the acceleration value is further applied as a limiting factor in trajectory planning to obtain the optimal trajectory control of the lower limb rehabilitation robot. As shown in Figure 5, the horizontal coordinate is the time, and the vertical coordinate is the TCP end position of the vacuum manipulator. Red is the general planning curve, and blue is the optimal trajectory curve. When the end position is from 0 to −80 and then to 90, the robot's time is obtained from the acceleration calculated by the dynamics, and the planning time becomes significantly faster.

Figure 5
www.frontiersin.org

Figure 5. Optimal trajectory control end position time.

The acceleration calculated by the dynamics is applied to the S-type trajectory planning, and the optimal trajectory control of the acceleration of the S-type trajectory is performed indirectly according to the acceleration solved by the dynamics to achieve the corresponding optimal. Comparing the running time with the ordinary planning time, optimal S-type planning performs quickly. Optimal S-type planning typically requires that servo drives use position control, which enhances the speed and current response of the motor, thereby improving the effectiveness of position control.

4.2 Zero-force control based on friction model

Zero force control is a compliant control strategy that aims to ensure that the force between the system and the environment remains at zero level. The LuGre friction parameters are identified and optimized, and the theoretical driving torque is solved against the collected actual torque, as shown in Figure 6. The blue curve represents the real friction moment curve, while the red curve is the moment curve of the LuGre friction model proposed in this paper. The deviation of actual friction and LuGre friction is calculated to be about 5 Nm. The results verify that the whole dynamic algorithm with The LuGre friction can effectively solve zero-force control.

Figure 6
www.frontiersin.org

Figure 6. Comparison of actual torque and theoretical torque on zero-load control.

To intuitively and scientifically validate the effectiveness of the dynamic algorithm, this study utilized a flexible lower-limb rehabilitation robotic experimental platform to demonstrate a zero-load control algorithm. As shown in Figure 7, this approach enabled high-precision control of the end effector force in the robot, achieving effective force feedback management.

Figure 7
www.frontiersin.org

Figure 7. Zero-load control of flexible lower limb rehabilitation robot.

Implementing the zero-load control algorithm on the experimental platform signifies that the robot can more accurately simulate the natural movement patterns of the human body while performing rehabilitation training tasks. This reduces unnecessary mechanical resistance and discomfort, enhancing patient rehabilitation experience and therapeutic outcomes. Such advancements have profound implications for improving rehabilitation efficiency, shortening recovery periods, and reducing overall rehabilitation costs.

4.3 Singular perturbation

To validate the effectiveness of the designed control method, we compared the PD control strategy with a PD-based composite control strategy that integrates singular perturbation theory. The core of the experiment involved quantitatively analyzing the system performance under both control architectures, focusing on key metrics such as system tracking error, velocity response curves, and velocity error. Figures 8, 9 visually demonstrate the system dynamic behavior using classical PD control, providing a benchmark for subsequent comparison with PD control combined with singular perturbation theory. In figures, the Tracking difference on the Y-axis represents the actual code drive value minus the planned code drive value, and its units can be expressed in PPR (Pulse Per Revolution).

Figure 8
www.frontiersin.org

Figure 8. Tracking error of PD control.

Figure 9
www.frontiersin.org

Figure 9. Command velocity vs. actual velocity with PD control.

The system data curves for the PD combined with singular perturbation control are presented in Figures 10, 11.

Figure 10
www.frontiersin.org

Figure 10. Tracking error of PD + singular perturbation control.

Figure 11
www.frontiersin.org

Figure 11. Command velocity vs. actual velocity with PD control + singular perturbation.

The comparison curves (Figure 12) indicate that a singular perturbation controller significantly enhances system tracking performance, reducing the tracking error by about one-third compared to using only a PD controller. As a critical step in evaluating the controller performance, experimental validation, through comparative data, demonstrates that the PD with singular perturbation control effectively reduces system tracking errors, ensuring more accurate trajectory tracking.

Figure 12
www.frontiersin.org

Figure 12. Compared curves of the two methods.

From Table 2, we can intuitively observe the advantages and disadvantages of the two control methods. The PD control excels in its simplicity and low computational cost, making it suitable for real-time applications in rigid systems. However, it struggles with multi-time-scale dynamics and external disturbances, leading to larger tracking errors and slower response times. In contrast, the PD + Singular Control (PD+SC) significantly improves response speed, tracking accuracy, and system robustness by effectively handling multi-time-scale dynamics. Nevertheless, it comes with increased complexity in controller design, higher computational demands, and potential errors due to model simplification. This comparison highlights the trade-offs between simplicity and performance in control system design.

Table 2
www.frontiersin.org

Table 2. Compared methods.

The improvement in tracking error has significant practical implications for patient rehabilitation. By reducing tracking errors, the robot can more precisely follow the patient's movement intentions, minimizing unnecessary mechanical resistance or sudden adjustments. This enhanced precision makes the rehabilitation training feel more natural and comfortable for patients, reducing discomfort caused by inaccurate robot movements. Additionally, smaller tracking errors enable the robot to respond more accurately to the patient's actions during training, enhancing safety by preventing accidents due to control delays or errors. For example, if a patient suddenly stops or changes direction, the robot can adjust quickly and accurately, lowering the risk of injury. Furthermore, precise motion control allows patients to engage in more effective rehabilitation training. By providing consistent and accurate assistance, the robot helps patients better restore their motor functions, potentially accelerating the recovery process and shortening rehabilitation time. The experimental results allow for further adjustments and optimization of the control parameters to achieve the best control outcomes. This validates the theoretical design's correctness and provides valuable experience and data support for future engineering applications.

5 Conclusion

This paper focuses on developing a flexible lower limb rehabilitation robot, with an in-depth exploration of the construction process for motion control and singular perturbation algorithms. The classical DH method was employed to ensure the accuracy and practicality of the models. The study demonstrates a dynamic zero-load control algorithm to utilize a flexible lower-limb rehabilitation robotic. Take the friction term into the traditional dynamic equation and use the LuGre friction model for friction analysis to realize zero-force control. This approach enabled high-precision control of the end effector force in the robot, achieving effective force feedback management. In this paper, an optimal S-type planning with limited acceleration is proposed, and a complete algorithm for all possible trajectory shapes under various constraints is given. The trajectory planning algorithm proposed in this paper is more consistent with the actual motion performance of the robot. The limitations of traditional singular perturbation control methods in flexible joint robots were anal in control strategize. The rehabilitation robot employing the improved singular perturbation control strategy can rapidly respond to and adjust the applied external forces when the patient actively participates in training, significantly reducing the discomfort and stress risks perceived by the patient. This technology demonstrates significant control accuracy, system response speed, and operational safety advantages.

Looking ahead, we plan to expand further and optimize the findings of this research, including but not limited to improving the accuracy of the dynamic models, optimizing the efficiency of the control algorithms, and enhancing the robustness and adaptability of the system. Additionally, we will actively explore the application potential of this technology in other rehabilitation robot fields, such as upper limb and spinal rehabilitation, to benefit more patients in need of rehabilitation support.

Data availability statement

The raw data supporting the conclusions of this article will be made available by the authors, without undue reservation.

Author contributions

YX: Writing – original draft. AW: Writing – original draft. XZ: Writing – review & editing. YJ: Writing – original draft. YW: Writing – original draft. HY: Writing – original draft.

Funding

The author(s) declare that financial support was received for the research and/or publication of this article. This research was funded by Basic Research on Stress induced Bone Growth of Porous Titanium and Its Potential Application in Spinal Fusion Cages (Project No.: 2023JH2/101700136), Basic and Applied Research Project of Liaoning Provincial Science and Technology Planning.

Conflict of interest

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

Generative AI statement

The author(s) declare that no Gen AI was used in the creation of this manuscript.

Publisher's note

All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article, or claim that may be made by its manufacturer, is not guaranteed or endorsed by the publisher.

References

Amersdorfer, M., and Meurer, T. (2022). Equidistant tool path and cartesian trajectory planning for robotic machining of curved freeform surfaces. IEEE Trans. Automat. Sci. Eng. 19, 3311–3323. doi: 10.1109/TASE.2021.3117691

Crossref Full Text | Google Scholar

Bhardwaj, S., Khan, A. A., and Muzammil, M. (2021). Lower limb rehabilitation robotics: the current understanding and technology. Work 69, 775–793. doi: 10.3233/WOR-205012

PubMed Abstract | Crossref Full Text | Google Scholar

Cao, Y., Chen, X., Zhang, M., and Huang, J. (2023). Adaptive position constrained assist-as-needed control for rehabilitation robots. IEEE Trans. Indus. Electron. 71, 4059–4068. doi: 10.1109/TIE.2023.3273270

Crossref Full Text | Google Scholar

Dhanaraj, N., Yoon, Y. J., Malhan, R., Bhatt, P. M., Thakar, S., and Gupta, S. K. (2022). A mobile manipulator system for accurate and efficient spraying on large surfaces. Proc. Comput. Sci. 200, 1528–1539. doi: 10.1016/j.procs.2022.01.354

Crossref Full Text | Google Scholar

From, P. J., Gunnar, J., and Gravdahl, J. T. (2010). Optimal paint gun orientation in spray paint applications—experimental results. IEEE Trans. Automat. Sci. Eng. 8, 438–442. doi: 10.1109/TASE.2010.2089450

Crossref Full Text | Google Scholar

Gao, R. (2020). Inverse kinematics solution of Robotics based on neural network algorithms. J. Ambient Intell. Human. Comput. 11, 6199–6209. doi: 10.1007/s12652-020-01815-4

Crossref Full Text | Google Scholar

Iskandar, M., van Ommeren, C., Wu, X., Albu-Schäffer, A., and Dietrich, A. (2022). Model predictive control applied to different time-scale dynamics of flexible joint robots. IEEE Robot. Automat. Lett. 8, 672–679. doi: 10.1109/LRA.2022.3229226

Crossref Full Text | Google Scholar

Jiang, Y., Yu, Y., Zhang, H. Y., Sun, D. K., and Li, Z. H. (2023). Research on application of compliant control of smart meter box handling robot. Energy Rep. 9, 1494–1501 doi: 10.1016/j.egyr.2023.06.050

Crossref Full Text | Google Scholar

Kevorkian, J., and Cole, J. D. (2012). Multiple Scale and Singular Perturbation Methods, Vol. 114. New York, NY: Springer Science & Business Media.

Google Scholar

Khan, R. F. A., Rsetam, K., Cao, Z., and Man, Z. (2022). Singular perturbation-based adaptive integral sliding mode control for flexible joint robots. IEEE Trans. Indus. Electron. 70, 10516–10525. doi: 10.1109/TIE.2022.3222684

Crossref Full Text | Google Scholar

Li, K., Wang, H., Liang, X., and Miao, Y. (2021). Visual servoing of flexible-link manipulators by considering vibration suppression without deformation measurements. IEEE Trans. Cybernet. 52, 12454–12463. doi: 10.1109/TCYB.2021.3072779

PubMed Abstract | Crossref Full Text | Google Scholar

Pana, C. F., Popescu, D., and Radulescu, V. M. (2023). Patent review of lower limb rehabilitation robotic systems by sensors and actuation systems used. Sensors 23:6237. doi: 10.3390/s23136237

PubMed Abstract | Crossref Full Text | Google Scholar

Qassim, H. M., and Wan Hasan, W. Z. (2020). A review on upper limb rehabilitation robots. Appl. Sci. 10:6976. doi: 10.3390/app10196976

Crossref Full Text | Google Scholar

Wang, Z., Li, Y., Sun, P., Luo, Y., Chen, B., and Zhu, W. (2021). A multi-objective approach for the trajectory planning of a 7-DOF serial-parallel hybrid humanoid arm. Mechanism Machine Theory 165:104423. doi: 10.1016/j.mechmachtheory.2021.104423

Crossref Full Text | Google Scholar

Weingartshofer, T., Hartl-Nesic, C., and Kugi, A. (2023). Automatic and flexible robotic drawing on complex surfaces with an industrial robot. IEEE Trans. Control Syst. Technol. 32, 1602–1615. doi: 10.1109/TCST.2023.3345209

Crossref Full Text | Google Scholar

Yu, X. Y., and Chen, L. (2015). Modeling and observer-based augmented adaptive control of flexible-joint free-floating space manipulators. Acta Astronaut. 108, 146–155. doi: 10.1016/j.actaastro.2014.12.002

Crossref Full Text | Google Scholar

Zhang, X., Rong, X., and Luo, H. (2024). Optimizing lower limb rehabilitation: the intersection of machine learning and rehabilitative robotics. Front. Rehabil. Sci. 5:1246773. doi: 10.3389/fresc.2024.1246773

PubMed Abstract | Crossref Full Text | Google Scholar

Zheng, K., Zhang, Q., and Zeng, S. (2022). Trajectory control and vibration suppression of rigid-flexible parallel robot based on singular perturbation method. Asian J. Control 24, 3006–3021. doi: 10.1002/asjc.2729

Crossref Full Text | Google Scholar

Keywords: rehabilitation robots, trajectory planning, singular perturbation, flexible control, controller design

Citation: Xie Y, Wang A, Zhao X, Jiang Y, Wu Y and Yu H (2025) Motion control and singular perturbation algorithms for lower limb rehabilitation robots. Front. Neurorobot. 19:1562519. doi: 10.3389/fnbot.2025.1562519

Received: 17 January 2025; Accepted: 28 March 2025;
Published: 09 May 2025.

Edited by:

Tomohiro Shibata, Kyushu Institute of Technology, Japan

Reviewed by:

Bin Zhi Li, Chinese Academy of Sciences (CAS), China
Wentai Zhang, Peking Union Medical College Hospital (CAMS), China

Copyright © 2025 Xie, Wang, Zhao, Jiang, Wu and Yu. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Hailong Yu, MTk1NTQxNjM1OUBxcS5jb20=

These authors have contributed equally to this work

Disclaimer: All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article or claim that may be made by its manufacturer is not guaranteed or endorsed by the publisher.