Fix Path being choppy with small theta difference between segments
#7486
| Job | Run time |
|---|---|
| 4m 42s | |
| 2m 56s | |
| 3m 48s | |
| 11m 32s | |
| 7m 55s | |
| 5m 50s | |
| 4m 47s | |
| 6m 46s | |
| 7m 30s | |
| 4m 27s | |
| 5m 55s | |
| 1h 6m 8s |