TQueue and TSortMap improvements

TQueue supports growing; TSortMap uses TQueue to keep free list instead
of array.
Pre-allocate m_Index in TSortMap when InsertEmpty

Performance improvement
Bug fix