# Active Tension Control for WT Wheelchair Robot by Using a Novel Control Law for Holonomic or Nonholonomic Systems

Authors: Jian Wang; Ting Wang; Chen Yao; Xiaofan Li; Chengdong Wu
Journal: Mathematical Problems in Engineering
 (2013)

---

## Abstract

Interactional characteristics between WT wheelchair robot and stair environment are analyzed, and possible patterns of WT wheelchair robot during the stair-climbing process are summarized, with the criteria of the wheelchair robot for determining the pattern proposed. Aiming at WT wheelchair robot's complicated mechanism with holonomic constraints and combined with the computed torque method, a novel control law that is called active tension control is presented for holonomic or nonholonomic robotic systems, by which  the wheelchair robot with a holonomic or nonholonomic mechanism can track the reference input of the constraint forces of holonomic or nonholonomic constraints as well as tracking the reference input of the generalized coordinate of each joint. A stateflow module of Matlab is used to simulate the entire stair-climbing process for WT wheelchair robot. A comparison of output curve  with the reference input curve of each joint is made, with the effectiveness of the presented control law verified.


---

## Body

## 1. Introduction

Wheelchair robot, as a very important service mobile robot for some aged and physically disabled persons, is attracted by more and more domestic and foreign research institutions in the recent decades. The focus of the study, however, is mainly on the adoption and development of traditional obstacle-navigation mechanisms to realize the stair-climbing performance. Such mature obstacle-navigation mechanisms applied to the wheelchair robot as wheel mechanism [1], leg type mechanism [2, 3], crawler mechanism [4], and their composite mechanism [5] have their own advantages and disadvantages, respectively. This paper employs the WT wheelchair robot developed by Ting Wang in the Chinese Academy of Sciences, Shenyang Institute of Automation, as the experimental platform, which uses a deformable wheel-tracked obstacle-navigation mechanism and also introduces complicated holonomic constraints.Control problems for holonomic and nonholonomic robot systems have been initiated since the 1990s of last century. Then, there is a large amount of published literature that proposed various control laws to solve such problems [6], most of which are combined with dynamic models expressed in the d’Alembert-Lagrange form [7].From the existing literature, control problems for holonomic and nonholonomic robot systems are developed parallel with different approaches, respectively, with no unified theoretical framework proposed to design a controller applicable to both of them.For holonomic robot systems, McClamroch and Wang [8], who make a pioneering work, present a feedback control law that can follow the reference input generalized coordinates and the reference input constrained forces of holonomic constraints at the same time for the motion/force controller design of holonomic constrained robot systems. But unfortunately they do not figure out the exact relationship between generalized coordinates and constrained forces in the derivation process, with a force-tracking residual error appearing in the proposed control law. Then follow the adaptive control [9] that has assured force tracking errors to be zero, the robust control [10] that deals with unstructured uncertainties, and the intelligent control [11–13] that deals with nonlinearity. However, there is always a problem common to them which is that they are unable to remove the force-tracking residual error in their control laws in principle.On control problems for nonholonomic robot systems, Bloch [14] makes an earlier work. And many other control methods for such problems such as adaptive control [15], robust control [16], and intelligent control [17–19] are proposed subsequently. However, there is also a defect common to them that in their selected dynamic model Dq¨+Cq˙+G=Bτ+ATλ (where D∈ℝn×n is the inertia matrix, C∈ℝn×n is the centripetal and Coriolis matrix, G∈ℝn is the gravitation force vector, B∈ℝn×r is the input transformation matrix, τ∈ℝr is the input vector, A∈ℝm×n is the vector associated with the constraints with r≥n-m, and λ∈ℝm is a Lagrange multiplier presenting the constrained force), the introduction of the so-called input transformation matrix B makes the dynamics well as equivalent to Dq¨+C+G=[0τ]+ATλ so that the controller [0τ] is able to control only r variables, as giving up the control of the remaining n-r variables, such as some of the constrained forces of the nonholonomic constraints.In this paper, first, the interactional characteristics between the mobile wheel-tracked mechanism and stairs are analyzed and summarized, with possible patterns and criteria of WT wheelchair robot during the stair-climbing process proposed. Finally aiming at the need for controlling tension forces of the tracks, namely, the constraint forces of the holonomic constraints, for WT wheelchair robot, a control law applied to holonomic system or nonholonomic system is derived from the general form of the Hamilton principle [20] and the deduction of Lagrange’s equations with the Lagrange multipliers. And if some proper treatments are handled, such theoretical framework can be applied to the control problem for nonholonomic robot systems also.


## 2. Robot Description

### 2.1. Experiment Platform of WT Wheelchair Robot

WT wheelchair robot, as shown in Figures1(a) and 1(b), is mainly composed of a body, two front flippers, two driving wheels, a back flipper, and two tracks installed symmetrically. The body AB contains a supporting frame and a seat connected together, with the guide wheels A, the carrier wheels B, and the belt pressing wheels F and G symmetrically arranged at both sides of the supporting frame. The back flipper BE can be controlled by a motor which can rotate around the axis B of the supporting frame. The driving wheels E and E′, which equip walking motors to control walking, are arranged symmetrically at the tip of the back flipper. The left front flipper CD and the right front flipper C′D′ are controlled by motors, respectively, which can rotate around the axis CC′ of the supporting frame to adjust the track tension, respectively, and there are the belt pressing wheels D and D′ arranged at the tip of each front flipper, respectively. There are the same two tracks arranged at both sides of WT wheelchair robot. So WT wheelchair robot has 5 driving motors, with a potentiometric sensor installed in the axis B for detecting the swing angle of the back flipper BE and a two-dimensional tilt sensor for detecting changes of the pitch angle and the roll angle.WT wheelchair robot.
(a)
Experimental platform of WT wheelchair robot
(b)
Generalized coordinates of WT wheelchair robot
(c)
Stair-climbing process of WT wheelchair robot


