More attributes of RoutePoint moved to private.
Resolved FIXMEs: resolved code duplication and replaced code with std algorithm.