Jörg Kümpel, Jan Sparbert, Eberhard P. Hofer: Numerical path optimization for path planning with cell decomposition methods. ECC 2001: 1822-1827