Basic AffineMatrix4d

Still need to do the multiplication part. And change the filename.