Dynamic registration and high speed visual servoing in robot-assisted surgery door