added local test method in ConnectionManager for path finding - it can
be enabled with a flag in the manager
the PathFinder now skips the next waypoint if it is not really a
waypoint (bug if ShortestPathFinder returns a value near 0 instead of
zero - it is not necessary to send a "forward0" command)
distance to move is now checked before a turn command is send - makes
the path finding even faster
fixed bug in PathFinder - if the target waypoint was a waypoint before
the robot got the ball, a drop command was sent
further improvement of the test in ConnectionManager - the path finding
has still some problems, but in general it seams to work