State space planning