# Tip-Over Stability Analysis of a Pelvic Support Walking Robot

Authors: Yawei Han; Shuai Guo; Leigang Zhang; Fengfeng (Jeff) Xi; Weiwei Lu
Journal: Journal of Healthcare Engineering
 (2020)

---

## Abstract

Discussed in this paper is the tip-over stability analysis of a pelvic support walking robot. To improve the activities of daily living (ADL) in hemiplegic patients, a pelvic support walking robot is proposed to help patients facilitating their rehabilitation. During the gait training with the robot, the abnormal man-machine interaction forces may lead to the tip-over of the robot, which is not beneficial to the rehabilitation process. A new method is proposed to predict the possibility of tipping over and evaluate the stability of the robot based on statics model, dynamics model, and zero-moment point (ZMP) theory. Through the interaction forces and moments analysis with static case, the safe point (ZMP) is studied, and the influence factors of force/moment are analyzed by dynamics case. An optimization algorithm based on the genetic algorithm (GA) is proposed to reduce the risk of tipping over. The simulation results show that the optimization algorithm can keep the robot from tipping over when the interaction forces exceed the safety threshold.


---

## Body

## 1. Introduction

As a result of the acceleration of population aging, the World Health Organization reported over 17 million confirmed cases of stroke in 2016 [1]. Most stroke patients suffer from lower-extremity motor dysfunction after surgery, which severely affects the ADL of the patient. However, ∼70–80% of patients can benefit from the timely and effective rehabilitation process and can restore the motor function and balance function. During the gait training, the fall prevention and safe training environment are important. It is necessary to analyze the safety of the robot by the tip-over stability analysis.In recent years, many universities, research institutes, and hospitals have developed mechanical equipment that can help the patients with the gait training. The Lokomat [2] is a highly automated suspension lower-limb rehabilitation robot that connects the lower-extremity exoskeleton system to the suspension weight reduction device through a four-bar mechanism. The robot is stationary and has little possibility of tipping over. The Andago [3] assisted rehabilitation robot developed by HOCOMA in Switzerland reduces the load on the lower limbs during the gait training by suspending weight loss on the pelvis. This suspension weight loss has a great influence on the coordinated movement of the upper and lower limbs. The designers avoid the tip-over by adding counterweight to the moving platform. The KineAssist [4] robot uses a pelvic support device with a moving platform to realize the movement of the patient, but the rotation center of the chassis is not on the same vertical line with the rotation center of the human body, directly affecting the patient's steering comfort. Carleton University developed a mobile limb training robot called GaitEnable [5]. This robot is smaller and lighter than KineAssist. It is a combination of a mobile lower-limb training robot and a walking robot. GaitEnable step trainer is omnidirectional. The device controls the support polygon of the robot, the position of the pelvis, and the posture of the robot. The GaitEnable and KineAssist are equipped with universal wheels to maintain stability via the change of the center of mass.During the gait training, the man-machine interaction forces may exceed the normal values. There is a risk that the robot will tip over because the forces acting on the robot are beyond the safety threshold, causing potential harm to the patients. Based on this concerning, the tip-over stability of the robot should be analyzed to study the threshold of the interaction forces and the effective ways to stabilize the robot.In this paper, the tip-over stability of a pelvic support walking robot, as shown in Figure1, is analyzed: (1) the analysis of the safe range of interaction forces; (2) the analysis of the influence factors of tipping over; (3) the study of the optimization algorithm based on ZMP and GA.Figure 1
The components of the pelvic support walking robot. (a) The coordinate system. (b) The setting of the springs and sensors.


## 2. System Description