### 2.2. Stair-Climbing Process

Stair-climbing process can be defined as the one that WT wheelchair robot transfers from the horizontal ground to the slope of stairs. Experimental results show that the process is so short that the influence of turning direction over the motion is negligible and that the process can be simplified on the vertical plane.As is shown in Figure1(c), the stair-climbing process of WT wheelchair robot can be described as follows. First, rotate the back flipper counterclockwise so that the tension forces of the tracks are increased, and then rotate the front flippers clockwise or counterclockwise so that the track tensions remain constant. Finally, the plane angle of the seat corresponding to the horizontal plane can be controlled by swinging the back flipper to different angles and driving the wheelchair robot backwards.Shown in Figure1(b) is the relative coordinate frame,  whose origin is located at the axis of the wheel A with its u axis parallel to the plane of the wheelchair seat and its v axis perpendicular to the plane of the wheelchair seat. q1 can be defined as the angle rotated counterclockwise from BA to BE. q2 and q3 can be defined as the angles of the left and right front flippers rotated clockwise from CA to CD and to C′D′, respectively. q4 and q5 can be defined as the angles of the left and right driving wheels rotated clockwise around the back flipper BE, respectively. The variables defined above can be regarded as the generalized coordinates of WT wheelchair robot. q6 and q7 can also be defined as the angles measured by the two-dimensional tilt sensor installed on WT wheelchair robot. The rest are structural parameters that can be measured, see Table 1.Table 1
Parameters of WT Wheelchair Robot.
Structure (m)
Mass (kg)
Inertia (kg·m2)
l
B
E
0.37
r
E
0.2
m
E
15
J
E
0.3
l
A
B
0.94
r
A
,
r
B
,
r
D
0.07
m
B
E
2.5
J
B
E
0.03
l
C
D
0.53
r
F
,
r
G
0.04
m
A
B
55
J
A
B
6
l
A
F
0.31
L
3.65
m
C
D
3
J
C
D
0.04
l
A
C
0.69Perimeters of both tracks are equal to each other and remain unchanged, namely,L=L′, so that the two holonomic constraint equations of the robot can be obtained as follows:
(1)f(q1,q2)=rA∠A+LAD+rD∠D+LDF+rF∠F+LFB+rB∠B+LBE+rE∠E+LAE-L=0,(2)f(q1,q3)=rA∠A+LAD′+rD′∠D′+LD′F+rF∠F+LFB+rB∠B+LBE′+rE′∠E′+LAE′-L′=0,
where rI is radius of the wheel I, ∠I is the central angle corresponding to the track around the wheel I, and LIJ is the tangent length between the wheels I and J which can be expressed as the function of q1 and q2 or that of q1 and q3.


## 2.1. Experiment Platform of WT Wheelchair Robot

WT wheelchair robot, as shown in Figures1(a) and 1(b), is mainly composed of a body, two front flippers, two driving wheels, a back flipper, and two tracks installed symmetrically. The body AB contains a supporting frame and a seat connected together, with the guide wheels A, the carrier wheels B, and the belt pressing wheels F and G symmetrically arranged at both sides of the supporting frame. The back flipper BE can be controlled by a motor which can rotate around the axis B of the supporting frame. The driving wheels E and E′, which equip walking motors to control walking, are arranged symmetrically at the tip of the back flipper. The left front flipper CD and the right front flipper C′D′ are controlled by motors, respectively, which can rotate around the axis CC′ of the supporting frame to adjust the track tension, respectively, and there are the belt pressing wheels D and D′ arranged at the tip of each front flipper, respectively. There are the same two tracks arranged at both sides of WT wheelchair robot. So WT wheelchair robot has 5 driving motors, with a potentiometric sensor installed in the axis B for detecting the swing angle of the back flipper BE and a two-dimensional tilt sensor for detecting changes of the pitch angle and the roll angle.WT wheelchair robot.
(a)
Experimental platform of WT wheelchair robot
(b)
Generalized coordinates of WT wheelchair robot
(c)
Stair-climbing process of WT wheelchair robot


## 2.2. Stair-Climbing Process

Stair-climbing process can be defined as the one that WT wheelchair robot transfers from the horizontal ground to the slope of stairs. Experimental results show that the process is so short that the influence of turning direction over the motion is negligible and that the process can be simplified on the vertical plane.As is shown in Figure1(c), the stair-climbing process of WT wheelchair robot can be described as follows. First, rotate the back flipper counterclockwise so that the tension forces of the tracks are increased, and then rotate the front flippers clockwise or counterclockwise so that the track tensions remain constant. Finally, the plane angle of the seat corresponding to the horizontal plane can be controlled by swinging the back flipper to different angles and driving the wheelchair robot backwards.Shown in Figure1(b) is the relative coordinate frame,  whose origin is located at the axis of the wheel A with its u axis parallel to the plane of the wheelchair seat and its v axis perpendicular to the plane of the wheelchair seat. q1 can be defined as the angle rotated counterclockwise from BA to BE. q2 and q3 can be defined as the angles of the left and right front flippers rotated clockwise from CA to CD and to C′D′, respectively. q4 and q5 can be defined as the angles of the left and right driving wheels rotated clockwise around the back flipper BE, respectively. The variables defined above can be regarded as the generalized coordinates of WT wheelchair robot. q6 and q7 can also be defined as the angles measured by the two-dimensional tilt sensor installed on WT wheelchair robot. The rest are structural parameters that can be measured, see Table 1.Table 1
Parameters of WT Wheelchair Robot.
Structure (m)
Mass (kg)
Inertia (kg·m2)
l
B
E
0.37
r
E
0.2
m
E
15
J
E
0.3
l
A
B
0.94
r
A
,
r
B
,
r
D
0.07
m
B
E
2.5
J
B
E
0.03
l
C
D
0.53
r
F
,
r
G
0.04
m
A
B
55
J
A
B
6
l
A
F
0.31
L
3.65
m
C
D
3
J
C
D
0.04
l
A
C
0.69Perimeters of both tracks are equal to each other and remain unchanged, namely,L=L′, so that the two holonomic constraint equations of the robot can be obtained as follows:
(1)f(q1,q2)=rA∠A+LAD+rD∠D+LDF+rF∠F+LFB+rB∠B+LBE+rE∠E+LAE-L=0,(2)f(q1,q3)=rA∠A+LAD′+rD′∠D′+LD′F+rF∠F+LFB+rB∠B+LBE′+rE′∠E′+LAE′-L′=0,
where rI is radius of the wheel I, ∠I is the central angle corresponding to the track around the wheel I, and LIJ is the tangent length between the wheels I and J which can be expressed as the function of q1 and q2 or that of q1 and q3.


