Teams Added

Teams are added and functional. Also added a slight optimization to the
path finder.