Created Entity and body classes

Almost completed vector2D class. All that remains is to calculate the
bearing