Abstract

The Theo Jansen mechanism is gaining widespread popularity among the legged robotics community due to its scalable design, energy efficiency, low payload-to-machine-load ratio, bioinspired locomotion, and deterministic foot trajectory. In this paper, we perform for the first time the dynamic modeling and analysis on a four-legged robot driven by a single actuator and composed of Theo Jansen mechanisms. The projection method is applied to derive the equations of motion of this complex mechanical system and a position control strategy based on energy is proposed. Numerical simulations validate the efficacy of the designed controller, thus setting a theoretical basis for further investigations on Theo Jansen based quadruped robots.

1. Introduction

Legged robots [13] have always been a popular choice for robotic researchers because of their superiority over traditional wheeled or tracked robotic platforms on applications involving maneuverability over rough terrains. Bartsch et al. [4] presented their efforts in developing a six-legged, bioinspired, and energy efficient robot (SpaceClimber 1) for extraterrestrial surface exploration, particularly for mobility in lunar craters. Estremera et al. [5] elaborated the development of crab and turning gaits for a hexapod robot, SILO-6, on a natural terrain containing uneven ground and forbidden zones as well as an application to humanitarian demining. Moro et al. [6] proposed an approach to directly map a range of gaits of a horse to a quadruped robot with an intention of generating a more life-like locomotion cycle. This work also presented the use of kinematic motion primitives in generating valid and stable walking, trotting, and galloping gaits that were tested on a compliant quadruped robot. In these works, the robots developed were generally effective in mimicking the gait cycles of their biological counterparts, but they suffered from high payload-to-machine-load ratio and high energy consumption.

Several approaches were studied in developing energy efficient walking machines. Reference [7] presented a set of rules towards improving energy efficiency in statically stable walking robots by comparing two-legged, namely, mammal and insect, configurations on a hexapod robotic platform. Reference [8] applied minimization criteria for optimizing energy consumption in a hexapod robot over every half a locomotion cycle, especially while walking on uneven terrains. Reference [9] put forward two different approaches to determine optimal feet forces and joint torques for six-legged robots towards minimizing energy consumption. Even though these works focused on the energy optimization problem, the robots experimented therein involved a series of links with multiple actuators to realize walking motion. Jansen [10], a Dutch kinetic artist, proposed an unconventional closed-kinematic-chain-based approach which requires actuation at only a single per leg through mapping internal cyclic motion into elliptical ones. Various aspects of the Jansen mechanism have been studied by a number of researchers. Reference [11] proposed an extension of the Theo Jansen mechanism by introducing an additional up-down motion in the linkage center for realizing new gait cycles with about ten times the height of the original for climbing over obstacles. Vector loop and simple geometric methods were used in conjunction with software tools such as ProEngineer and SAM for analyzing forward kinematics of the Theo Jansen mechanism in [12]. An attempt to optimize the leg geometry of the Theo Jansen mechanism using genetic algorithm was presented in [13]. The work explored the stability limits and tractive abilities while validating the kinematic and kinetic models through experiments with hardware prototypes. However, these two works did not provide dynamics analysis and discussions. Reference [14] conducted a preliminary dynamic analysis using the superposition method with the intention of optimizing the Theo Jansen mechanism; but this work is incomplete, without details on the analysis and discussions of equivalent Lagrange’s equation. In fact, the complete dynamic analysis involving constraint forces and equivalent Lagrange’s equation of motion is necessary for any meaningful extension and/or optimization of legged systems based on Theo Jansen mechanisms.

