Added horn method + extracted method for testing 3dpoints