Modify pathfinding to use straightened paths

In case someone finds this thread as well, this might get you started with a custom path finder class in Unreal Engine,

This one gives more details about how to implement three different solutions in C++,