Whisker Sensor Design for Three Dimensional Position Measurement in Robotic Assisted Beating Heart Surgery