Add compute position method
Add compute distance method