Adding tests to geometry utils