Add matrix.py module to create common matrices used in 3D

Just to allow me to play around with the maths in numpy.