Assessment of the Effect of Energy Consumption on Trajectory Improvement for a Car-like Robot