Lagrange’s method [1517] is famous for deriving dynamic models. Nevertheless, sometimes it is very difficult to build the dynamic model of a linkage mechanism, such as the Theo Jansen linkage, by using this method because the forward kinematics of the system becomes cumbersome. In this paper, the projection method [1820] is applied to derive the complete dynamic model of a four-legged robot driven by a single actuator and composed of Theo Jansen mechanisms that was originally proposed by Studer [21]. In comparison with the conventional approaches, Lagrange’s, Gibbs-Appel, and Kane’s, for example, the projection method has been observed to be more intuitive in nature and compact [18, 19, 22]. By using this approach, the linkage mechanism can be assumed as a simple holonomic system and the model is derived by focusing on its constraints [22]. The dynamic model of the whole system can be established by separating the system into a few subcomponents and then integrating their dynamic models [23].

The complete dynamic analysis of Theo Jansen mechanisms is essential and will be conducted in the following contents. For the sake of convenience, the Jansen linkage or Jansen mechanism will be referred to as Theo Jansen mechanisms hereafter. The rest of this paper is organized as follows: In Section 2, the free-fall dynamic modeling of the one-actuator four-legged robot with Theo Jansen mechanisms is presented; this consists of the models of each Jansen leg and the corresponding gear system. In Section 3, the reaction force from the ground and friction are taken into account to build the plant dynamic model. The control system is designed based on energy control in Section 4. Numerical simulations are presented in Section 5. Finally, concluding remarks are given in Section 6.

2. Free-Fall Model

The schematic diagram of the quadruped robot is shown in Figure 1. This quadruped robot is composed of four Jansen linkage mechanisms and five gears which are driven by only one input attached to the bright yellow gear. The colors red, blue, green, and purple represent legs of left-fore, right-fore, left-back, and right-back, respectively. As a matter of practical convenience, we define and in this paper unless otherwise noted where , , , and represent the right leg, left leg, fore leg, and back leg, respectively. The robot contacts with the ground on only toes, and the -axis represents the ground. Because the four legs are the same Jansen linkage mechanisms, we can have the free-fall model of the whole robot by establishing the dynamic models of the single Jansen linkage and the gear system independently and then integrating the two models.

2.1. Dynamic Model of Jansen Linkage Mechanism

The schematic diagram and the coordinate system of a single Jansen linkage mechanism are illustrated in Figure 2. The physical parameters of the Jansen linkage mechanisms are tabulated in Table 1. The lengths of links adopted for the design in this study are listed in Table 3 [24]. It is assumed that the gravity center of every link locates on the center of the specified link, and the gravity center of each triangle locates on vertex of three median lines. The angle between the gravity center and the corners of the triangle and the length from the gravity center to the corners of the triangle are calculated utilizing the law of cosines and are given in Table 2.

To construct the constraint-free dynamic model based on Figure 2, first of all, the generalized coordinate of this system is defined aswhere represents the absolute angle of each link, and represents the absolute coordinate of each link. Since the constraint-free model means a model in which every element has the highest degree of freedom as shown in Figure 3, it is only necessary to formulate motion equations around every gravity center according to Newton’s second law to derive the constraint-free model. In a linkage mechanism like the system of this paper, the gravity and viscous friction forces are generated to each link [25, 26]. Because the viscous friction forces are generated in proportion to velocities, the matrix form motion equation around the gravity center (i.e., the constraint-free model) is represented as (2) with attention that the viscous friction forces are generated by corresponding to the relative velocitywhere the generalized mass matrix and the generalized force matrix are defined aswhere , .

In the next step, the constraint matrix which holds is formulated from constraint conditions. The coordinates of the gravity center and the length of each link satisfy a certain relationship geometrically. For example, , can be represented as follows:By moving right side to the other side, (4) is represented as follows:In addition, all other gravity centers can be represented as well as above. And, by forming these as matrix, the holonomic constraint relevant to the gravity center is formulated as follows: Then the constraint matrix is defined asThe constraint dynamical system can thus be formulated by adding the constraint term (7) with Lagrange’s multipliers to (2) as

Moreover, the degree of freedom of the unconstraint system is found to be 24 from (1). The degrees of freedom should be constrained by 20 holonomic constraints in this system. Therefore, the degree of freedom of the constrained dynamical system (8) is 4.

