**International Journal of Modern Nonlinear Theory and Application**

Vol.04 No.03(2015), Article ID:58664,10 pages

10.4236/ijmnta.2015.43013

Circular Obstacle Avoidance Control of the Compass-Type Biped Robot Based on a Blending Method of Discrete Mechanics and Nonlinear Optimization

Tatsuya Kai

Department of Applied Electronics, Faculty of Industrial Science and Technology, Tokyo University of Science, Tokyo, Japan

Email: kai@rs.tus.ac.jp

Copyright © 2015 by author and Scientific Research Publishing Inc.

This work is licensed under the Creative Commons Attribution International License (CC BY).

http://creativecommons.org/licenses/by/4.0/

Received 9 June 2015; accepted 3 August 2015; published 7 August 2015

ABSTRACT

This paper considers an obstacle avoidance control problem for the compass-type biped robot, especially circular obstacles are dealt with. First, a sufficient condition such that the swing leg does not collide the circular obstacle is derived. Next, an optimal control problem for the discrete compass-type robot is formulated and a solving method of the problem by the sequential quadratic programming is presented in order to calculate a discrete control input. Then, a transformation method that converts a discrete control input into a continuous zero-order hold input via discrete Lagrange-d’ Alembert principle is explained. From the results of numerical simulations, it turns out that obstacle avoidance control for the continuous compass-type robot can be achieved by the proposed method.

**Keywords:**

Discrete Mechanics, Compass-Type Biped Robot, Obstacle Avoidance Control, Nonlinear Optimization, Zero-Order Hold Input

1. Introduction

Humanoid robots have been energetically researched in the fields of robotics and control theory so far. Especially, the compass-type biped robot has been mainly studied as one of the simplest models of humanoid robots. For example, theoretical analysis of passive walking [1] - [4] , researches associated with nonlinear mechanics such as Poincáre section and limit cycles [5] - [8] , gait pattern generation based on ZMP (zero- moment point) [9] - [11] , self-motivating acquirement of gaits by learning theory and evolutionary computing [12] - [15] . Generally, it is quite difficult to realize stable gaits for humanoid robots in terms of nonlinear problems, and hence there is still a lot of problems left to solve. In [16] - [19] , the authors have studied gait generation problems for the compass-type biped robot based on discrete mechanics, which is a new discretizing tool for nonlinear mechanical systems and is derived by discretization of basic principles and equations of classical mechanics [20] - [23] . It is known that a discrete model (the discrete Euler-Lagrange equations) in discrete mechanics has some interesting characteristics: 1) less numerical error in comparison with other numerical solutions such as Euler method and Runge-Kutta method; 2) it can describe energies for both conservative and dissipative systems with less errors; 3) some laws of physics such as Noether’s theorem are satisfied; 4) simulations can be performed for large sampling times. Hence, discrete mechanics has a possibility of analysis and controller synthesis with high compatibility with computers. The authors have developed a new blending approach of discrete mechanics and nonlinear optimization for gait generation problems on flats, slopes and irregular grounds [16] - [19] .

In this paper, we deal with an obstacle avoidance control problem for the compass-type biped robot via discrete mechanics. The contents of this paper is as follows. In Section 2, some fundamental concepts on discrete mechanics are summed up. Next, we derive the continuous and discrete compass-type biped robots based on both continuous and discrete mechanics, respectively in Section 3. Then, in Section 4, we formulate an obstacle avoidance control problem for the discrete compass-type biped robot and propose a solving method of it by the sequential quadratic programming to calculate a discrete control input. Furthermore, a transformation method from a discrete control input into a continuous zero-order hold input based on discrete Lagrange- d’Alembert principle is developed. In Section 5, we show some numerical simulations for the continuous compass-type biped robot in order to confirm the effectiveness of our method. Finally, we make a conclusion in Section 6.

2. Discrete Mechanics

