rqt teach_in_handle and scene calibration (intermediate version)