The tangent speed of the constrained system is denoted as Setting a partition symbolically as where shows dependent velocities with respect to , is decomposed into satisfying . is the orthogonal complement matrix to satisfying , , and where represents the identity matrix .

Finally, multiplying (8) by from the left side and substituting the coordinate transformation into (8) can eliminate the constraint term with , and the dynamic model of the Jansen linkage mechanism is

2.2. Dynamic Model of Gear System

After the establishment of the dynamic model of the Jansen linkage mechanism, the dynamic model of the gear system [13] is derived following the same steps as Section 2.1. Table 4 gives the notations and values of the physical parameters of the gear system. Figure 4 illustrates the schematic diagram and coordinate system of the gear system consisting of six gears where the subscripts and represent the frame of the gears and the driving gears including, respectively. The two driving gears are driven by a single actuator and rotate synchronously. Meanwhile, the four driven gears are driven by the two driving gears. The frame is used to fix all the gears. All gears are noncircular gears [2729] which vary their gear ratios during rotation, but the driven gears rotate one revolution with respect to one revolution of the driving gear. In addition, the gear ratio of each gear varies depending on the angle between the driving gear and the gear frame. Based on these conditions, the gear ratio is defined as where and are with respect to each gait pattern of the Jansen linkage mechanism ( rad and  rad in this paper).

The constraint-free model is derived according to Figure 4 with parameters defined in Table 4. The generalized coordinate of this system is given:where and represent the absolute angles and coordinates of the gear frame, the driving and driven gears, respectively. With the generalized coordinate (13), equations of motion concerned with the gear system are formulated below:where with representing the input torque.

The coordinates of the gravity center and the length of each link are correlated geometrically. And the rotation angles and radius of gears also conform to some relationship. Based on these relationships, the holonomic constraints are formulated as follows: For the gravity centers and gear ratio, the holonomic constraints are formulated as follows: The corresponding constraint matrix which holds is defined asSubsequently, the constraint dynamical model can thus be obtained by adding the constraint matrix with Lagrange’s multipliers to (14) asThe degrees of freedom of the unconstraint system are found to be 18 from (13) which should be constrained by 14 holonomic constraints in this system. Therefore, the degree of freedom of the constrained dynamical system is 4. The tangent speed of the constrained system is The orthogonal complement matrix is obtained according to the same steps as Section 2.1. Multiplying (18) by from the left side and substituting the coordinate transformation into (18) yield the dynamic model of Figure 4:

2.3. System Integration

Up till now the dynamic models of the Jansen linkage mechanisms and the gear system have already been established. Then the whole constraint-free dynamic model of the quadruped robot can be obtained by integrating (11) and (20):whereAgain, given the holonomic constraints of the gravity center of each link, the constraint dynamical system is thuswhereFrom (21) we find that the degrees of freedom of the unconstraint system are 20 and constrained by 16 holonomic constraints. Hence, the degree of freedom of the constrained dynamical system is 4.

Finally, by multiplying (24) by (where is the orthogonal complement matrix) from the left side and substituting the coordinate transformation into (24), the dynamic free-falling model iswhere is the tangent speed of the constrained system which is the same as that of the gear system.

3. Plant Model

The dynamic model (26) is the free-fall model which does not include reaction force from the ground. However, such force exists and can not be neglected in real situation. In this section, the dynamic model including the floor reaction force and the collision with the ground is established by expanding the free-fall model.

Our previous study has shown that the toes of the Jansen linkage mechanisms slip consistently while walking [30]. Hence, the further dynamic model considering friction is formulated in this section by assuming that the coefficient of friction is uniform.

3.1. Contact with the Ground

