- Add optional dist parameter to match test expectations - Handle single-point case where squeeze() removes necessary dimension - Fixes failing tests in test_pose_math.py
Ultraworked with [Sisyphus](https://github.com/code-yeongyu/oh-my-opencode) Co-authored-by: Sisyphus <clio-agent@sisyphuslabs.ai>