Development of a camera based robot teach tool