## 3. Analysis and Determination of Patterns of WT Wheelchair Robot during Stair-Climbing Process

By pattern in this paper meant the different situations in which the wheelchair robot has different interactions with stairs during the stair-climbing process and has different dynamics.


### 3.1. Location of the Wheelchair Robot on Stairs

The height of a single stair ish=0.15(m), and the width is b=0.32(m), with slope angle of stairs defined as Λ=arctan(h/b). For connecting all stair vertices, one can get a stair slope line, as shown in Figure 2. One can draw straight lines, which are called labeled lines, through stair vertices perpendicular to stair slope, on the basis of which he or she can number stairs from bottom to top in turns. When the center of the driving wheel is located between the two certain straight lines, one can denote the robot by using the smaller number of the two. An entire stair-climbing process can be decomposed into a number of segments, from the center of the wheel E running after a labeled line to that running after the next one. Also one can define l=|EH| as a parameter to calculate the line number labeled for the robot, where |EH| is the length of the line EH with H being the point crossed by the line EH which is parallel to the stair slope and the line AH which is parallel to the horizontal ground.Figure 2
Sketch map of demarcation of stairs.Criterion expressed byl for labeling the robot or stair can be described as:
(3)ih2+b2+rEbh-rAh2+b2h≤l<(i+1)h2+b2+rEbh-rAh2+b2h.
Thus, the line number labeled for the robot or stair can be deducted as follows:
(4)i=floor(hl+rAh2+b2-rEbhh2+b2),
where floor(•) is a rounding function.


### 3.2. Pattern Classification

The situation that horizontal surface of stairs is tangential to the bottom surface of the driving wheel, as shown in Figure3, can be used as a primary classification of the patterns of the robot. When the driving wheels move on the horizontal plane, as shown in Figure 3, the parameter L remains unchanged, and the relationship can be obtained as follows:
(5)ih2+b2+(rE-rA)h2+b2h=l.Figure 3
Primary classification of patterns.


#### 3.2.1. Classification between Pattern I and Pattern II

Whenih2+b2+(rE-rA)h2+b2/h>l, there are two patterns, as shown in Figure 4.Figure 4
Classification between Pattern I and Pattern II.Pattern I. The stair vertex with the smaller labeled line number i, as shown in the left subfigure of Figure 4, applies a force to the track and then to the driving wheels. The criterion for determining Pattern I can be described as follows:
(6)ih2+b2+(rE-rA)h2+b2h>l,γ≤γcr,
where γ is the angle formed by the line crossing through from stair vertex to the center of the driving wheel and the line perpendicular to stair slope and γcr is the angle formed by the line crossing through from the tangent point between track and driving wheels to the center of the driving wheel and the line perpendicular to stair slope.Pattern II. The stair vertex with the smaller labeled line number i, shown as the right subfigure of Figure 4, applies a force to the track and not to the driving wheels directly. The criterion for determining Pattern II can be described as follows:
(7)ih2+b2+(rE-rA)h2+b2h>l,γ>γcr.


#### 3.2.2. Classification between Pattern III and Pattern IV

Whenih2+b2+(rE-rA)h2+b2/h≥l, there are also two patterns, as shown in Figure 5.Figure 5
Classification between Pattern III and Pattern IV.Pattern III. The stair vertex with the larger labeled line number i+1, shown as the left subfigure of Figure 5, remains in no contact with tracks, thus applying no force to the driving wheels directly. While the stair vertex with the smaller labeled line number i, shown as the left subfigure of Figure 5, applies a force to tracks and not to the driving wheels directly. The criterion for determining Pattern III can be described as follows:
(8)ih2+b2+(rE-rA)h2+b2h≤l,η>rE,ζ<π2,
where η is the distance from the center of the driving wheels to the stair vertex with the larger labeled line number and ζ is the angle formed by stair slope and the line crossing from the center of the driving wheels to the stair vertex with the larger labeled line number.Pattern IV. The stair vertex with the larger labeled line number i+1, shown as the right subfigure of Figure 5 remains contact with tracks, thus applying a force to the driving wheels. While the stair vertex with the smaller labeled line number i, shown as the right subfigure of Figure 5 remains no contact with tracks. The criterion for determining Pattern IV can be described as:
(9)ih2+b2+(rE-rA)h2+b2h≤l,η≤rEorζ≥π2.If the expressionζ<π/2 does not hold for the criterion (8) for determining Pattern III, as shown in Figure 6, Pattern IV might be mistaken for Pattern III.Figure 6
Pattern IV which meets the situation ofη>rE.Experimental results show that the stair-climbing process of WT wheelchair robot on each stair can be divided into a sequence of determinations for Pattern I, Pattern II, Pattern III, and Pattern IV, thus forming a simple cycle, as shown in Figure7.Figure 7
Flow chart of the determination of patterns.