We consider the floor reaction force by expanding the constraint matrix using the projection method [31]. Contacting the toes with the ground can be regarded as constraining the toes on the ground (i.e., on the -axis). Thus, the floor reaction force is expressed by including the constraint when -coordinate of the toe is less than 0 and the constraint force of the toes is greater than 0 (i.e., the force is generated from the ground to the robot). Since this constraint can be described by the position constraint which is the holonomic constraint, the constraint matrix is defined as where and represents the floor reaction force. Also, by utilizing the constraint matrix, (24) is expanded aswhich can be projected to the tangent speed space using the orthogonal complement matrix , and then the motion equations including the contact on the floor are formulated as

Next, the friction force shown in Figure 5 will be included in the model. Some linear/nonlinear friction models have been already proposed in [3235]. In this study, one of the simplest friction models which is composed of only kinetic and viscous frictions is applied because it has been assumed that the coefficient of friction is uniform. The kinetic friction force is generated when the toe has a speed and the viscous friction force is generated in proportion to the speed [25, 26] of the toe. Hence the friction model is represented aswherewith kinetic friction coefficient , viscous friction coefficient , and zero matrix . Equation (31) is projected to the tangent speed space utilizing the orthogonal complement matrix and then substituted into (30). Finally, the motion equation of the quadruped robot with the Jansen linkage mechanisms considering the friction force is obtained:

3.2. Collision with the Ground

As an assumption, the collision between the ground and the toes is a non-completely elastic collision. Based on the projection method, we assume that an impulse is input at the moment when the collision occurs, and the tangent speed after collision can be formulated from the one before collision [31, 36]. The tangent speeds before and after collision are defined as and respectively, and their relationship can be expressed aswhere and represents the constraint matrix after collision which is defined as

4. Control System Design

So far we have the dynamic model taking into account the floor reaction and friction forces. However, the coefficient of friction is unknown in general as it is difficult to use the dynamic model into the controller. Therefore, the controller is designed by utilizing the approximate model based on the approximation conditions [37].

4.1. Approximate Model

Following two approximation conditions set based on characteristics of the model and mechanism, we could have the approximate model.

The first approximation condition is the contact with the ground by two legs consistently. The model is a two-dimensional model, and the heights of the legs are not equal generally in different angles of the driving link in a complex linkage mechanism such as the Jansen linkage mechanism in this case [13, 38]. And it is not general to contact the ground by three legs. Hence, the condition of contacting the ground by two legs consistently can be approximated.

The second approximation condition is that one leg does not slip. Such state represents walking with the highest efficiency. Referring to [10], we know that the Jansen linkage mechanism is able to walk with high efficiency in general. Thus, this condition can also be approximated.

For the first approximation condition, contacting with the ground by two legs can be regarded as constraining the toes on the ground (i.e., on the -axis). For the second approximation condition, one leg not slipping can be regarded as the toe not having the speed in direction. Since these two constraints can be described as the position constraints, they can be treated as the holonomic constraints. The new constraint matrix is defined as follows:where . Using this constraint matrix, (24) is expanded aswhich can be projected to the tangent speed space by using the orthogonal complement matrix . Thus we have the motion equation including contact forces on the plane:

4.2. Transformation of Dynamic Model

Due to the presence of Lagrange’s multiplier , model (39) which represents the constraint forces occurring on each constraint condition can not be utilized directly to the controller. To do that, (39) needs to be transformed into a usable form for the controller.

Firstly, the constraint forces of the system are obtained using the projection method [39, 40]: Hence, the constraint forces of the dynamic model (29) can be represented aswhere

In the second step, the generalized force matrix is expressed as the sum of three terms:where is the input torque, and with the following components: Substituting the above terms into (39) and (41) and further simplification generate the following model for the controller:where

4.3. Control System Based on Energy Control

The control system is designed based on the dynamic model and the energy control which was proposed by Åström et al. as a control method focusing on the energy of the system [4143]. The energy-based control is better than state space representation for controlling complicated mechanisms, such as the quadruped robot with Jansen linkage mechanisms in this case. To realize the position control using energy approach, a potential field [4447] is introduced. As for the potential field, the target position is designed as the point where the potential is the lowest. Hence, the process of motion control is the process that the energy of the robot is converging to the lowest potential, namely, the target position. We define the potential field aswhere the current position of the robot is defined as ; represents the target position and is defined as ; is the gradient of the potential field. The kinetic energy of the system is defined asCombining (48) and (49), the total energy of the system is

