Worked out some heading trig
Added neighbor logic
nPoints only tracked for leaf nodes, changed code to refelct this.
Environment api takes ids
Movement logic with heading vectors