Trie routing

- Adding some comments about what still needs to be done
- Switching to SmallIntMap instead of HashMap