hi Tor,
is this thread somthing you are looking for?
then use the: Move diriction comand> until> until tool contact> get tcp pose video
i havn’t done it myself, so can’t help you futher, it is still on my wishlist to figure it out. so in case it worked for you, feel free to share 
Corné