added functions

added wait function and VisionStepper::foundTargetSpeed