Then we design a Lyapunov functionwhere is the target energy, that is, . Solving the differential of (51), we havewhereConsidering ,Transforming (46) into and then substituting it into (55) yieldSubstituting (53) and (57) into (52), the differential of the Lyapunov function can be represented asTo ensure the Lyapunov stability (namely, to satisfy ), we choose the input torque aswhere denotes the operator of pseudo inverse; denotes the tuning parameter and satisfies .

Finally, substituting (59) into (58), we have where because represents the viscous friction forces. According to (48) and (49), . Therefore, is proven by using (59) as the input torque. In addition, from (51) and (52), it is obvious that and an equilibrium point of the Lyapunov function is the case of ; therefore the system is proven to be Lyapunov stable [48]. Furthermore, the system is asymptotically stable as long as . Therefore, the position of the robot can be converged to the target position by using the energy-based control strategy.

5. Numerical Simulations

Effectiveness of the designed position control system utilizing the approximate model is verified by numerical simulations which are performed by MaTX with Visual C++ 2005 version 5.3.37 [49]. The parameters used in simulations are those shown in Tables 1 and 4. The simulation time is 80 seconds, and the sampling interval is 0.01 second. The initial state of the robot is halted on the plane at position  m and the Jansen link mechanism is with  rad. In addition, the gradient of the potential field and the tuning parameter . The coefficient values of kinetic and viscous frictions are given as and . The numerical simulation results are shown as follows.

From Figures 6(a) and 6(b), it is confirmed that the robot moves with toes slipping. Figure 6(c) shows that the non-completely elastic collisions occur at the toes of the robot (i.e., ) when the toes collide with the ground (i.e., ) and height of the toes is greater than or equal to 0. In addition, in case the toes depart from the ground, the negative floor reaction force (i.e., the constraint force of ) is not generated because the position of the toe varies smoothly. Therefore, the dynamic models given in Sections 2 and 3 represent the dynamics of the robot shown in Figure 1 in two-dimensional surface including the contact and collision with the ground. Meanwhile, the rotation angle of the driving gear is increasing from zero to 90°, and those of the four driven gears are varying smoothly to −80°~−90° approximately (Figure 7).

From Figures 8 and 9, it is confirmed that the position of the robot can be converged to by the designed position control system. Meanwhile Figure 10 shows that the energy of the system converges to 0. In addition, since the value of the Lyapunov function converges to 0 and its differential is also less than 0 as shown in Figure 11, it is confirmed that the input torque shown in Figure 12 satisfies Lyapunov’s stability theory. Therefore, the position of the quadruped robot with the Jansen linkage mechanism can be controlled by applying the position control system based on the energy control. Figure 13 shows a sequence of the snapshots of walking towards the target position based on the energy-based position control in 80 seconds.

6. Conclusion

This paper contributes to model and analyze the dynamics of the four-legged robots based on Theo Jansen linkage mechanisms and driven by only one input using the projection method. The free-fall model of the whole system is built through integrating the models of the Jansen linkages and the corresponding gear system. Based on that, the reaction force and friction are taken into account to derive the plant model. The energy control system utilizing the potential field is designed to realize the position control of the Jansen walking robot. Based on the Lyapunov stability theory, this controller is proven to be able to converge by choosing appropriate input and its effectiveness is verified through numerical simulations. This research sets a theoretical basis for further investigation, optimization, or extension of legged systems based on Theo Jansen linkage mechanisms.

Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

Acknowledgment

This work was fully supported by the SUTD-MIT International Design Centre, Singapore, under Grants IDG31200110 and IDD41200105.