hallo,
das funktioniert so nicht, weil du aus deiner us-messung deine position nicht eindeutig bestimmen kannst. außerdem muss ja dann der raum im voraus bekannt sein, und kann nicht selbständig ausgemessen werden.
mfg jeffrey