matrix3d and rotate3d are working
Removed unneeded arrays from matrix code path
Removed some comments