fix for second-order kinodynamic benchmarks