AC_PosControl: velocity controller init fix

Target position and velocity were not being set leading to a severe
twitch when the controller was engaged