Major update. Mainly switched to Isometry3f from Isometry3d, etc.