FMT: cosmetic fixes, add python bindings, add to unit test for optimizing planners