Velocity regulation

Need to add look ahead for deceleration!
started jerk