Fix out of bounds access in test
Add obb closesPointTo