Added Assert routine for debugging.
Added dynamic memory allocation routine.
Added a binary tree. (Deletion not properly tested yet)
Added Collision detection.