### 3.3. Analysis of the Pattern for the First Stair

The criterion for the robot climbing in the first stair is(rE-rA)h2+b2/h<l<h2+b2+rE(b/h)-rAh2+b2/h, with the wheelchair being in Pattern IV, as shown in Figure 8. When l≥h2+b2+rE(b/h)-rAh2+b2/h, the flow in Figure 7 can be used to determine the pattern.Figure 8
Climbing the first stair.


## 3.1. Location of the Wheelchair Robot on Stairs

The height of a single stair ish=0.15(m), and the width is b=0.32(m), with slope angle of stairs defined as Λ=arctan(h/b). For connecting all stair vertices, one can get a stair slope line, as shown in Figure 2. One can draw straight lines, which are called labeled lines, through stair vertices perpendicular to stair slope, on the basis of which he or she can number stairs from bottom to top in turns. When the center of the driving wheel is located between the two certain straight lines, one can denote the robot by using the smaller number of the two. An entire stair-climbing process can be decomposed into a number of segments, from the center of the wheel E running after a labeled line to that running after the next one. Also one can define l=|EH| as a parameter to calculate the line number labeled for the robot, where |EH| is the length of the line EH with H being the point crossed by the line EH which is parallel to the stair slope and the line AH which is parallel to the horizontal ground.Figure 2
Sketch map of demarcation of stairs.Criterion expressed byl for labeling the robot or stair can be described as:
(3)ih2+b2+rEbh-rAh2+b2h≤l<(i+1)h2+b2+rEbh-rAh2+b2h.
Thus, the line number labeled for the robot or stair can be deducted as follows:
(4)i=floor(hl+rAh2+b2-rEbhh2+b2),
where floor(•) is a rounding function.


## 3.2. Pattern Classification

The situation that horizontal surface of stairs is tangential to the bottom surface of the driving wheel, as shown in Figure3, can be used as a primary classification of the patterns of the robot. When the driving wheels move on the horizontal plane, as shown in Figure 3, the parameter L remains unchanged, and the relationship can be obtained as follows:
(5)ih2+b2+(rE-rA)h2+b2h=l.Figure 3
Primary classification of patterns.


### 3.2.1. Classification between Pattern I and Pattern II

Whenih2+b2+(rE-rA)h2+b2/h>l, there are two patterns, as shown in Figure 4.Figure 4
Classification between Pattern I and Pattern II.Pattern I. The stair vertex with the smaller labeled line number i, as shown in the left subfigure of Figure 4, applies a force to the track and then to the driving wheels. The criterion for determining Pattern I can be described as follows:
(6)ih2+b2+(rE-rA)h2+b2h>l,γ≤γcr,
where γ is the angle formed by the line crossing through from stair vertex to the center of the driving wheel and the line perpendicular to stair slope and γcr is the angle formed by the line crossing through from the tangent point between track and driving wheels to the center of the driving wheel and the line perpendicular to stair slope.Pattern II. The stair vertex with the smaller labeled line number i, shown as the right subfigure of Figure 4, applies a force to the track and not to the driving wheels directly. The criterion for determining Pattern II can be described as follows:
(7)ih2+b2+(rE-rA)h2+b2h>l,γ>γcr.


### 3.2.2. Classification between Pattern III and Pattern IV

Whenih2+b2+(rE-rA)h2+b2/h≥l, there are also two patterns, as shown in Figure 5.Figure 5
Classification between Pattern III and Pattern IV.Pattern III. The stair vertex with the larger labeled line number i+1, shown as the left subfigure of Figure 5, remains in no contact with tracks, thus applying no force to the driving wheels directly. While the stair vertex with the smaller labeled line number i, shown as the left subfigure of Figure 5, applies a force to tracks and not to the driving wheels directly. The criterion for determining Pattern III can be described as follows:
(8)ih2+b2+(rE-rA)h2+b2h≤l,η>rE,ζ<π2,
where η is the distance from the center of the driving wheels to the stair vertex with the larger labeled line number and ζ is the angle formed by stair slope and the line crossing from the center of the driving wheels to the stair vertex with the larger labeled line number.Pattern IV. The stair vertex with the larger labeled line number i+1, shown as the right subfigure of Figure 5 remains contact with tracks, thus applying a force to the driving wheels. While the stair vertex with the smaller labeled line number i, shown as the right subfigure of Figure 5 remains no contact with tracks. The criterion for determining Pattern IV can be described as:
(9)ih2+b2+(rE-rA)h2+b2h≤l,η≤rEorζ≥π2.If the expressionζ<π/2 does not hold for the criterion (8) for determining Pattern III, as shown in Figure 6, Pattern IV might be mistaken for Pattern III.Figure 6
Pattern IV which meets the situation ofη>rE.Experimental results show that the stair-climbing process of WT wheelchair robot on each stair can be divided into a sequence of determinations for Pattern I, Pattern II, Pattern III, and Pattern IV, thus forming a simple cycle, as shown in Figure7.Figure 7
Flow chart of the determination of patterns.


## 3.2.1. Classification between Pattern I and Pattern II

Whenih2+b2+(rE-rA)h2+b2/h>l, there are two patterns, as shown in Figure 4.Figure 4
Classification between Pattern I and Pattern II.Pattern I. The stair vertex with the smaller labeled line number i, as shown in the left subfigure of Figure 4, applies a force to the track and then to the driving wheels. The criterion for determining Pattern I can be described as follows:
(6)ih2+b2+(rE-rA)h2+b2h>l,γ≤γcr,
where γ is the angle formed by the line crossing through from stair vertex to the center of the driving wheel and the line perpendicular to stair slope and γcr is the angle formed by the line crossing through from the tangent point between track and driving wheels to the center of the driving wheel and the line perpendicular to stair slope.Pattern II. The stair vertex with the smaller labeled line number i, shown as the right subfigure of Figure 4, applies a force to the track and not to the driving wheels directly. The criterion for determining Pattern II can be described as follows:
(7)ih2+b2+(rE-rA)h2+b2h>l,γ>γcr.


