Switched to float for setVel, added time step