Compile-able visualServo (not yet field tested)