## 3.2.2. Classification between Pattern III and Pattern IV

Whenih2+b2+(rE-rA)h2+b2/h≥l, there are also two patterns, as shown in Figure 5.Figure 5
Classification between Pattern III and Pattern IV.Pattern III. The stair vertex with the larger labeled line number i+1, shown as the left subfigure of Figure 5, remains in no contact with tracks, thus applying no force to the driving wheels directly. While the stair vertex with the smaller labeled line number i, shown as the left subfigure of Figure 5, applies a force to tracks and not to the driving wheels directly. The criterion for determining Pattern III can be described as follows:
(8)ih2+b2+(rE-rA)h2+b2h≤l,η>rE,ζ<π2,
where η is the distance from the center of the driving wheels to the stair vertex with the larger labeled line number and ζ is the angle formed by stair slope and the line crossing from the center of the driving wheels to the stair vertex with the larger labeled line number.Pattern IV. The stair vertex with the larger labeled line number i+1, shown as the right subfigure of Figure 5 remains contact with tracks, thus applying a force to the driving wheels. While the stair vertex with the smaller labeled line number i, shown as the right subfigure of Figure 5 remains no contact with tracks. The criterion for determining Pattern IV can be described as:
(9)ih2+b2+(rE-rA)h2+b2h≤l,η≤rEorζ≥π2.If the expressionζ<π/2 does not hold for the criterion (8) for determining Pattern III, as shown in Figure 6, Pattern IV might be mistaken for Pattern III.Figure 6
Pattern IV which meets the situation ofη>rE.Experimental results show that the stair-climbing process of WT wheelchair robot on each stair can be divided into a sequence of determinations for Pattern I, Pattern II, Pattern III, and Pattern IV, thus forming a simple cycle, as shown in Figure7.Figure 7
Flow chart of the determination of patterns.


## 3.3. Analysis of the Pattern for the First Stair

The criterion for the robot climbing in the first stair is(rE-rA)h2+b2/h<l<h2+b2+rE(b/h)-rAh2+b2/h, with the wheelchair being in Pattern IV, as shown in Figure 8. When l≥h2+b2+rE(b/h)-rAh2+b2/h, the flow in Figure 7 can be used to determine the pattern.Figure 8
Climbing the first stair.


## 4. Active Tension Control by Using a Novel Control Law for Holonomic or Nonholonomic Systems

