Speed up bounding box checks. Fix warning in PickingController.  Added isIdentity to Matrix.