The mechanical structure diagram of the robot is shown in Figure2. Combining the revolute pair and the prismatic pair, the robot can realize the six degrees of freedom of motion in space: flexion and extension in the sagittal plane; adduction and abduction in the coronal plane; internal rotation and external rotation on the horizontal plane; and movement of the front, back, left, and right, and up and down. According the range of motion of healthy people [6, 7], the workspace of the robot is designed to be larger than the healthy people’s need. Also, the rotation center of the robot should coincide with the people’s rotation center to make the people more comfortable during the gait training.Figure 2
The schematic diagram of the mechanism.
(a)
(b)The function of the robot is to provide the patients with pelvic support and help them during the gait training. This function is realized through the mobile platform (MP), the body weight support (BWS), and the pelvic-assisted mechanism (PAM). The PAM can support the patient and help them to realize the movement in cross section and the rotation around the sagittal axis, the vertical axis, and the coronal axis. The BWS can lift the pelvic support mechanism and patient to realize the movement in the vertical direction: the pelvis moves periodically along the vertical axis. With the help of the MP, the motion range of the patient can be extended throughout the environment.As shown in Figure2, the MP has two driving wheels installed on the rear to drive the mobile platform, and two universal wheels are installed at the front. With the differential motion of the two driving wheels, the robot can realize turning motion on the ground. And the robot can rotate around the center of two drive wheels’ connection (around the Z-axis).The BWS consists of a ball screw and a slider. The PAM is fixed at the slider, and the slider can move along the ball screw with low friction. The PAM can move along theZ-axis to adapt the motion of the pelvis.The PAM provides support to the pelvis and can realize the motion of the pelvis. And the signals that needed to control the robot or evaluate the patient’s movement are detected in this part.The movement along theX-axis and Y-axis on the horizontal plane is realized by a four-bar mechanism as shown in Figure 2(b). The four-bar mechanism consists of four links. The rotation of J2 will produce the movement of J3 on the horizontal plane. A potentiometer is installed on J2 to detect θ2. The movement of J3 can be calculated: X=l2cosθ2, Y=l2sinθ2. In order to provide elasticity in the direction of X-axis and Y-axis, a spring damping mechanism is installed between the four links. The forces will overcome the movement along the X-axis and Y-axis and make the patient know whether their pelvis center deviates from the normal position. The elasticity also can be adjusted according to different patients’ needs. The rotation of J4 realizes the rotation around the X-axis (the sagittal axis (α)). Springs are placed between J4 and the fixed base of the pelvic support mechanism to provide elasticity around the X-axis. θ4 can be detected by the potentiometer installed on J4. P5 and P6 are prismatic pairs. When P5 moves forward and P6 moves backward, the patient will realize the rotation around the Z-axis (the vertical axis (γ)). The sliders of P5 and P6 are located between springs to provide elasticity along the Z-axis. The pressure sensors detect the force from patient’s rotation acting on the spring. By analyzing the forces, the direction of the rotation along the Z-axis can be studied. Also, the movement of P5 and P6 can be calculated through the force F and spring stiffness k: s=F/k. And θ5 can be calculated as: θ5≈(S5 − S6)/D when θ5 is small enough. Two universal joints are fixed at P5 and P6 to realize the rotation around the Y-axis (coronal axis (β)).


## 3. System Modeling and ZMP Theory

### 3.1. Statics Modeling

As shown in Figure2, the robot coordinate system (O0X0Y0Z0) is fixed at the center of the connection of two driving wheels. The end-effector of the robot is the pelvis of patient, the O6X6Y6Z6 is attached. OiXiYiZi (i = 1, 2, …, 5) is the joint coordinate system. The rotation center of the pelvis has to be consistent with the rotation center of the mechanism: l0=l1+l2+l3+l4; During the gait training, the parameter Z1 will change accordingly to realize the displacement in the Z-axis direction. The parallel four-bar mechanism composed of joints J2 and J3 realizes the X-axis and the displacement in the Y-axis direction: X=l2cosθ2, Y=l2sinθ2 (relative to the coordinate system ∑2). The establishment of the positive solution matrix equation is based on the recursive formula proposed by Xi et al., which is as follows [8]:(1)pi=p0+∑i=1nRipi′,Ri=∏j=1iRsjRmj,where(i)
pi is the position of each joint relative to the world coordinate system;(ii)
pi′ is the position vector;(iii)
Ri is the rotation transformation matrix;(iv)
Rsj is the coordinate transformation of the adjacent coordinate system;(v)
Rmj is the rotation around the current coordinate system, according to the mechanism diagram:(2)RP01=C5C6−S5C5S6T1T2C4C5T3l2S2T4C5S4T5Z00001,whereC
2
=
cos
θ
2, S2=sinθ2, and so on; T1=l0−l1−l3−l2C2−l4;T2=S4S6+C4S5C6;T3=C4S5S6−S4C6;T4=C6S4S5+C4S6;T5=C4C6+S4S5S6.(3)vxvyvzωxωyωz=0−l2S200000l2C200001000000010000000010001D−1D0Z˙1θ˙2θ˙4S˙5S˙6θ˙6,where D=0.32m, as shown in Figure 2, is the width of the mechanism, which hugs the pelvis.The center of mass of the link can be viewed as at the center of figure of the link. The vector of theith link centroid position in the ∑0:(4)pci=pi−1+12pi=Ripci′.The centroid velocity of theith link p˙ci can be got by derivation on both sides of the equation:(5)p˙ci=R˙ipci′+Rip˙ci′=ωi×pci+Rip˙ci′.The centroid acceleration of theith link p¨ci can be got by derivation on both sides of equation (5):(6)p¨ci=ω˙i×pci+ωi×p˙ci+R˙ip˙ci′+Rip¨ci′=ω˙i×pci+ωi×ωi×pci+Ripci′+R˙iRiTRip˙ci′+Rip¨ci′=ω˙i×pci+ωi×ωi×pci+2ωi×Ripci′+Rip¨ci′,where(i)
ωi is the joint angular velocity of ith link;(ii)
pci is the vector of the ith link centroid position in the ∑0; −p˙ci′ is the velocity of ith link;(iii)
Ri is the transformation from ∑0 to ∑i.


