Added validity bool cast for matrix & vector
Began rotation matrix function