Improve test of mower algorithm.
Fix bugs.
Test of PositionEntity equals function.