Fix all indexes issue. Points correctly saved in leaves. Node id taken in order of need: now using 2*n-1 nodes.