Bug for def safe_dist(x, timestep, amin, amax, dist_margin):

[owenliu-rdc]

I have a question about the code inside the function safe_dist(x, timestep, amin, amax, dist_margin) in kinematic_car.py. Should the code:

brake_min_dist = (abs(x[2]) + amax * timestep) * 2 / (2 amax) + dist_margin

be changed to:

brake_min_dist = (abs(x[2]) + amax * timestep) * 2 / (2 abs(amin)) + dist_margin

even though in the current code amax = abs(amin)

am i right？

[junzengx14]

@AkshayThiru Could you have a quick look on this? Thanks!