Finish line;

Only need to detect end point and generate right path;
Tests;
Bugfix;