Login / Signup

Stochastic Extended LQR for Optimization-based Motion Planning Under Uncertainty.

Wen SunJur van den BergRon Alterovitz
Published in: IEEE transactions on automation science and engineering : a publication of the IEEE Robotics and Automation Society (2016)
We introduce a novel optimization-based motion planner, Stochastic Extended LQR (SELQR), which computes a trajectory and associated linear control policy with the objective of minimizing the expected value of a user-defined cost function. SELQR applies to robotic systems that have stochastic non-linear dynamics with motion uncertainty modeled by Gaussian distributions that can be state- and control-dependent. In each iteration, SELQR uses a combination of forward and backward value iteration to estimate the cost-to-come and the cost-to-go for each state along a trajectory. SELQR then locally optimizes each state along the trajectory at each iteration to minimize the expected total cost, which results in smoothed states that are used for dynamics linearization and cost function quadratization. SELQR progressively improves the approximation of the expected total cost, resulting in higher quality plans. For applications with imperfect sensing, we extend SELQR to plan in the robot's belief space. We show that our iterative approach achieves fast and reliable convergence to high-quality plans in multiple simulated scenarios involving a car-like robot, a quadrotor, and a medical steerable needle performing a liver biopsy procedure.
Keyphrases
  • healthcare
  • public health
  • mental health
  • high speed
  • minimally invasive
  • health insurance
  • magnetic resonance imaging
  • computed tomography
  • contrast enhanced
  • quality improvement
  • robot assisted