Added some speed calculations
Fixed min stop distance