### 3.2. Dynamics Modeling

As the movement of the pelvis has great influence on the robot’s tip-over stability, it is necessary to establish a dynamics model to research the motion parameters’ effect on the robot’s risk of tipping over.According to Xi et al., the force and moment acting on theith joint:(7)wi=Mit˙iJ+Bi+Hii+1wi+1,where(i)
wi=fiJmiJ consists of the force and moment of the ith joint;(ii)
Mi=mi1mip˜icTmip˜icIi is the generalized mass matrix of the ith link;(iii)
p˜ic is the skew symmetric matrix of centroid vector of the ith joint;(iv)
Ii is the inertia tensor of each link;(v)
t˙iJ=p¨ci−gαi is the acceleration of the ith link;(vi)
Bi=miωi×ωi×picωi×Iiωi consists of the centrifugal force and gyro moment;(vii)
ωi is the angular velocity of the ith joint;(viii)
pic is the vector pointing from the center of the ith link to the ith joint;(ix)
Hii+1=10p˜i1 is the transformation matrix from i + 1th joint to ith joint;(x)
pi is the vector pointing from joint i to the tip;(xi)
p˜i is the antisymmetric matrix of pi.All the forces and moments acting on the machine converted to jointi can be written as:(8)wi=Mit˙iJ+∑k=i+15∏j=k+1kHj−1,jMkt˙kJ+Bi+∑k=i+15∏j=k+1kHj−1,jBk+∏j=i+15Hj−1,jwp,where wp is the forces and moments between patient and robot.


### 3.3. ZMP Theory

The zero-moment point theory [9] is used to evaluate the tip-over stability by comparing the relative positional relationship between the ZMP and the support polygon. The component of the man-machine interaction forces and moments in the horizontal plane needs to be balanced by the friction and the friction torque:(9)OP⟶×R⟶H+OG⟶×msg+MAH+OA⟶×FAH=0,(10)R+FA+msg=0,where(i)
OP⟶ is the vector from the ∑0 to the acting point of the friction force;(ii)
R⟶ is the friction force from the ground and can be calculated from equation (9);(iii)
G is the center of gravity of the robot.The forceFA and moment MA equals to the forces and moments above the ∑0.(11)Rx=−FAx+msgx,Ry=−FAy+msgy,Rz=−FAz+msgz.The position of the pointP (Px,Py) (zero-moment point) can be calculated as:(12)Px=OG⟶×msg+MAH+OA⟶×FAHyRz,Py=OG⟶×msg+MAH+OA⟶×FAHxRz,Pz=0.The support polygon is made up of a rectangle. Once theP is out of the rectangle, the robot will lose dynamic equilibrium and tip over.


## 3.1. Statics Modeling

