Here is the code I have so far implemented. Its just a crude implementation with no optimizations and I plan to use linked lists instead of arrays once it is fully working.