[pg] Robustify the mapping for left, right ankles and wrist. Generate an exception if the bodies are not found.
[pg] Robustify the mapping for left, right ankles and wrist.
Generate an exception if the bodies are not found.

stack-of-tasks/sot-pattern-generator,stack-of-tasks/sot-pattern-generator