Robust Motion Estimation in Robotic Surgery on the Beating Heart