velocity update is fixed

same results as reference output now for params_5x5.dat