Calc Distance to Reference Pose