As shown in Figure2, the robot coordinate system (O0X0Y0Z0) is fixed at the center of the connection of two driving wheels. The end-effector of the robot is the pelvis of patient, the O6X6Y6Z6 is attached. OiXiYiZi (i = 1, 2, …, 5) is the joint coordinate system. The rotation center of the pelvis has to be consistent with the rotation center of the mechanism: l0=l1+l2+l3+l4; During the gait training, the parameter Z1 will change accordingly to realize the displacement in the Z-axis direction. The parallel four-bar mechanism composed of joints J2 and J3 realizes the X-axis and the displacement in the Y-axis direction: X=l2cosθ2, Y=l2sinθ2 (relative to the coordinate system ∑2). The establishment of the positive solution matrix equation is based on the recursive formula proposed by Xi et al., which is as follows [8]:(1)pi=p0+∑i=1nRipi′,Ri=∏j=1iRsjRmj,where(i)
pi is the position of each joint relative to the world coordinate system;(ii)
pi′ is the position vector;(iii)
Ri is the rotation transformation matrix;(iv)
Rsj is the coordinate transformation of the adjacent coordinate system;(v)
Rmj is the rotation around the current coordinate system, according to the mechanism diagram:(2)RP01=C5C6−S5C5S6T1T2C4C5T3l2S2T4C5S4T5Z00001,whereC
2
=
cos
θ
2, S2=sinθ2, and so on; T1=l0−l1−l3−l2C2−l4;T2=S4S6+C4S5C6;T3=C4S5S6−S4C6;T4=C6S4S5+C4S6;T5=C4C6+S4S5S6.(3)vxvyvzωxωyωz=0−l2S200000l2C200001000000010000000010001D−1D0Z˙1θ˙2θ˙4S˙5S˙6θ˙6,where D=0.32m, as shown in Figure 2, is the width of the mechanism, which hugs the pelvis.The center of mass of the link can be viewed as at the center of figure of the link. The vector of theith link centroid position in the ∑0:(4)pci=pi−1+12pi=Ripci′.The centroid velocity of theith link p˙ci can be got by derivation on both sides of the equation:(5)p˙ci=R˙ipci′+Rip˙ci′=ωi×pci+Rip˙ci′.The centroid acceleration of theith link p¨ci can be got by derivation on both sides of equation (5):(6)p¨ci=ω˙i×pci+ωi×p˙ci+R˙ip˙ci′+Rip¨ci′=ω˙i×pci+ωi×ωi×pci+Ripci′+R˙iRiTRip˙ci′+Rip¨ci′=ω˙i×pci+ωi×ωi×pci+2ωi×Ripci′+Rip¨ci′,where(i)
ωi is the joint angular velocity of ith link;(ii)
pci is the vector of the ith link centroid position in the ∑0; −p˙ci′ is the velocity of ith link;(iii)
Ri is the transformation from ∑0 to ∑i.


## 3.2. Dynamics Modeling

As the movement of the pelvis has great influence on the robot’s tip-over stability, it is necessary to establish a dynamics model to research the motion parameters’ effect on the robot’s risk of tipping over.According to Xi et al., the force and moment acting on theith joint:(7)wi=Mit˙iJ+Bi+Hii+1wi+1,where(i)
wi=fiJmiJ consists of the force and moment of the ith joint;(ii)
Mi=mi1mip˜icTmip˜icIi is the generalized mass matrix of the ith link;(iii)
p˜ic is the skew symmetric matrix of centroid vector of the ith joint;(iv)
Ii is the inertia tensor of each link;(v)
t˙iJ=p¨ci−gαi is the acceleration of the ith link;(vi)
Bi=miωi×ωi×picωi×Iiωi consists of the centrifugal force and gyro moment;(vii)
ωi is the angular velocity of the ith joint;(viii)
pic is the vector pointing from the center of the ith link to the ith joint;(ix)
Hii+1=10p˜i1 is the transformation matrix from i + 1th joint to ith joint;(x)
pi is the vector pointing from joint i to the tip;(xi)
p˜i is the antisymmetric matrix of pi.All the forces and moments acting on the machine converted to jointi can be written as:(8)wi=Mit˙iJ+∑k=i+15∏j=k+1kHj−1,jMkt˙kJ+Bi+∑k=i+15∏j=k+1kHj−1,jBk+∏j=i+15Hj−1,jwp,where wp is the forces and moments between patient and robot.


## 3.3. ZMP Theory

The zero-moment point theory [9] is used to evaluate the tip-over stability by comparing the relative positional relationship between the ZMP and the support polygon. The component of the man-machine interaction forces and moments in the horizontal plane needs to be balanced by the friction and the friction torque:(9)OP⟶×R⟶H+OG⟶×msg+MAH+OA⟶×FAH=0,(10)R+FA+msg=0,where(i)
OP⟶ is the vector from the ∑0 to the acting point of the friction force;(ii)
R⟶ is the friction force from the ground and can be calculated from equation (9);(iii)
G is the center of gravity of the robot.The forceFA and moment MA equals to the forces and moments above the ∑0.(11)Rx=−FAx+msgx,Ry=−FAy+msgy,Rz=−FAz+msgz.The position of the pointP (Px,Py) (zero-moment point) can be calculated as:(12)Px=OG⟶×msg+MAH+OA⟶×FAHyRz,Py=OG⟶×msg+MAH+OA⟶×FAHxRz,Pz=0.The support polygon is made up of a rectangle. Once theP is out of the rectangle, the robot will lose dynamic equilibrium and tip over.


## 4. System Simulation and Optimization

