Added box intersect, fixed yaw/pitch/roll to quaternion calc.