Design, Motion Planning, And Control For Energy Sustainable Robotic Systems