Added Point2D class

Encapsulated the positions and velocities into a Point2D class, this
provides getters and setters as expected and a function to add or
subtract two points together.