Changed environment/robot updates to switch node type (code removed from tree before). Changed test accordingly; added GetNumKnownNodes()