OMPL Intermediate solution issue

[ksatyaki]

OMPL intermediate solutions are super weird and WRONG! Please see: this issue

Consequently, you might want to cherry-pick (ksatyaki@0a4ad1a) for just the one file.

Thanks,
Chittaranjan