More FM methods added

the path should not be an attribute of the planner, but a result. This should be deleted, following the same design as for FastMarching