Completed
Add unit testing for complex logic parts
Specifically, the geometry math and selection logic
Specifically, the geometry math and selection logic