update step
removed debugger statment.
modified to calc velocity.