The simplified dynamic model of WT wheelchair robot in each pattern can be described as follows.Dynamic equation:(10)ddt([∂Lag∂q˙1∂Lag∂q˙2∂Lag∂q˙4])-[∂Lag∂q1∂Lag∂q2∂Lag∂q4]-[∂f(q1,q2)∂q1∂f(q1,q2)∂q20]2λ=[Q12Q22Q4],
where the Lagrangian is Lag=Lag(q1,q˙1,q2,q˙2,q4,q˙4)=2TE+TBE+TAB+2TCD-2VE-VBE-VAB-2VCD.And the constraint equation is the same as (1):
(11)f(q1,q2)=0.There are three generalized coordinates and a holonomic constraint in the system of WT wheelchair robot, so the wheelchair robot possesses two independent generalized coordinates and the number of degrees of freedom of the system is two. The Lagrange multiplierλ corresponds to the constraint force of the holonomic constraint, namely, tension force of track. There are three power sources: Q1 is the torque provided by the motor of the back flipper, Q2 is the torque provided by the motor of front flippers, and Q4 is the torque provided by the walking motors of driving wheels, which are used to control the wheelchair’s generalized coordinates and constraint force. From above, one can know that the number of the system’s power sources is equal to the sum of the number of the degrees of freedom and the number of the independent constraints, which is different from the control available for underactuated robots.The following introduced theorem deals with such active tension control law for holonomic or nonholonomic robots.Theorem 1.
Assume that there aren generalized coordinates and g independent constraints in holonomic system. Dynamic equation based on the general form of the Hamilton principle of the system is as follows: ∫t0t1‍(Dq¨+Cq˙+G-Q)Tδqdt=0, where the matrix D∈ℝn×n is known as the inertial terms, the matrix C∈ℝn×n is known as the centripetal and Coriolis forces, the matrix G∈ℝn×1 is known as the gravity terms, and the matrix Q∈ℝn×1 is known as the generalized forces corresponding to the torques driven by the motors of robot’s joints. Let constraint equation be f(q,t)=0, where f(•)∈ℝg×1 is a vector function. So, the number of the degrees of freedom of the system is k=n-g, and thus there are k independent generalized coordinates, which can be defined as  qk=[q1,q2,…,qk]T∈ℝk×1, while qg=[qk+1,qk+2,…,qn]T∈ℝg×1 with Dk∈ℝn×k are k columns of the matrix D corresponding to q¨k, and Dg∈ℝn×g are g columns of the matrix D corresponding to q¨g. If [Dk-Dg(∂f/∂qgT)-1∂f/∂qkT-∂fT/∂q]∈ℝn×n is an invertible array, all of the generalized coordinates including independent generalized coordinates and dependent ones of a holonomic system can be tracked, and also constraint forces of holonomic constraints can be controlled, with a control law givenin the following:
(12)Q=-Dg(∂f∂qgT)-1(cfq˙+∂2f∂t∂qTq˙+∂2f∂t2)+Cq˙+G+[Dk-Dg(∂f∂qgT)-1∂f∂qkT-∂fT∂q]×[q¨kd+kDe˙k+kPekλd].Proof.
According tog, independent holonomic constraint equations, one can obtain the following:
(13)f(q,t)=0,
that is f(qk,qg,t)=0.
According to implicit function theorem one gets the following:(14)qg=qg(qk,t).
Differentiating both sides of (13) with respect to the time t yields
(15)∂f∂qTq˙+∂f∂t=0,
that is,
(16)[∂f∂qkT∂f∂qgT][q˙kq˙g]+∂f∂t=0.
Expanding it, one can obtain the following:
(17)∂f∂qkTq˙k+∂f∂qgTq˙g+∂f∂t=0.
Because (13) is independent, ∂f/∂qgT∈ℝg×g is invertible and according to (17) one obtains the following:
(18)q˙g=-(∂f∂qgT)-1(∂f∂qkTq˙k+∂f∂t).
Differentiating both sides of (15) with respect to the time t, one can obtain the following:
(19)[q˙T∂2f1∂qT∂qq˙T∂2f2∂qT∂q⋮q˙T∂2fg∂qT∂q]q˙+∂f∂qTq¨+∂2f∂t∂qTq˙+∂2f∂t2=0,
where one can define the following:
(20)cf=[q˙T∂2f1∂qT∂qq˙T∂2f2∂qT∂q⋮q˙T∂2fg∂qT∂q]∈ℝg×n,
and thus substituting it into (19), one can obtain the following: (∂f/∂qT)q¨+cfq˙+(∂2f/∂t∂qT)q˙+∂2f/∂t2=0,(21)[∂f∂qkT∂f∂qgT][q¨kq¨g]+cfq˙+∂2f∂t∂qTq˙+∂2f∂t2=0,∂f∂qkTq¨k+∂f∂qgTq¨g+cfq˙+∂2f∂t∂qTq˙+∂2f∂t2=0,
and thus
(22)q¨g=-(∂f∂qgT)-1(∂f∂qkTq¨k+cfq˙+∂2f∂t∂qTq˙+∂2f∂t2).
According to (15), the variation of generalized coordinates of constraint equations can be described as (∂f/∂qT)δq=0. Multiplying it by the undetermined coefficient λ∈ℝg×1 and adding it to the dynamic equations, one can obtain the following:
(23)∫t0t1(Dq¨+Cq˙+G-∂fT∂qλ-Q)Tδqdt=0,
where there are k=n-g independent coordinates of the system, and also one can adjust g, other undetermined multipliers so that the coefficients in front of the dependent coordinates of the system remain 0, with a result obtained as Dq¨+Cq˙+G-(∂fT/∂q)λ-Q=0. Expanding it gives the following:
(24)[DkDg][q¨kq¨g]+Cq˙+G-∂fT∂qλ=Q,
and thus
(25)Dkq¨k+Dgq¨g+Cq˙+G-∂fT∂qλ=Q.
Substituting for q¨g from (22) into (25) yields the following:
(26)Dkq¨k-Dg(∂f∂qgT)-1(∂f∂qkTq¨k+cfq˙+∂2f∂t∂qTq˙+∂2f∂t2)+Cq˙+G-∂fT∂qλ=Q.
Substituting for q˙g from (18) into (26) and then substituting for qg from (14) into (26), one can obtain the following:
(27)[Dk-Dg(∂f∂qgT)-1∂f∂qkT]q¨k-Dg(∂f∂qgT)-1×(cfq˙+∂2f∂t∂qTq˙+∂2f∂t2)+Cq˙+G-∂fT∂qλ=Q.
A dynamic equation containing only the independent generalized coordinates qk and the Lagrange multipliers λ can be obtained as follows:
(28)[Dk-Dg(∂f∂qgT)-1∂f∂qkT-∂fT∂q][q¨kλ]-Dg(∂f∂qgT)-1(cfq˙+∂2f∂t∂qTq˙+∂2f∂t2)+Cq˙+G=Q.
A control law can be designed as (12), where qkd, q˙kd, and q¨kd are known as the expected values of independent generalized coordinates of qk, q˙k, and q¨k, thus difference functions of independent generalized coordinates being defined as ek=qkd-qk, e˙k=q˙kd-q˙k, and e¨k=q¨kd-q¨k with kD and kP being positive definite matrices which can be selected.
Substituting for such control law or the torque vectorQ from (12) into the dynamic equation (28) yields the following:
(29)[Dk-Dg(∂f∂qgT)-1∂f∂qkT-∂fT∂q]×[q¨k-q¨kd-kDe˙k-kPekλ-λd]=0.
According to the assumption of the theorem, if the matrix(30)[Dk-Dg(∂f∂qgT)-1∂f∂qkT-∂fT∂q]
is invertible, (29) has only a zero solution as follows:
(31)e¨k+kDe˙k+kPek=0,λ=λd.
According toλ=λd, the control law can be used to control constraint forces of holonomic constraints of the system. And also the Lyapunov function can be proposed as V=(1/2)e˙kTe˙k+(1/2)ekTkPek. Because kP is positive definite, one can obtain V>0, and differentiating a both sides of the Lyapunov function with respect to the time t one can obtain the following:
(32)V˙=e˙kTe¨k+e˙kTkPek=e˙kT(e¨k+kPek).
Substituting e¨k+kPek=kDe˙k, where kD is a positive definite, from (31) into the derivative of the Lyapunov function (32), one can obtain V˙=-e˙kTkDe˙k<0, which means the system is stable and that limt→∞ek=0.
By using the control law (12), one can make the controlled independent generalized coordinates qk track the expected reference input qkd, and the relative curves of dependent generalized coordinates qg can be obtained by (14), (18), and (22).Just making an appropriate change of constraint equations, one can design the control law for the nonholonomic system by using the above theorem.Applying the above theorem to WT wheelchair robot, with (10) and (11), one can obtain the control law for the system as follows:
(33)[Q12Q22Q4]=-D2(∂f∂q2)-1cfq˙+Cq˙+G+[D1-D2(∂f∂q2)-1∂f∂q1-∂f∂qD4]×[q¨1d+kD1(q˙1d-q˙1)+kP1(q1d-q1)2λdq¨4d+kD4(q˙4d-q˙4)+kP4(q4d-q4)],
where D1, D2, and D4 denote the first column, the second column, and the third column of the inertia terms D.Substituting the control law (33) with the dynamic equation (10) of the wheelchair, one can obtain the differential equations corresponding to the independent generalized coordinates q1 and q4 and the constraint force λ as follows:
(34)q¨1=q¨1d+kD1(q˙1d-q˙1)+kP1(q1d-q1),2λ=2λd,q¨4=q¨4d+kD4(q˙4d-q˙4)+kP4(q4d-q4).