This section summarizes fundamental concepts of discrete mechanics. See [16] - [28] for more details. Let Q be an n-dimensional configuration manifold and be a generalized coordinate of Q. We also refer to

as the tangent space of Q at a point and denotes a generalized velocity. Moreover, we consider a time-invariant Lagrangian as. We first explain about the discretization method. The time variable is discretized as by using a sampling interval. We denote as a point of Q at the time step k, that is, a curve on Q in the continuous setting is represented as a sequence of points in the discrete setting. The transformation method of discrete mechanics is carried out by the replacement:

(1)

where q is expressed as a internally dividing point of and with an internal division ratio We then define a discrete Lagrangian:

(2)

and a discrete action sum:

(3)

Next, the discrete equations of motion is summarized. Consider a variation of points on Q as with the fixed condition as shown in Figure 1. In analogy with the continuous setting, we define a variation of the discrete action sum (3) as

(4)

Figure 1. Discrete variations and discrete Hamilton’s principle.

The discrete Hamilton’s principle states that only a motion which makes the discrete action sum (3) stationary is realized. Calculating (4), we have

(5)

where and denotes the partial differential operators with respect to the first and second arguments, respectively. Consequently, from the discrete Hamilton’s principle and (5), we obtain the discrete Euler- Lagrange equations:

(6)

with the initial and terminal equations:

(7)

It turns out that (6) is represented as difference equations which contains three points, and we need as initial conditions when we simulate (6).

Then, we consider a method to add external forces to the discrete Euler-Lagrange equations. By an analogy of continuous mechanics, we denote discrete external forces by, and discretize conti- nuous Lagrange-d’Alembert’s principle as

(8)

where we define right/left discrete external forces: as

(9)

respectively. By right/left discrete external forces, a continuous external force can be discretized as

(10)

Calculating variations for (8), we obtain the discrete Euler-Lagrange equations with discrete external forces:

(11)

with the initial and terminal equations:

(12)

3. Compass-Type Biped Robot

3.1. Setting of Compass-Type Biped Robot

In this subsection, we first give a problem setting of the compass-type biped robot. In this paper, we consider a simple compass-type biped robot which consists of two rigid bars (Leg 1 and 2) and a joint without rotational friction (Waist) as shown in Figure 1. In Figure 2, Leg 1 is called the swing leg which is ungrounded and Leg 2 is called the supporting leg which connects to the ground. Moreover, for the sake of simplicity, we give the following assumptions; 1) the supporting leg does not slip at the contact point with the ground, 2) the swing leg hits the ground with completely inelastic collision, 3) the compass-type biped robot is supported by two legs for just a moment, 4) the length of the swing leg gets smaller by infinitely small when the swing leg and the supporting leg pass each other. Let and be the angles of Leg 1 and 2, respectively. We also use the notations: m: the mass of the legs, M: the mass of the waist, I: the inertia moment of the legs, a: the length between the center of gravity and the toe of the leg, b: the length between the waist and the center of gravity,: the length between the waist and the toe of the leg.

3.2. Continuous Compass-Type Biped Robot (CCBR)

This subsection derives a model of continuous compass-type biped robot (CCBR) by using usual continuous mechanics. Denote the angles of Leg 1 and 2 by, respectively, and assume that Leg 1 is the swing leg and Leg 2 is the supporting leg. In addition, denote their angular velocities.

We now derive a model of the CCBR. We assume that the torque at the waist can be controlled, and denote it by. The Lagrangian of this system is given by

(13)

Substituting the Lagrangian (13) into the Euler-Lagrange equations and adding the control input to the right-hand sides of them, we have the model of the CCBR as

(14)

(15)

Figure 2. Compass-type biped robot.

3.3. Discrete Compass-Type Biped Robot (DCBR)

Next, we derive a model of discrete compass-type biped robot (CCBR) via discrete mechanics in this subsection. We here use the notations; h: the sampling time;: the time step;: the internal division ratio in discrete mechanics;: the angles of Leg 1 and 2 at the k-th step.

