Collision Complete

Got the collision working properly however still need to get the
pathfinding to work. Still unsure how to do it, but was messing around
with A* pathfinding.