If the robot is following a wall, it will proceed in the rightmost direction possible
Deleted an unused class
Initializing the destination so it can never be null. A bit of refactoring for clarity
Implemented the setting of waypoints. Currently this will not affect navigation because no soldiers are following the waypoints.
The soldiers initial location is the segment start so that it is never null.
corrected the direction checks
Added an check so a segment would not go to itself
Fixed the equals check
A soldier will try to follow a segment if it exists. When it reaches the segment destination it will try to continue to the eventual destination. There are a lot of places where followingWall is hardcoded, which is probably a bad sign.