It would be good if the position/orientation thresholds could be split up to be different in the X/Y/Z/roll/pitch/yaw directions. This should be doable with some parameter changes.