Refactor point test and add randomly generated 2d points to test suite

Fixes #12, that headings were being computed wrong.
Merge pull request #22 from erget/12_heading_tests

Refactor point test and add randomly generated 2d points to test suite