Add walking planning capability