In this paper, we use only the model of the DCBR in the swing phases, and hence we will derive it. By using the transformation law from a continuous Lagrangian into a discrete Lagrangian (2), we obtain the discrete Lagrangian as

(16)

from (13). Since the left and right discrete external forces (9) satisfy for, we set a discrete control input that consists of only the left discrete external force as

(17)

Then, substituting (13) and (16) into the discrete Euler-Lagrange Equation (11) and the initial and terminal Equations (12), and adding the discrete control input (17) to these systems, we have the model of the DCBR as

(18)

(19)

(20)

(21)

(22)

(23)

It is noted that the detailed model of the CCBR can be derived by calculating (18)-(23) with (13) and (16).

4. Obstacle Avoidance Control

4.1. Setting on Circular Obstacle

In this subsection, we first give the problem setting of circular obstacles. As shown in Figure 3, we set the x and z axes to the horizontal and vertical directions, respectively, and O denotes the origin of the xz-plane. In the xz- plane, as a obstacle for the robot, we consider a semicircular region

(24)

where is the center of a circle and is a radius of a circle. We call the resion (24) a circular obstacle.

In addition, we set a point P as a desired grounding point for the swing leg of the robot. Based on the setting above, we consider the following problem on the gait generation for the compass-type biped robot.

Problem 1: For the continuous compass-type biped robot (CCBR) (14), (15), we find a control input v such that the swing leg of the CCBR lands at a desired grounding point P with avoiding collision with a circular obstacle.

Figure 3. Circular obstacle.

The initial and desired states of the CCBR are illustrated in Figure 4. Moreover, an illustration of obstacle avoidance control for the CCBR is depicted in Figure 5.

In order to solve Problem 1 above, a new method based on discrete mechanics will be developed. The method consists of the two steps: 1) calculation of a discrete control input by solving a finite dimensional constrained nonlinear optimization problem (Subsection 4.2); 2) transformation of a discrete control input into a zero-order hold input by discrete Lagrange-d’Alembert principle (Subsection 4.3).

4.2. Discrete Gait Generation Problem

Next, we consider an obstacle avoidance control problem of a discrete gait for the DCBR instead of the CCBR. The discrete obstacle avoidance control problem for the DCBR is stated as follows.

Problem 2: For the discrete compass-type biped robot (DCBR) (18)-(23), we find a sequence of the control input such that the swing leg of the DCBR lands at a reference grounding point P with avoiding collision with a circular obstacle.

Before formulation of Problem 2, we have to consider a condition on collision with a circular obstacle. The following theorem gives us a condition such that collision with a circular obstacle does not occur for the CCBR.

Theorem 1: If the next inequality

(25)

holds, then the swing leg of the CCBR does not collide the circular obstacle.

(Proof) From Figure 1, it turns out that all the point on the swing leg can be represented by

(26)

with a parameter s satisfying. Now, we denote the point (26) by. A sufficient condition such that the swing leg of the CCBR does not collide the circular obstacle is that the distance between and P is equal to or more than. Therefore, we can obtain the inequality condition (25).

When we implement the inequality condition (25) for numerical simulations, we have to make a modification for discretization. Hence, (25) is modified as

(27)

where S is the number of s. That is to say, we check the inequality condition for a finite number of s. Then, Problem 2 can be formulated as the following nonlinear optimization problem:

(28)

(29)

(30)

Figure 4. Initial and desired states.

Figure 5. Obstacle avoidance control for CCBR.

In the formulation above, (28) is a cost function on a sum of square of a discrete control input. We can see that the optimization control problem (28)-(30) is represented as a finite dimensional constrained nonlinear optimization problem with respect to the variables:. Therefore, we can solve it by the sequential quadratic programming [23] [29] [30] , and obtain a sequence of discrete control input.

4.3. Transformation to Continuous Zero-Order Hold Input

