LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information