path planning ready for debug?