In the previous subsection, we show a synthesis method of a discrete control input for the DCBR by solving a finite dimensional constrained nonlinear optimization problem. However, the obtained discrete control input cannot be utilized for the CCBR. So, we here consider transformation of a discrete control input into a con- tinuous one.

There exist infinite methods to generate a continuous control input from a given discrete one, and a conti- nuous control input generated from a given discrete input has to be consistent with laws of physics. Hence, in this paper, we deal with a zero-order hold input in the form:

(31)

which is one of the simplest continuous inputs. We need to derive a relationship between a discrete input and a zero-order hold input (31). By using discrete Lagrange-d’Alembert’s principle which is explained in Section 2, we can obtain the following theorem.

Theorem 2: A zero-order hold input (31) that satisfies discrete Lagrange-d’Alembert’s principle is given by

(32)

(Proof) For the time interval, substituting (17) and (31) into the definition of the left discrete external force in (9):

we obtain

Hence, we can have (32).

By using (32) in Theorem 2, we can easily calculate a zero-order hold input from which are obtained by solving a finite dimensional constrained nonlinear optimization problem (28)-(30). In addition, it must be noted that since we use discrete Lagrange-d’Alembert’s principle to prove Theorem 1, a zero-order hold input with a gain (32) is consistent with laws of physics.

5. Simulations

In this section, we shall carry out some numerical simulations on continuous gait generation on slopes for the CCBR via the method proposed in the previous section, and confirm the effectiveness of our method. First, the problem setting is given. we set parameters as follows; parameters of the DCBR and the CCBR: , and other parameters: .

We set data of a circular obstacle as. Parameters on gait generation are set as and . Intial states are , and desired states are .

Figures 6-9 show the simulation results. Figure 6 illustrates the time series of Leg 1 and 2 (and). Figure 7 shows the plot of solution trajectory in the phase space of. The time series of the continuous control input is shown in Figure 8. In Figure 9, a snapshot of the continuous gait is depicted. From these results, it can be confirmed that the control purpose on obstacle avoidance control is achieved by the proposed approach. It is noted that we ignore collision with the ground in the simulations, however, it can be avoided by adding a constraint to the optimization problem (28)-(30).

Figure 6. Time series of θ and φ.

Figure 7. Solution trajectory on θφ-space.

Figure 8. Time series of control input.

Figure 9. Snapshot of gait.

6. Conclusions

This paper has developed a new approach to circular obstacle avoidance control for the compass-type biped robot from the view points of discrete mechanics and nonlinear optimization. Simulation results have shown that a gait that does not collide a circular obstacle can be generated, and hence we have confirmed the effectiveness of our new approach.

Our future work on control of humanoid robots via discrete mechanics includes the following themes: 1) extensions to various obstacles; 2) experimental evaluation of the proposed control method; 3) applications of discrete mechanics to more human-like robots and systems represented by partial differential equations.

Cite this paper

TatsuyaKai, (2015) Circular Obstacle Avoidance Control of the Compass-Type Biped Robot Based on a Blending Method of Discrete Mechanics and Nonlinear Optimization. *International Journal of Modern Nonlinear Theory and Application*,**04**,179-189. doi: 10.4236/ijmnta.2015.43013

References

- 1. McGeer, T. (1990) Passive Dynamic Walking. The International Journal of Robotics Research, 9, 62-82.

http://dx.doi.org/10.1177/027836499000900206 - 2. Goswami, A., Thuilot, B. and Espiau, B. (1998) A Study of the Passive Gait of a Compass-like Biped Robot: Symmetry and Chaos. The International Journal of Robotics Research, 17, 1282-1301.

http://dx.doi.org/10.1177/027836499801701202 - 3. Collins, S.H., Ruina, A., Tedrake, R. and Wisse, M. (2005) Efficient Bipedal Robots based on Passive-Dynamic Walkers. Science, 307, 1082-1085. http://dx.doi.org/10.1126/science.1107799
- 4. Hass, J., Herrmann, J.M. and Geisel, T. (2006) Optimal Mass Distribution for Passivity-based Bipedal Robots. The International Journal of Robotics Research, 25, 1087-1098.

