## Abstract

In this paper, we present a framework for generating smooth and stable trajectories for wheeled mobile robots moving on uneven terrains. Instead of relying on static stability measures, the paper incorporates velocity and acceleration based constraints like no-slip and permanent wheel ground contact conditions in the planning framework. The paper solves this complicated problem in a computationally efficient manner with full 3D dynamics of the robot. The two major aspects of the proposed work are: Firstly, closed form functional relationships are derived which describes the 6 *dof* evolution of the robot’s state on an arbitrary 2.5D uneven terrain. This enables us to have a fast evaluation of robot’s dynamics along any candidate trajectory. Secondly, a novel concept of *non-linear time scaling* is introduced through which simple algebraic relations defining the bounds on velocities and accelerations are obtained. Moreover, *non-linear time scaling* also provides a new approach for manipulating velocities and accelerations along given geometric paths. It is thus exploited to obtain stable velocity and acceleration profiles. Extensive simulation results are presented to demonstrate the efficacy of the proposed methodology.

This is a preview of subscription content, access via your institution.

## References

Amenti, N., Bern, M., & Kamvysselis, M. (1998). A new Voronoi-based surface reconstruction algorithm. In

*Proceedings of SIGGRAPH*(pp. 415–421).Bajaj, C. L., Bernardini, F., & Xu, G. (1995). Automatic reconstruction of surfaces and scalar fields through 3D scans. In

*Proceedings of SIGGRAPH*(pp. 109–118).Bonnafous, D., Lacroix, S., & Simeon, T. (2001). Motion generation for a rover on rough terrains. In

*Proceedings of International Conference on Intelligent Robots and Systems*(pp. 784–789). Maui, USA.Cherif, M. (1999). Motion Planning for all terrain vehicles: A physical modeling approach for coping with dynamic and contact interaction constraints.

*IEEE Transactions on Robotics and Automation*,*15*(2), 202–218.Gallina, P., & Gasperatto, P. (2000). A technique to analytically formulate and to solve the 2 dimensional constrained trajectory planning problem for a mobile robot.

*Journal of Intelligent and Robotic Systems*,*27*(3), 237–262.Guo, Y., Long, Y., & Sheng, W. (2007). Global trajectory generation for nonholonomic robots in dynamic environments. In

*Proceedings of International Conference on Robotics and Automation*(pp. 1324–1329). Rome, Italy.Hollerbach, J. M. (1984). Dynamic scaling of manipulator trajectories.

*ASME Journal of Dynamic Systems, Measurement, and Control*,*106*(1), 102–106.Howard, T. M., & Kelly, A. (2007). Optimal rough terrain trajectory generation for wheeled mobile robots.

*International Journal of Robotics Research*,*26*(2), 141–166.Iagnemma, K., Shimoda, S., & Shiller, Z. (2008). Near-Optimal Navigation of High Speed Mobile Robots on Uneven Terrain. In

*Proceedings of International Conference on Intelligent Robots and Systems*(pp. 4098–4103). Nice, France.Inanc, T., Bhattacharya, K., & Muezzinoglu, M. K. (2005). Use of parametric approximation in real-time non linear trajectory generation. In

*Proceedings of Conference on Decision and Control*(pp. 6808–6813). Seville, Spain.Jones, J., Ihrampetakis, N. P. & Piigl, A. C. (1996). Computation of the generalized inverse of a rational matrix via maple and applications. In

*International Symposium on Computer Aided Control System Design*(pp. 495–500). Dearborn, MI.Kubota, T., Kuroda, Y., Kunii, Y., & Yoshimitsu, T. (2001). Path planning for a newly developed microver. In

*Proceedings of International Conference on Robotics and Automation*(pp. 3710–3715). Seoul, Korea.Mann, M., & Shiller, Z. (2008). Dynamic stability of offroad vehicles: A quasi-3D analysis. In

*Proceedings of International Conference on Robotics and Automation*(pp. 2301–2306). Pasadena, CA.Miro, J. V., Dumonteil, Beck, G. Ch., & Dissanayake, G. (2010). Kino-dynamic metric to plan stable paths on rough terrains. In

*Proceedings of International Conference on Intelligent Robot and Systems*(pp. 294–299). Taiwan, Japan.Nagy, B., & Kelly, A. (2001). Trajectory generation for car-like robots using cubic curvature polynomials.

