Removed some unused variables. Removed the caching of get_int_vel_old since the improvement was small, the consumption of memory high and also was introducing a memory leak. We pass all the test cases.
Git forces me to commit again