Identy one object, working

A working model is now made that scans and marks the closest object,
seen by th lower sonar. Now this only need to be extended to the upper
one aswell