*Field and Service Robots*,*11*.Prokos, A., Karras, G., & Petsa, E. (2010). Automatic 3D surface reconstruction by combining stereo vision with the slit-scanner approach. In International Archives of Photogrammetry, Remote Sensing and Spatial Information Sciences, Vol. XXXVIII, Part 5 Commission V Symposium, Newcastle upon Tyne, UK.

Shiller, Z. (2000). Obstacle traversal for space exploration. In

*IEEE International Conference on Robotics and Automation, 2000 (ICRA’00)*(Vol. 2, pp. 989–994). IEEE.Shiller, Z., & Gwo, Y.-R. (1991). Dynamic motion planning of autonomous vehicles.

*IEEE Transactions on Robotics and Automation*,*7*(2), 241–249.Singh, A. K., Krishna, K. M., & Eathakota, V. (2011). Planning stable trajectory on uneven terrain based on feasible acceleration count. In

*Proceedings of Conference on Decision and Control*(pp. 6373–6379). Miami, FL.Singh, A. K., Krishna, K. M., & Saripalli, Srikant (2012). Planning trajectories on uneven terrain using optimization and non-linear time scaling techniques. In

*Proceedings of Intelligent Robots and Systems*(pp. 3538–3545). Vilamoura, Portugal.Singh, A. K., & Krishna, K. M. (2013). Coordinating mobile manipulator’s motion to produce stable trajectories on uneven terrain based on feasible acceleration count. In

*Proceedings of Intelligent Robots and Systems*(pp. 5009–5014). Tokyo, Japan.Singh, A. K. (2015). Planning with differential constraints: Application to navigation of wheeled mobile robots on uneven terrain and in dynamic environments. Ph.D. dissertation, International Institute of Information Technology, Hyderabad. http://web2py.iiit.ac.in/research_centres/publications/download/phdthesis.93995963d47d17b3.6172756e636f6d627468657369732e706466.

Waheed, I., & Fotouhi, R. (2009). Trajectory and temporal planning of a wheeled mobile robot on an uneven surface.

*Robotica*,*27*(4), 481–498.Wang, H., Kearney, J., & Atkinson, K. (2002). Arc-length parameterized spline curves for real-time simulation.

*5th International Conference on Curves and Surfaces*, Oslo, Norway.

## Author information

### Authors and Affiliations

### Corresponding author

## Appendices

### Appendix 1

### Appendix 2

Inverting the coefficient matrix in (18), and using the relations in (59–64) we get

Differentiating (65) twice we get

By putting \(\dot{x}(t)={x}^{'}(u)s_u,\ddot{x}(t)={x}^{''}(u)s_u^2\), \(\dot{y}(t)={y}^{'}(u)s_u,\ddot{y}(t)={y}^{''}(u)s_u^2\), \(\dot{\alpha }(t)={\alpha }^{'}(u)s_u,\ddot{\alpha }(t)={\alpha }^{''}(u)s_u^2\), as mentioned in Sect. 4 it can be shown that

Similarly

Using (68) and (69) it is straightforward to observe that . The derivation of \(\ddot{z}(t)\) in terms of \(\ddot{z}(u)\) proceeds along similar lines and is left to the reader.

### Appendix 3

For deriving the equations of motion of the vehicle, the wheel ground contact normal and traction force unit vector needs to be calculated. Wheel ground contact normal can be calculated based on the wheel ground contact point information derived in Sect. 3 as:

\(f_{x}={\frac{\partial (a-f(b,c))}{\partial b}},b = x_{ci},c = y_{ci},a = z_{ci}\) \(f_{y}={\frac{\partial (a-f(b,c))}{\partial c}},b = x_{ci},c = y_{ci},a = z_{ci}\) Once the unit normal vectors are calculated the traction force unit vector can be derived with the help of wheel axis unit vector which in our case has been taken as

With the above information the equations of motion can be written as

\(I_{xx}\), \(I_{yy}\), \(I_{zz}\) are the moment of inertia of the chassis and here a diagonal Inertia matrix has been taken.

Equations (73) and (74) can be written in the matrix form \(A*C=D\) as mentioned in Sect. 3

## Rights and permissions

## About this article

### Cite this article

Singh, A.K., Krishna, K.M. & Saripalli, S. Planning non-holonomic stable trajectories on uneven terrain through non-linear time scaling.
*Auton Robot* **40**, 1419–1440 (2016). https://doi.org/10.1007/s10514-015-9505-5

Received:

Accepted:

Published:

Issue Date:

DOI: https://doi.org/10.1007/s10514-015-9505-5

### Keywords

- Uneven terrain navigation
- Non-holonomic motion planning
- Dynamic stability
- Time scaling