There is a thread already about using focus to measure stuff - a measurement device. Like I said in the thread, focus on an N900 is very unprecise, basically it does one meter or over 5, which is insuficcient for any usable mapping, not to mention it doesn't reliably lock every time.

I think you need DSLR grade focusing to get what you want, if I understand what you want correctly.