Matricies and transformation

Added matricies to the functions that need them for transformation. Also
fixed minor errors in main with int/float and a rotate/scale error.