Another proggy update.
Now it work in 3d (I hope).
On attached image there's BARN. Starting point is marked blue on level2, destination point is purple on level2.
Unit goes up, then over the roof, down to barn entrance, then to the stairs, and towards destination point.
It don't know anything about lifts yet, and Stairs don't work as they should (they don't make any inter-level switch), and max elevation is not implemented. But I think it's not that hard to do.
==Addition:==
Application is uploaded. You can use any of your xcom1 maps (from battlescape savegames, just replace contents of /game with appropriate /GAME_XX).