http://dx.doi.org/10.1177/0278364906072449 - 5. Goswami, A., Espiau, B. and Keramane, A. (1997) Limit Cycles in a Passive Compass Gait Biped and Passivity Mimicking Control Laws. Autonomous Robots, 4, 273-286.

http://dx.doi.org/10.1023/A:1008844026298 - 6. Garcia, M., Chatterjee, A., Ruina, A. and Coleman, M.J. (1998) The Simplest Walking Model: Stability, Complexity, and Scaling. ASME Journal of Journal of Biomechanical Engineering, 120, 281-288.

http://dx.doi.org/10.1115/1.2798313 - 7. Grizzle, J.W., Abba, G. and Plestan, F. (2001) Asymptotically Stable Walking for Biped Robots: Analysis via Systems with Impulse Effects. IEEE Transactions on Automatic Control, 46, 51-64.

http://dx.doi.org/10.1109/9.898695 - 8. Hobbelen, D.G.E. and Wisse, M. (2008) Swing-Leg Retraction for Limit Cycle Walkers Improves Disturbance Rejection. IEEE Transactions on Robotics, 24, 377-389.

http://dx.doi.org/10.1109/TRO.2008.917002 - 9. Huang, Q., Yokoi, K., Kajita, S., Kaneko, K., Arai, H., Koyachi, N. and Tanie, K. (2001) Planning Walking Patterns for a Biped Robot. IEEE Transactions on Robotics and Automation, 17, 280-289.

http://dx.doi.org/10.1109/70.938385 - 10. Sardain, P. and Bessonnet, G. (2004) Forces Acting on a Biped Robot. Center of Pressure—Zero Moment Point. IEEE Transactions on Systems, Man, and Cybernetics, Part A: Systems and Humans, 34, 630-637.

http://dx.doi.org/10.1109/TSMCA.2004.832811 - 11. Erbatur, K. and Kurt, O. (2009) Natural ZMP Trajectories for Biped Robot Reference Generation. IEEE Transactions on Industrial Electronics, 56, 835-845. http://dx.doi.org/10.1109/TIE.2008.2005150
- 12. Taga, G., Yamaguchi, Y. and Shimizu, H. (1991) Self-Organized Control of Bipedal Locomotion by Neural Oscillators in Unpredictable Environment. Biological Cybernetics, 65, 147-159.

http://dx.doi.org/10.1007/BF00198086 - 13. Miller, W.T. (1994) Real-Time Neural Network Control of a Biped Walking Robot. IEEE Control Systems Magazine, 14, 41-48. http://dx.doi.org/10.1109/37.257893
- 14. Nakanishi, J., Morimoto, J., Endo, G., Cheng, G., Schaal, S. and Kawato, M. (2004) Learning from Demonstration and Adaptation of Biped Locomotion. Robotics and Autonomous Systems, 47, 79-91.

http://dx.doi.org/10.1016/j.robot.2004.03.003 - 15. Morimoto, J. and Atkeson, C.G. (2007) Learning Biped Locomotion Application of Poincare-Map-Based Reinforcement Learning. IEEE Robotics & Automation Magazine, 14, 41-51.

