Updates to Vector3D and Matrix3D

Documentation for both Vector3D and Matrix3D added. Sugar methods for
both finalised.  Small issues surrounding operator overloading remain
before porting test cases.