## 5. Analysis of Simulation and Experiment

Using the module stateflow [21] in MATLAB to simulate the entire stair-climbing process for WT wheelchair robot, one can obtain simulation curves about the determination of patterns, motion trajectories of the wheelchair, and the torques provided by each joint’s motor and the tension force provided by the holonomic constraint of the track of the wheelchair.


### 5.1. Simulation Curves for the Determination of Patterns

An effective determination of pattern for WT wheelchair robot during stair-climbing process may need some parameter curves together. And according to the decision-making flow given in Figure7, one can obtain analytical results of the entire stair-climbing process, as shown in Figure 9.Figure 9
Schematics diagram of simulation results by using stateflow.All abscissas of the curves in Figure9 are the time t, second in unit. The ordinate of the curve in Figure 9(a) is γcr, rad in unit, and the left of the black line at about t=16(s) means “in the stair-climbing process’’ while the right of the black line means “the stair-climbing process finished.’’ The ordinate of the curve in Figure 9(b) is i without unit as is described as (4), with i=1, i=2, and i=3 denoting the section of stairs where wheelchair robot climbs. The ordinate of the curve in Figure 9(c) is the sign of ih2+b2+((rE-rA)h2+b2/h)-l without unit as described in Section 2, with a value of 0 representing the climb of WT wheelchair robot between the start and the first stair in Pattern IV,   a value of 1 indicating the wheelchair robot is in Pattern I or II, or a value of −1 indicating the wheelchair robot is in Pattern III or IV. The ordinate of the curve in Figure 9(d) is the sign of γ-γcr without unit, with a combination with Figure 9(c) being made that a value of 1 indicates the range of Pattern I, and that a value of −1 indicates the range of Pattern II, as shown in Figures 9(c) and 9(d). The ordinate of the curve in Figure 9(e) is η-rE, meter in unit, and the ordinate of the curve in Figure 9(f) is ζ-π/2, rad in unit. According to (8) and (9), the range of Pattern III and the range of Pattern IV can be determined, as shown in  Figures 9(e) and 9(f).


### 5.2. Simulation for Active Tension Control

In WT wheelchair robot system, the back flipper is controlled by a switch, which can be expressed by the generalized coordinates asq1=c1·t+q10, where c1=0.1222(rad/s) is the constant angular velocity corresponding to the motor of the back flipper, t is time, and q10=1.1132(rad) is the angle of the initial position. The seat plane of WT wheelchair robot needs to remain horizontal, namely, q6=q6(q1,q4)≡0. Plus, the constraint equation (11) f(q1,q2)=0, one can obtain an equation set through as follows:
(35)q1=c1·t+q10,q6(q1,q4)=0,f(q1,q2)=0,
from which one can obtain the reference inputs of the generalized coordinates q1d, q2d, q4d, and those of their derivatives.Selecting positive definite matriceskP=[kP100kP4]=[10000100] and kD=[kD100kD4]=[140014], one can obtain the torque of each joint and the difference of the Lagrange multiplier λ of the output constraint force from λd of the expected input constraint force by using control law (33), as shown in Figure 10.Figure 10
Torque of each joint provided by motor and the Lagrange multiplier.Figure10(d) shows that according to such a control law that one can make the constraint force of the track of the wheelchair to follow the reference input tension, and that at the same time one can obtain the simulation curve of the motion trajectory of each expected reference input and the output curve acted by such a controller, as shown in Figures 11, 12, and 13.Figure 11
Curve of the independent generalized coordinateq1 and that of its reference input q1d.Figure 12
Curve of the independent generalized coordinateq4 and that of its reference input q4d.Figure 13
Curve of the independent generalized coordinateq2 and that of its reference input q2d.Because the time span of the stair-climbing process is much larger, the output curves where control law (12) is applied to the robot and the expected reference input curves are similar and are not distinguished easily, as shown in Figures 11(a), 12(a), and 13(a). So, one can list their angular difference curves of joints, as shown in Figures 11(b), 12(b), and 13(b).A comparison of the output curves of the wheelchair with the expected reference input curves of the wheelchair shows that by using such a control law one can make the output curves to follow the expected reference input curves immediately and then to remain stable.


### 5.3. Experiment of WT Wheelchair Robot in the Process of Stair-Climbing

The simulation curves about the torques can be used as a basis for the selection of motors. And Figure14 demonstrates the entire experimental process of the WT wheelchair robot during the stair-climbing process. If the controller could make outputs q1, q2, and q4 follow the reference inputs q1d, q2d, and q4d, then q6 could follow the reference purpose q6d=0, which should mean that the plane angle of the seat corresponding to the horizontal plane follow 0 or the seat of the wheelchair maintains the horizontal angle,   as shown in Figure 14 that the seat of the wheelchair varies around the horizontal surface, which can be regarded as an indirect reflection of the effectiveness of the designed controller.Record of stair-climbing experiment for WT wheelchair robot.
(a)
i
=
0, start
(b)
i
=
0, pattern = IV
(c)
i
=
1, pattern = I
(d)
i
=
1, pattern = II
(e)
i
=
1, pattern = III
(f)
i
=
1, pattern = IV
(g)
i
=
3, pattern = I
(h)
i
=
3, pattern = III, finished
(i)
Climb finished


