added a few asserts.
Reduced rotation to a single matrix
Reading in from some PLY files.