http://dx.doi.org/10.1109/MRA.2007.380654 - 16. Kai, T. and Shintani, T. (2011) A Discrete Mechanics Approach to Gait Generation for the Compass-Type Biped Robot. Nonlinear Theory and Its Applications, IEICE, 2, 533-547.
- 17. Kai, T. and Shintani, T. (2011) Discrete Mechanics Approach to Gait Generation for the Compass-Type Biped Robot. Proceedings of the 18th IFAC World Congress, Milano, 28 August 2011, 434-437. http://dx.doi.org/10.1587/nolta.2.533
- 18. Kai, T. and Shintani, T. (2011) A Gait Generation Method for the Compass-Type Biped Robot on Slopes via Discrete Mechanics. Proceedings of the 50th IEEE Conference CDC, Orlando, 12-15 December 2011, 675-681. http://dx.doi.org/10.1109/cdc.2011.6161060
- 19. Kai, T. and Shintani, T. (2012) Gait Generation on Periodically Unlevel Grounds for the Compass-Type Biped Robot via Discrete Mechanics. Proceedings of the International Conference MSC, Dubrovnik, 3-5 October 2012, 1374-1381.
- 20. Marsden, J.E., Patrick, G.W. and Shkoller, S. (1998) Multisymplectic Geometry, Variational Integrators and Nonlinear PDEs. Communications in Mathematical Physics, 199, 351-395.

http://dx.doi.org/10.1007/s002200050505 - 21. Kane, C., Marsden, J.E., Ortiz, M. and West, M. (2000) Variational Integrators and the Newmark Algorithm for Conservative and Dissipative Mechanical Systems. International Journal for Numerical Methods in Engineering, 49, 1295-1325.

http://dx.doi.org/10.1002/1097-0207(20001210)49:10<1295::AID-NME993>3.0.CO;2-W - 22. Marsden, J.E. and West, M. (2001) Discrete Mechanics and Variational Integrators. Acta Numerica, 10, 3571-5145. http://dx.doi.org/10.1017/S096249290100006X
- 23. Junge, O., Marsden, J.E. and Ober-Blöbaum, S. (2005) Discrete Mechanics and Optimal Control. Proceedings of the 16th IFAC World Congress, Praha, 4-8 July 2005, Paper No. We-M14-TO/3.
- 24. Bloch, A.M., Leok, M., Marsden J.E. and Zenkov, D.V. (2005) Controlled Lagrangians and Stabilization of the Discrete Cart-Pendulum System. Proceedings of the 44th IEEE Conference CDC-ECC, Seville, 12-15 December 2005, 6579-6584. http://dx.doi.org/10.1109/cdc.2005.1583218
- 25. Bloch, A.M., Leok, M., Marsden, J.E. and Zenkov, D.V. (2006) Controlled Lagrangians and Potential Shaping for Stabilization of the Discrete Mechanical Systems. Proceedings of the 45th IEEE Conference CDC, San Diego, 13-15 December 2006, 3333-3338. http://dx.doi.org/10.1109/cdc.2006.376695
- 26. Kai, T. (2012) Control of the Cart-Pendulum System Based on Discrete Mechanics—Part I: Theoretical Analysis and Stabilization Control. IEICE Transactions on Fundamentals of Electronics, Communications and Computer Sciences, E95-A, 525-533 http://dx.doi.org/10.1587/transfun.E95.A.525
- 27. Kai, T., Bito, K. and Shintani, T. (2012) Control of the Cart-Pendulum System based on Discrete Mechanics—Part II: Transformation to Continuous-Time Inputs and Experimental Verification. IEICE Transactions on Fundamentals of Electronics, Communications and Computer Sciences, E95-A, 534-541.

http://dx.doi.org/10.1587/transfun.E95.A.534 - 28. Kai, T. and Bito, K. (2014) A New Discrete Mechanics Approach to Swing-Up Control of the Cart-Pendulum System. Communications in Nonlinear Science and Numerical Simulation, 19, 230-244.

http://dx.doi.org/10.1016/j.cnsns.2013.05.021 - 29. Gurwitz, C.B. and Overton, M.L. (1989) Sequential Quadratic Programming Methods Based on Approximating a Projected Hessian Matrix. SIAM Journal on Scientific and Statistical Computing, 10, 631-653.
- 30. Nocedal, J. and Wright, S.J. (2006) Numerical Optimization. Springer, Berlin.