Towards Active Tracking of Beating Heart Motion in the Presence of Arrhythmia for Robotic Assisted Beating Heart Surgery