Implement More Thuente line search
Currently, our NDT implementation uses a naive fixed step line search.
More Thuente line search is used in all other practical implementations of NDT. This method, or a superior line search method should be used instead.
The following should be done:
- Implement More Thuente line search
- Add tests
- Integrate with NDT