The simulations are carried out to analyze the possibility of tipping over of the robot. The input is man-machine interaction forces. These forces can be measured and calculated:F
x is the force generated by the movement of the patient along the X-axis. Fx can be measured by the pressure sensors as shown in Figure 2(b).F
y is the force generated by the movement of the patient along the Y-axis. Fy can be calculated as follows:(13)Fy=ΔyK23,whereΔy is the movement along the Y-axis, K23 is the spring damping stiffness between joint2 and joint3. K23 can be calculated through experiment. In this robot, K23=3.9N/mm.F
z is the force generated by the movement of the patient along the Z-axis. Fz can be measured and calculated by the torque sensors as shown in Figure 2(b).(14)Fz=Td,where T is the torque measured by the torque sensors. d is the distance between the torque sensors and the center of the pelvis.The support polygon is a rectangle:L∗W1.03∗0.7m. The coinciding of the round reaction force acting point (P) with the center of the rectangle can be seen as the safest condition of the robot. Evaluation function Q can describe the relation between the two points. If P coincides with the center of the support polygon, the function Q is 1. When Q is closer to 1, the robot is safer and less likely to tip over. When Q is closer to 0, the robot is more likely to tip over. If P exceeds the support polygon boundary, the function Q will be negative.(15)Q=minPx,Px+L/2L+minPy−W/2,Py+W/2W,when the ZMPPx,Pyis inside the support polygon,−1,when the ZMPPx,Pyis outside the support polygon.


### 4.1. Static Simulation

An experiment is designed to study the range ofFx, Fy, and Fz, when the subject falls over and leans on the machine. As shown in Figure 3, there are four cases when the subject leans on the robot and the 8 subjects involved with different height and weight. The result is shown in Table 1. The static calculation model can be got by making ωi=0,p¨ci=0, and αi=0 in the dynamic model. And so on, Bi=0 and t˙iJ=−g0. The force and moment acting on the ith joint in the static model can be written as:(16)wi=Mit˙iJ+∑k=i+15∏j=k+1kHj−1,jMkt˙kJ+∏j=i+15Hj−1,jwp.Figure 3
The four cases that the subject leans on the robot. (a) The subject leans on the machine to the left; (b) the subject leans on the machine to the right; (c) the subject leans on the machine to the forward; (d) the subject leans on the machine to the backward.
(a)
(b)
(c)
(d)Table 1
The force along theX-axis and Y-axis when the patient falls over.
Subject
Height (cm)
Weight (kg)
+Fx (N)
−Fx (N)
+Fy (N)
−Fy (N)
S1
178
73
130
140
130
130
S2
170
78
160
165
155
130
S3
178
65
130
130
120
125
S4
173
55
90
90
85
75
S5
173
60
140
130
110
90
S6
173
62
100
110
100
110
S7
173
68
120
120
120
120
S8
169
63
130
140
100
110
Average
173
66
125
128
115
111In the statics model, the parameterZ0 is the height of the pelvis, and the range of Z1 is from 0.55 m to 1.1 m. The simulations with different Z1 are carried out. The results in Figure 4 show that the higher the Z1 is, the more risk the robot with the same interaction force.Figure 4
The relationship between the tip-over stability of the robot and the height of the pelvis:Z1. Each point represents an interaction force: Fxyz. The points with light color mean the robot will not tip over, and the points with blue color mean the robot will tip over. (a) The number of the safe points is 1898 with the Z1 = 0.55 m. (b) The number of the safe points is 1225 with the Z1 = 1.1 m.
(a)
(b)In order to analyze the safe range of the input forces, makeFx: −450 N∼300 N, Fy: −200 N∼300 N, Fz: −350 N∼350 N. Within the range of forces set, calculate Q with each force synthesized by Fx, Fy, and Fz, and Z1=1.1m. The calculation result is shown in Figure 5, and the force safety range: FXYZ=FX,FY,FZT is as follows:(17)FXYZ=FZ≤3.1FY+320,FZ≤1.2FX+180s.t.0≤FY≤200,0≤FX≤140,FZ≤−3.1FY+320,FZ≤1.2FX+180s.t.−200≤FY<0,−400≤FX≤0.Figure 5
The safe range ofFXYZ with Z1=1.1m.The points with light color means that with the effect of the forces the point represents, the ZMP:P is within the support polygon. If the color is blue, the robot will tip over and the patient is in danger.The analysis of the tip-over stability in the static condition provides reference for the analysis with dynamics model. The impact factors such asωi, αi, p¨ci, and so on will be considered, and a control system based on genetic algorithm (GA) [10, 11] is used to optimize the tip-over stability of the robot.


### 4.2. Dynamic Simulation

