Navigating a large-scaled robot in unknown and cluttered height-constrained environments is challenging. Not only is a fast and reliable planning algorithm required to go around obstacles, the robot should also be able to change its intrinsic dimension by crouching in order to travel underneath height-constrained regions. There are few mobile robots that are capable of handling such a challenge, and bipedal robots provide a solution. However, as bipedal robots have nonlinear and hybrid dynamics, trajectory planning while ensuring dynamic feasibility and safety on these robots is challenging. This paper presents an end-to-end autonomous navigation framework which leverages three layers of planners and a variable walking height controller to enable bipedal robots to safely explore height-constrained environments. A vertically actuated spring-loaded inverted pendulum (vSLIP) model is introduced to capture the robot’s coupled dynamics of planar walking and vertical walking height. This reduced-order model is utilized to optimize for long-term and short-term safe trajectory plans. A variable walking height controller is leveraged to enable the bipedal robot to maintain stable periodic walking gaits while following the planned trajectory. The entire framework is tested and experimentally validated using a bipedal robot Cassie. This demonstrates reliable autonomy to drive the robot to safely avoid obstacles while walking to the goal location in various kinds of height-constrained cluttered environments.
AnderssonJAEGillisJHornG, et al. (2018) CasADi – a software framework for nonlinear optimization and optimal control. Mathematical Programming Computation11: 1–36(In.
2.
ApgarTClaryPGreenK, et al. (2018) Fast online trajectory optimization for the bipedal robot cassie. Robotics: Science and Systems101: 14.
3.
BieglerLTZavalaVM (2009) Large-scale nonlinear programming using ipopt: an integrating framework for enterprise-wide dynamic optimization. Computers and Chemical Engineering33(3): 575–582.
4.
BuchananRWellhausenLBjelonicM, et al. (2021) Perceptive whole-body planning for multilegged robots in confined spaces. Journal of Field Robotics38(1): 68–84.
5.
CaronSEscandeALanariL, et al. (2019) Capturability-based pattern generation for walking with variable height. IEEE Transactions on Robotics36: 517–536.
6.
CaronSPhamQCNakamuraY (2016) Zmp support areas for multicontact mobility under frictional constraints. IEEE Transactions on Robotics33(1): 67–80.
7.
ChevallereauCGabrielAAoustinY, et al. (2003) Rabbit: a testbed for advanced control theory. IEEE Control Systems Magazine (CSM)23(5): 57–79.
8.
DaXHaribOHartleyR, et al. (2016) From 2d design of underactuated bipedal gaits to 3d implementation: walking with speed tracking. IEEE Access4: 3469–3478.
9.
DafarraSBertrandSGriffinRJ, et al. (2020) Non-linear trajectory optimization for large step-ups: application to the humanoid robot atlas. In: 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Las Vegas, NV, USA: IEEE, pp. 3884–3891.
10.
DaiHValenzuelaATedrakeR (2014) Whole-body motion planning with centroidal dynamics and full kinematics. In: 2014 IEEE-RAS International Conference on Humanoid Robots. Madrid, Spain: IEEE. pp. 295–302.
11.
DeitsRTedrakeR (2014) Footstep planning on uneven terrain with mixed-integer convex optimization. In: 2014 IEEE-RAS International Conference on Humanoid Robots. Madrid, Spain: IEEE. pp. 279–286.
12.
FankhauserPBellicosoCDGehringC, et al. (2016) Free gait—an architecture for the versatile control of legged robots. In: 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids). Cancun, Mexico: IEEE. pp. 1052–1058.
13.
FengSWhitmanEXinjilefuX, et al. (2015) Optimization-based full body control for the darpa robotics challenge. Journal of Field Robotics32(2): 293–312.
14.
FengSXinjilefuXAtkesonCG, et al. (2016) Robust dynamic walking using online foot step optimization. In: 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Daejeon, Korea (South): IEEE, pp. 5373–5378.
15.
FengSXinjilefuXHuangW, et al. (2013) 3d walking based on online optimization. In: 2013 13th IEEE-RAS International Conference on Humanoid Robots (Humanoids). Atlanta, GA, USA: IEEE, pp. 21–27.
16.
GaertnerMBjelonicMFarshidianF, et al. (2021) Collision-free MPC for legged robots in static and dynamic scenes. In 2021 IEEE International Conference on Robotics and Automation (ICRA), Xi'an, China: IEEE, pp. 8266–8272.
17.
GeyerHSeyfarthABlickhanR (2006) Compliant leg behaviour explains basic dynamics of walking and running. Proceedings of the Royal Society B: Biological Sciences273(1603): 2861–2867.
18.
GongYHartleyRDaX, et al. (2019) Feedback control of a cassie bipedal robot: walking, standing, and riding a segway. In: 2019 American Control Conference (ACC). Philadelphia, PA, USA: IEEE pp. 4559–4566.
19.
GreyMXAmesADLiuCK (2017) Footstep and motion planning in semi-unstructured environments using randomized possibility graphs. In: 2017 IEEE International Conference on Robotics and Automation (ICRA). Singapore: IEEE, pp. 4747–4753.
20.
GriffinRJWiedebachGMcCroryS, et al. (2019) Footstep planning for autonomous walking over rough terrain. In: 2019 IEEE-RAS 19th International Conference on Humanoid Robots (Humanoids). Toronto, ON, Canada: IEEE. pp. 9–16.
21.
GrizzleJWChevallereauCAmesAD, et al. (2010) 3d bipedal robotic walking: models, feedback control, and open problems. IFAC Proceedings Volumes43(14): 505–532.
22.
HartPENilssonNJRaphaelB (1968) A formal basis for the heuristic determination of minimum cost paths. IEEE Transactions on Systems Science and Cybernetics4(2): 100–107.
23.
HerdtADiedamHWieberPB, et al. (2010) Online walking motion generation with automatic footstep placement. Advanced Robotics24(5–6): 719–737.
24.
HereidAHaribOHartleyR, et al. (2019) Rapid trajectory optimization using c-frost with illustration on a cassie-series dynamic walking biped. In: 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Macau, China: IEEE. pp. 4722–4729.
25.
HildebrandtACKlischatMWahrmannD, et al. (2017) Real-time path planning in unknown environments for bipedal robots. IEEE Robotics and Automation Letters2(4): 1856–1863.
26.
HornungAWurmKMBennewitzM, et al. (2013) Octomap: an efficient probabilistic 3d mapping framework based on octrees. Autonomous Robots34(3): 189–206.
27.
HuangJKGrizzleJW (2023) Efficient anytime clf reactive planning system for a bipedal robot on undulating terrain. IEEE Transactions on Robotics39(6): 2093–2110.
28.
KajitaSKanehiroFKanekoK, et al. (2003) Biped walking pattern generation by using preview control of zero-moment point. In: 2003 IEEE International Conference on Robotics and Automation (Cat. No. 03CH37422). Taipei, Taiwan: IEEE, volume 2. pp. 1620–1626.
29.
KoolenTDe BoerTRebulaJ, et al. (2012) Capturability-based analysis and control of legged locomotion, part 1: Theory and application to three simple gait models. The International Journal of Robotics Research31(9): 1094–1113.
30.
KuffnerJJLaValleSM (2000) Rrt-connect: an efficient approach to single-query path planning proceedings 2000 icra. Millennium conference. In: IEEE International Conference on Robotics and Automation Symposia Proceedings (Cat. No. 00CH37065). San Francisco, CA, USA: IEEE, 2, pp. 995–1001.
31.
KuindersmaSDeitsRFallonM, et al. (2016) Optimization-based locomotion planning, estimation, and control design for the atlas humanoid robot. Autonomous Robots40(3): 429–455.
32.
KuindersmaSPermenterFTedrakeR (2014) An efficiently solvable quadratic program for stabilizing dynamic locomotion. In: 2014 IEEE International Conference on Robotics and Automation (ICRA). Hong Kong, China: IEEE, pp. 2589–2594.
33.
KumagaiIMorisawaMNakaokaS, et al. (2018) Efficient locomotion planning for a humanoid robot with whole-body collision avoidance guided by footsteps and centroidal sway motion. In: 2018 IEEE-RAS 18th International Conference on Humanoid Robots (Humanoids). Beijing, China: IEEE, pp. 251–256.
34.
KweonISHebertMKrotkovE, et al. (1989) Terrain mapping for a roving planetary explorer. In: 1989 IEEE International Conference on Robotics and Automation. Scottsdale, AZ, USA: IEEE, pp. 997–1002.
LabbéMMichaudF (2019) Rtab-map as an open-source lidar and visual simultaneous localization and mapping library for large-scale and long-term online operation. Journal of Field Robotics36(2): 416–446.
37.
LaValleSMKuffnerJJJr (2001) Randomized kinodynamic planning. The International Journal of Robotics Research20(5): 378–400.
38.
LeuteneggerSLynenSBosseM, et al. (2015) Keyframe-based visual–inertial odometry using nonlinear optimization. The International Journal of Robotics Research34(3): 314–334.
39.
LiZChengXPengXB, et al. (2021) Reinforcement learning for robust parameterized locomotion control of bipedal robots. In: 2021 IEEE International Conference on Robotics and Automation (ICRA). Xi'an, China: IEEE, pp. 2811–2817.
40.
LiZCummingsCSreenathK (2020) Animated cassie: a dynamic relatable robotic character. In: 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Las Vegas, NV, USA: IEEE, pp. 3739–3746.
41.
MastalliCFocchiMHavoutisI, et al. (2017) Trajectory and foothold optimization using low-dimensional models for rough terrain locomotion. In: 2017 IEEE International Conference on Robotics and Automation (ICRA). Singapore: IEEE. pp. 1096–1103.
42.
MotaharMSVeerSPoulakakisI (2016) Composing limit cycles for motion planning of 3d bipedal walkers. In: 2016 IEEE 55th Conference on Decision and Control (CDC). Las Vegas, NV, USA: IEEE, pp. 6368–6374.
43.
NguyenQAgrawalAMartinW, et al. (2018) Dynamic bipedal locomotion over stochastic discrete terrain. The International Journal of Robotics Research37(13–14): 1537–1553.
44.
PoulakakisIGrizzleJ (2007) Formal embedding of the spring loaded inverted pendulum in an asymmetric hopper. In: 2007 European Control Conference (ECC). Kos, Greece: IEEE, pp. 3159–3166.
45.
PrattJKoolenTDe BoerT, et al. (2012) Capturability-based analysis and control of legged locomotion, part 2: application to m2v2, a lower-body humanoid. The International Journal of Robotics Research31(10): 1117–1133.
46.
ReherJAmesAD (2021) Control Lyapunov Functions for Compliant Hybrid Zero Dynamic Walking. arXiv preprint arXiv:2107.04241.
47.
RummelJBlumYMausHM, et al. (2010) Stable and robust walking with compliant legs. In: 2010 IEEE International Conference on Robotics and Automation. Anchorage, AK, USA: IEEE. pp. 5250–5255.
48.
SaranlıUArslanÖAnkaralıMM, et al. (2010) Approximate analytic solutions to non-symmetric stance trajectories of the passive spring-loaded inverted pendulum with damping. Nonlinear Dynamics62(4): 729–742.
49.
SchulmanJDuanYHoJ, et al. (2014) Motion planning with sequential convex optimization and convex collision checking. The International Journal of Robotics Research33(9): 1251–1270.
50.
SreenathKParkHWPoulakakisI, et al. (2011) A compliant hybrid zero dynamics controller for stable, efficient and fast bipedal walking on mabel. International Journal of Robotics Research (IJRR)30(9): 1170–1193.
51.
TengSGongYGrizzleJW, et al. (2021) Toward Safety-Aware Informative Motion Planning for Legged Robots. arXiv preprint arXiv:2103.14252.
52.
TianYGaoF (2018) Efficient motion generation for a six-legged robot walking on irregular terrain via integrated foothold selection and optimization-based whole-body planning. Robotica36(3): 333–352.
53.
TonneauSDel PreteAPettréJ, et al. (2018) An efficient acyclic contact planner for multiped robots. IEEE Transactions on Robotics34(3): 586–601.
54.
VeerSMotaharMSPoulakakisI (2017) Almost driftless navigation of 3d limit-cycle walking bipeds. In: 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Vancouver, BC, Canada: IEEE, pp. 5025–5030.
55.
VeerSPoulakakisI (2019a) Safe adaptive switching among dynamical movement primitives: application to 3d limit-cycle walkers. In: 2019 International Conference on Robotics and Automation (ICRA). Montreal, QC, Canada: IEEE, pp. 3719–3725.
56.
VeerSPoulakakisI (2019b) Switched systems with multiple equilibria under disturbances: Boundedness and practical stability. IEEE Transactions on Automatic Control65(6): 2371–2386.
57.
VukobratovićMBorovacB (2004) Zero-moment point—thirty five years of its life. International Journal of Humanoid Robotics1(01): 157–173.
58.
XiongXAmesA (2022) 3-d underactuated bipedal walking via h-lip based gait synthesis and stepping stabilization. IEEE Transactions on Robotics38(4): 2405–2425.
59.
XiongXAmesAD (2018) Bipedal hopping: reduced-order model embedding via optimization-based control. In: 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). Madrid, Spain: IEEE. pp. 3821–3828.
60.
XiongXReherJAmesAD (2021) Global position control on underactuated bipedal robots: step-to-step dynamics approximation for step planning. In: 2021 IEEE International Conference on Robotics and Automation (ICRA). Xi'an, China: IEEE, pp. 2825–2831.
61.
ZengJZhangBSreenathK (2021) Safety-critical model predictive control with discrete-time control barrier function. In: 2021 American Control Conference (ACC). New Orleans, LA, USA: IEEE. pp. 3882–3889.
62.
ZuckerMRatliffNDraganAD, et al. (2013) Chomp: covariant hamiltonian optimization for motion planning. The International Journal of Robotics Research32(9–10): 1164–1193.
