Pull initial agent position out to caller. Add velocity controller.