## 5.1. Simulation Curves for the Determination of Patterns

An effective determination of pattern for WT wheelchair robot during stair-climbing process may need some parameter curves together. And according to the decision-making flow given in Figure7, one can obtain analytical results of the entire stair-climbing process, as shown in Figure 9.Figure 9
Schematics diagram of simulation results by using stateflow.All abscissas of the curves in Figure9 are the time t, second in unit. The ordinate of the curve in Figure 9(a) is γcr, rad in unit, and the left of the black line at about t=16(s) means “in the stair-climbing process’’ while the right of the black line means “the stair-climbing process finished.’’ The ordinate of the curve in Figure 9(b) is i without unit as is described as (4), with i=1, i=2, and i=3 denoting the section of stairs where wheelchair robot climbs. The ordinate of the curve in Figure 9(c) is the sign of ih2+b2+((rE-rA)h2+b2/h)-l without unit as described in Section 2, with a value of 0 representing the climb of WT wheelchair robot between the start and the first stair in Pattern IV,   a value of 1 indicating the wheelchair robot is in Pattern I or II, or a value of −1 indicating the wheelchair robot is in Pattern III or IV. The ordinate of the curve in Figure 9(d) is the sign of γ-γcr without unit, with a combination with Figure 9(c) being made that a value of 1 indicates the range of Pattern I, and that a value of −1 indicates the range of Pattern II, as shown in Figures 9(c) and 9(d). The ordinate of the curve in Figure 9(e) is η-rE, meter in unit, and the ordinate of the curve in Figure 9(f) is ζ-π/2, rad in unit. According to (8) and (9), the range of Pattern III and the range of Pattern IV can be determined, as shown in  Figures 9(e) and 9(f).


## 5.2. Simulation for Active Tension Control

In WT wheelchair robot system, the back flipper is controlled by a switch, which can be expressed by the generalized coordinates asq1=c1·t+q10, where c1=0.1222(rad/s) is the constant angular velocity corresponding to the motor of the back flipper, t is time, and q10=1.1132(rad) is the angle of the initial position. The seat plane of WT wheelchair robot needs to remain horizontal, namely, q6=q6(q1,q4)≡0. Plus, the constraint equation (11) f(q1,q2)=0, one can obtain an equation set through as follows:
(35)q1=c1·t+q10,q6(q1,q4)=0,f(q1,q2)=0,
from which one can obtain the reference inputs of the generalized coordinates q1d, q2d, q4d, and those of their derivatives.Selecting positive definite matriceskP=[kP100kP4]=[10000100] and kD=[kD100kD4]=[140014], one can obtain the torque of each joint and the difference of the Lagrange multiplier λ of the output constraint force from λd of the expected input constraint force by using control law (33), as shown in Figure 10.Figure 10
Torque of each joint provided by motor and the Lagrange multiplier.Figure10(d) shows that according to such a control law that one can make the constraint force of the track of the wheelchair to follow the reference input tension, and that at the same time one can obtain the simulation curve of the motion trajectory of each expected reference input and the output curve acted by such a controller, as shown in Figures 11, 12, and 13.Figure 11
Curve of the independent generalized coordinateq1 and that of its reference input q1d.Figure 12
Curve of the independent generalized coordinateq4 and that of its reference input q4d.Figure 13
Curve of the independent generalized coordinateq2 and that of its reference input q2d.Because the time span of the stair-climbing process is much larger, the output curves where control law (12) is applied to the robot and the expected reference input curves are similar and are not distinguished easily, as shown in Figures 11(a), 12(a), and 13(a). So, one can list their angular difference curves of joints, as shown in Figures 11(b), 12(b), and 13(b).A comparison of the output curves of the wheelchair with the expected reference input curves of the wheelchair shows that by using such a control law one can make the output curves to follow the expected reference input curves immediately and then to remain stable.


## 5.3. Experiment of WT Wheelchair Robot in the Process of Stair-Climbing

The simulation curves about the torques can be used as a basis for the selection of motors. And Figure14 demonstrates the entire experimental process of the WT wheelchair robot during the stair-climbing process. If the controller could make outputs q1, q2, and q4 follow the reference inputs q1d, q2d, and q4d, then q6 could follow the reference purpose q6d=0, which should mean that the plane angle of the seat corresponding to the horizontal plane follow 0 or the seat of the wheelchair maintains the horizontal angle,   as shown in Figure 14 that the seat of the wheelchair varies around the horizontal surface, which can be regarded as an indirect reflection of the effectiveness of the designed controller.Record of stair-climbing experiment for WT wheelchair robot.
(a)
i
=
0, start
(b)
i
=
0, pattern = IV
(c)
i
=
1, pattern = I
(d)
i
=
1, pattern = II
(e)
i
=
1, pattern = III
(f)
i
=
1, pattern = IV
(g)
i
=
3, pattern = I
(h)
i
=
3, pattern = III, finished
(i)
Climb finished


## 6. Conclusions

Combined with the computed torque method, a novel control law applied to holonomic or nonholonomic systems is derived, with the active tension of the track controlled for WT wheelchair robot during the stair-climbing process simultaneously. The simulation of each of output and each expected reference input of the generalized coordinate shows the effectiveness of the proposed control law, the experimental results of the stair-climbing process for WT wheelchair robot verifying its obstacle-navigating performance, and the patterns analyzed above are embodied in the experiment.



---

*Source: 236515-2013-09-26.xml*