Tip servo control
Leverage strong prior on tip location

whenever the wrist rotates:
detect tip in image as
                 estimate probability is tip detection as

If                                              :
       initialize block-matching visual tracker at
 

estimate tip location         using closest point of          to tracker ray

substitute         for       in the open-loop controller