The simulation with dynamic model considers the effect from theωi(joint angular velocity) on the analysis of robot. The consideration of ωi makes Ii (the inertia tensor of ith link) become an important influencing factor:(18)Bi=miωi×ωi×picωi×Iiωi,(19)Mit˙iJ=mi1mip˜icTmip˜icIip¨ci−gαi.As can be seen from equations (18) and (19), the larger the ωi and Ii are, the larger the ωi is. According to the quality of each link and the motion pattern of each joint, ω2 and ω4 may have great influence on the tip-over stability of the robot. The results of the simulation about ω2 and ω4 are shown in Figures 6 and 7. Although the variation range of ω2 and ω4 is four times than the normal value, the results show that ω2 and ω4 have little influence on the forces and moments of last joint.Figure 6
The influence ofω2 on the forces:FAx,FAyandFAz and the moments: MAx,MAyandMAz.Figure 7
The influence ofω4 on the forces:FAx,FAyandFAz and the moments: MAx,MAyandMAz.


### 4.3. Optimization

According to the analysis above, the height of the pelvis:Z1 has great influence on the tip-over stability of the robot. And other parameters such as ω2 and ω4 have little influence on the robot. Based on this, in the progress of the optimization, Z1 and the movement along X-axis: ΔX will be adjusted to look for the best combination of Z1 and ΔX to make Q nearest to 1.The range of interaction force:Fnxyz=Fnx,Fny,Fnz when healthy people walks with the robot normally can be obtained from the study by Ji et al. [12].According to the analysis in the static simulation, the safe range of the interaction force:FX FY and FZ is studied. Also, when the patient loses support and falls over, the interaction force: Fxyz=Fx,Fy,Fz is beyond the safe range. In order to make sure the robot is safer during using, safety factor H is proposed to calculate the safety threshold of the interaction force:(20)FXYZ>Fsxyz=FXYZH>Fnxyz.An optimization algorithm based on genetic algorithm (GA) is proposed to prevent the robot from tipping over and make the evaluation functionQ nearest to 1. The control flow chart is shown in Figure 8. When the interaction force is beyond Fsxyz, GA will calculate the optimal ΔZ1 and ΔX. GA calculates the Q with different combinations of Z1 and ΔX, and chooses ZQ1 and ΔXQ as the best combination when Q is the maximum. And the signals will be sent to the motors to adjust the height of the pelvic and the position of the support polygon.(21)Maximize︸ZQ1,ΔXQ,QGAZ1,ΔX,Qs.t.0.55≤Z1≤1.1,−0.3≤ΔX≤0.3.Figure 8
The control flow of the optimization algorithm.


### 4.4. Simulation

In order to ensure the safety of the subject, a simulation is carried to instead of an experiment. The results are shown in Figures9 and 10. In Figure 9, without the optimization algorithm, the distribution of the zero-moment points: P is throughout the support polygon. And in Figure 10, with the optimization, all the points are distributed around the center of the center of the support polygon.Figure 9
The distribution ofP(ZMP) without the optimization algorithm.Figure 10
The distribution ofP(ZMP) with the optimization algorithm.


### 4.5. Data Analysis and Discussion

The tip-over stability of the pelvic support walking robot is analyzed based on the statics model, the dynamics model, and the ZMP theory. Figure3 shows the results of two simulations carried out with Fx: −800 N∼300 N, Fy: −300 N∼300 N, Fz: −350 N∼350 N. In Figure 4(a), with Z1=0.55m, the most points’ Q is positive with light color. The number of safe points is 1898. In Figure 4(b), with Z1=1.1m, half of the points’ Q is negative. The number of safe points is 1225. The results show that the height of the pelvis:Z1 has great influence on the tip-over stability of the robot. The safe range of the interaction forces is studied in Figure 5 with Z1=1.1m. The safe range of Fy is symmetric around the Y-axis from −200 N to 200 N for that the robot is symmetry about the xoz plane. The safe range of Fx is from −400 N∼140 N for that the center of mass position is at the front of the robot. The safe range of Fz is a function of Fx and Fy as shown in (17). The influence of ω2 and ω4 is analyzed, and the results are shown in Figures 6 and 7. It shows that the influence of ω2 and ω4 is not so obvious, for that the max variation of FA and MA is 15 N and 20 N·m, respectively. The optimization based on the GA and the influence factors: Z1 and ΔX is proven to be effective in Figures 9 and 10. In Figure 9, without the optimization algorithm, the P(ZMP) is distributed throughout the support polygon. Some points’ Q is close to 0.3, and the position is close to the boundary of the support polygon. With the interaction forces, these dangerous points represent the robot is likely to tip over. In Figure 10, the Q of these points is from 0.76 to 1, and the distribution of these points is limited to a rectangle: X: −0.58∼−0.48; Y: −0.16∼0.16. It means that with the optimization algorithm, the points whose interaction forces are beyond the safe range: Fsxyz are focused around the center of the support polygon with the adjustments of Z1 and ΔX.


