Implmemented get_closest_object

Mostly, still needs other parts