Realized that simulation was not working: velocity peaked out at 30km/h. Changed algorithm back to non-iterative approach and it worked fine