Almost complete

Still needs a function to get the transformation matrix.