## 4.1. Static Simulation

An experiment is designed to study the range ofFx, Fy, and Fz, when the subject falls over and leans on the machine. As shown in Figure 3, there are four cases when the subject leans on the robot and the 8 subjects involved with different height and weight. The result is shown in Table 1. The static calculation model can be got by making ωi=0,p¨ci=0, and αi=0 in the dynamic model. And so on, Bi=0 and t˙iJ=−g0. The force and moment acting on the ith joint in the static model can be written as:(16)wi=Mit˙iJ+∑k=i+15∏j=k+1kHj−1,jMkt˙kJ+∏j=i+15Hj−1,jwp.Figure 3
The four cases that the subject leans on the robot. (a) The subject leans on the machine to the left; (b) the subject leans on the machine to the right; (c) the subject leans on the machine to the forward; (d) the subject leans on the machine to the backward.
(a)
(b)
(c)
(d)Table 1
The force along theX-axis and Y-axis when the patient falls over.
Subject
Height (cm)
Weight (kg)
+Fx (N)
−Fx (N)
+Fy (N)
−Fy (N)
S1
178
73
130
140
130
130
S2
170
78
160
165
155
130
S3
178
65
130
130
120
125
S4
173
55
90
90
85
75
S5
173
60
140
130
110
90
S6
173
62
100
110
100
110
S7
173
68
120
120
120
120
S8
169
63
130
140
100
110
Average
173
66
125
128
115
111In the statics model, the parameterZ0 is the height of the pelvis, and the range of Z1 is from 0.55 m to 1.1 m. The simulations with different Z1 are carried out. The results in Figure 4 show that the higher the Z1 is, the more risk the robot with the same interaction force.Figure 4
The relationship between the tip-over stability of the robot and the height of the pelvis:Z1. Each point represents an interaction force: Fxyz. The points with light color mean the robot will not tip over, and the points with blue color mean the robot will tip over. (a) The number of the safe points is 1898 with the Z1 = 0.55 m. (b) The number of the safe points is 1225 with the Z1 = 1.1 m.
(a)
(b)In order to analyze the safe range of the input forces, makeFx: −450 N∼300 N, Fy: −200 N∼300 N, Fz: −350 N∼350 N. Within the range of forces set, calculate Q with each force synthesized by Fx, Fy, and Fz, and Z1=1.1m. The calculation result is shown in Figure 5, and the force safety range: FXYZ=FX,FY,FZT is as follows:(17)FXYZ=FZ≤3.1FY+320,FZ≤1.2FX+180s.t.0≤FY≤200,0≤FX≤140,FZ≤−3.1FY+320,FZ≤1.2FX+180s.t.−200≤FY<0,−400≤FX≤0.Figure 5
The safe range ofFXYZ with Z1=1.1m.The points with light color means that with the effect of the forces the point represents, the ZMP:P is within the support polygon. If the color is blue, the robot will tip over and the patient is in danger.The analysis of the tip-over stability in the static condition provides reference for the analysis with dynamics model. The impact factors such asωi, αi, p¨ci, and so on will be considered, and a control system based on genetic algorithm (GA) [10, 11] is used to optimize the tip-over stability of the robot.


## 4.2. Dynamic Simulation

The simulation with dynamic model considers the effect from theωi(joint angular velocity) on the analysis of robot. The consideration of ωi makes Ii (the inertia tensor of ith link) become an important influencing factor:(18)Bi=miωi×ωi×picωi×Iiωi,(19)Mit˙iJ=mi1mip˜icTmip˜icIip¨ci−gαi.As can be seen from equations (18) and (19), the larger the ωi and Ii are, the larger the ωi is. According to the quality of each link and the motion pattern of each joint, ω2 and ω4 may have great influence on the tip-over stability of the robot. The results of the simulation about ω2 and ω4 are shown in Figures 6 and 7. Although the variation range of ω2 and ω4 is four times than the normal value, the results show that ω2 and ω4 have little influence on the forces and moments of last joint.Figure 6
The influence ofω2 on the forces:FAx,FAyandFAz and the moments: MAx,MAyandMAz.Figure 7
The influence ofω4 on the forces:FAx,FAyandFAz and the moments: MAx,MAyandMAz.


## 4.3. Optimization

