angular DoF joints need better error logic around +/-PI

### Describe the bug

It is still breaking down when rotating "around the horn". 


### How to reproduce

virtualroom shows it

### Example code

```go

```

### Relevant output

```shell

```

### Platform

macOS