Modified human safety signal to operate at a specified frequency and not be determined by the human estimation. Quaternion error fixed for human estimation.
Looks at both end-effector and base to decide whom to track.