Preparation for scanning

-Changed some matrix multiplication so multiplying same types (e.g.
float w float, double w double)
-Preliminary code for testing scan (without laser)
-Mesh3d with VRML output for use with MeshLab