According to the analysis above, the height of the pelvis:Z1 has great influence on the tip-over stability of the robot. And other parameters such as ω2 and ω4 have little influence on the robot. Based on this, in the progress of the optimization, Z1 and the movement along X-axis: ΔX will be adjusted to look for the best combination of Z1 and ΔX to make Q nearest to 1.The range of interaction force:Fnxyz=Fnx,Fny,Fnz when healthy people walks with the robot normally can be obtained from the study by Ji et al. [12].According to the analysis in the static simulation, the safe range of the interaction force:FX FY and FZ is studied. Also, when the patient loses support and falls over, the interaction force: Fxyz=Fx,Fy,Fz is beyond the safe range. In order to make sure the robot is safer during using, safety factor H is proposed to calculate the safety threshold of the interaction force:(20)FXYZ>Fsxyz=FXYZH>Fnxyz.An optimization algorithm based on genetic algorithm (GA) is proposed to prevent the robot from tipping over and make the evaluation functionQ nearest to 1. The control flow chart is shown in Figure 8. When the interaction force is beyond Fsxyz, GA will calculate the optimal ΔZ1 and ΔX. GA calculates the Q with different combinations of Z1 and ΔX, and chooses ZQ1 and ΔXQ as the best combination when Q is the maximum. And the signals will be sent to the motors to adjust the height of the pelvic and the position of the support polygon.(21)Maximize︸ZQ1,ΔXQ,QGAZ1,ΔX,Qs.t.0.55≤Z1≤1.1,−0.3≤ΔX≤0.3.Figure 8
The control flow of the optimization algorithm.


## 4.4. Simulation

In order to ensure the safety of the subject, a simulation is carried to instead of an experiment. The results are shown in Figures9 and 10. In Figure 9, without the optimization algorithm, the distribution of the zero-moment points: P is throughout the support polygon. And in Figure 10, with the optimization, all the points are distributed around the center of the center of the support polygon.Figure 9
The distribution ofP(ZMP) without the optimization algorithm.Figure 10
The distribution ofP(ZMP) with the optimization algorithm.


## 4.5. Data Analysis and Discussion

The tip-over stability of the pelvic support walking robot is analyzed based on the statics model, the dynamics model, and the ZMP theory. Figure3 shows the results of two simulations carried out with Fx: −800 N∼300 N, Fy: −300 N∼300 N, Fz: −350 N∼350 N. In Figure 4(a), with Z1=0.55m, the most points’ Q is positive with light color. The number of safe points is 1898. In Figure 4(b), with Z1=1.1m, half of the points’ Q is negative. The number of safe points is 1225. The results show that the height of the pelvis:Z1 has great influence on the tip-over stability of the robot. The safe range of the interaction forces is studied in Figure 5 with Z1=1.1m. The safe range of Fy is symmetric around the Y-axis from −200 N to 200 N for that the robot is symmetry about the xoz plane. The safe range of Fx is from −400 N∼140 N for that the center of mass position is at the front of the robot. The safe range of Fz is a function of Fx and Fy as shown in (17). The influence of ω2 and ω4 is analyzed, and the results are shown in Figures 6 and 7. It shows that the influence of ω2 and ω4 is not so obvious, for that the max variation of FA and MA is 15 N and 20 N·m, respectively. The optimization based on the GA and the influence factors: Z1 and ΔX is proven to be effective in Figures 9 and 10. In Figure 9, without the optimization algorithm, the P(ZMP) is distributed throughout the support polygon. Some points’ Q is close to 0.3, and the position is close to the boundary of the support polygon. With the interaction forces, these dangerous points represent the robot is likely to tip over. In Figure 10, the Q of these points is from 0.76 to 1, and the distribution of these points is limited to a rectangle: X: −0.58∼−0.48; Y: −0.16∼0.16. It means that with the optimization algorithm, the points whose interaction forces are beyond the safe range: Fsxyz are focused around the center of the support polygon with the adjustments of Z1 and ΔX.


## 5. Conclusions

The tip-over stability analysis of a pelvic support walking robot was introduced in this paper, and an optimization algorithm was proposed to optimize the tip-over stability of the robot. The influence of the height of the pelvis and the safe range of the interaction forces were studied through the simulation with statics model. With the dynamics model, it was proven that the joint angular velocity such asω2 and ω4 have little influence on the forces and moments of the last joint. An optimization algorithm based on the dynamics model and the GA was proposed to optimize the tip-over stability when the interaction forces are beyond the safe range. Simulations were carried to verify the effectiveness of the optimization system. The follow-up work will be concentrated on the improvement of the optimization algorithm to reduce the running time of the algorithm. Also, the counterweight of the robot can be optimized to improve the tip-over stability.



---

*Source: 1506250-2020-02-07.xml*