tests: Assert that coordinates are *almost* equal

Comparing floats for equality is never a good idea...
tests: Moved assert_waypoint() function to parent module
formats: Added SeeYouReader class