Added basic geometry

Added Sphere, Box and Capsule geometry. Getting ready to start on the
hull library.