Ejemplo n.º 1
0
    void Start()
    {
        inter = new intersector();
        //test cube pool
        pool       = new DCube_pool();
        dCube_rays = new List <DCube_Ray>();
        //camera rays
        cam = this.gameObject.GetComponent(typeof(Camera)) as Camera;
        // print("cam wolr position :" +cam.transform.position);


        w_rays = 10;
        h_rays = (int)((float)w_rays * cam.pixelHeight / cam.pixelWidth);

        cam_rays = new List <AB_RAY>();
        for (int i = 0; i < h_rays; i++)
        {
            //need to create the last ray at right edge
            for (int j = 0; j < w_rays; j++)
            {
                //create ray at correct gap
                Ray        myRay    = cam.ViewportPointToRay(new Vector3(1.0f / (w_rays - 1) * j, 1.0f / (h_rays - 1) * i, 0));
                GameObject A_object = new GameObject();
                A_object.transform.position = myRay.origin;
                Vector3    B        = (myRay.origin - cam.transform.position) * cam.farClipPlane / cam.nearClipPlane + cam.transform.position;
                GameObject B_object = new GameObject();
                B_object.transform.position = B;
                // DCube fc = pool.getDCube();
                // fc.position = B;
                // fc.setParent(cam.transform);

                // DCube nc = pool.getDCube();
                // nc.position = myRay.origin;
                // nc.setParent(cam.transform);

                AB_RAY cam_ab_ray = new AB_RAY(A_object.transform, B_object.transform);
                cam_rays.Add(cam_ab_ray);
            }
        }

        //test the cube is a obb or aabb
        if (is_aabb)
        {
            aabb = new AABB(test_cube);
            //debug cubes for a ray
            dcubes = new DCube_Ray(pool);
        }
        else
        {
            obb = new OBB(test_cube);
            //debug cubes for a ray
            dcubes = new DCube_Ray(pool);
        }

        //create ray
        ab_ray = new AB_RAY(cam.transform, GetComponent <Transform>().Find("cam_ray_handeler"));
        //ray march parameters
        max_distance = cam.farClipPlane - cam.nearClipPlane;
        step_size    = max_distance / max_steps;
    }
Ejemplo n.º 2
0
    public void obb_intersection(AB_RAY _ray, OBB _box, DCube_Ray _dcubes)
    {
        Vector3 min_inter, max_inter;  // intersection point
        bool    min_exist, max_exist;

        Vector3 ray_min = _box.min - _ray.PA.position;
        Vector3 ray_max = _box.max - _ray.PA.position;

        Vector3 xyz_sclae_min;
        Vector3 xyz_sclae_max;

        //full ray on x , y , z value
        Vector3 ray_projected = new Vector3(Vector3.Dot(_box.x_axis, _ray.fullRay), Vector3.Dot(_box.y_axis, _ray.fullRay), Vector3.Dot(_box.z_axis, _ray.fullRay));

        ray_projected.x = ray_projected.x == 0?0.0000001f : ray_projected.x;
        ray_projected.y = ray_projected.y == 0?0.0000001f : ray_projected.y;
        ray_projected.z = ray_projected.z == 0?0.0000001f : ray_projected.z;

        float _x1 = Vector3.Dot(_box.x_axis, ray_min) / ray_projected.x;
        float _x2 = Vector3.Dot(_box.x_axis, ray_max) / ray_projected.x;

        xyz_sclae_min.x = _x1 < _x2 ? _x1 : _x2;
        xyz_sclae_max.x = _x1 > _x2 ? _x1 : _x2;

        float _y1 = Vector3.Dot(_box.y_axis, ray_min) / ray_projected.y;
        float _y2 = Vector3.Dot(_box.y_axis, ray_max) / ray_projected.y;

        xyz_sclae_min.y = _y1 < _y2 ? _y1 : _y2;
        xyz_sclae_max.y = _y1 > _y2 ? _y1 : _y2;

        float _z1 = Vector3.Dot(_box.z_axis, ray_min) / ray_projected.z;
        float _z2 = Vector3.Dot(_box.z_axis, ray_max) / ray_projected.z;

        xyz_sclae_min.z = _z1 < _z2 ? _z1 : _z2;
        xyz_sclae_max.z = _z1 > _z2 ? _z1 : _z2;

        float min_scale = Mathf.Max(Mathf.Max(xyz_sclae_min.x, xyz_sclae_min.y), xyz_sclae_min.z);
        float max_scale = Mathf.Min(Mathf.Min(xyz_sclae_max.x, xyz_sclae_max.y), xyz_sclae_max.z);

        min_exist = false;
        max_exist = false;

        if (min_scale < max_scale)
        {
            if (min_scale > 0 && min_scale < 1)
            {
                min_exist = true;
            }

            if (max_scale > 0 && max_scale < 1)
            {
                max_exist = true;
            }
        }

        //debug info display
        _dcubes.p0.position = _ray.PA.position + min_scale * _ray.fullRay;
        _dcubes.p1.position = _ray.PA.position + max_scale * _ray.fullRay;
        _dcubes.x0.position = _ray.PA.position + xyz_sclae_min.x * _ray.fullRay;
        _dcubes.x1.position = _ray.PA.position + xyz_sclae_max.x * _ray.fullRay;
        _dcubes.y0.position = _ray.PA.position + xyz_sclae_min.y * _ray.fullRay;
        _dcubes.y1.position = _ray.PA.position + xyz_sclae_max.y * _ray.fullRay;
        _dcubes.z0.position = _ray.PA.position + xyz_sclae_min.z * _ray.fullRay;
        _dcubes.z1.position = _ray.PA.position + xyz_sclae_max.z * _ray.fullRay;
        if (!min_exist)
        {
            _dcubes.p0.release();
        }
        else
        {
            _dcubes.p0.use();
        }
        if (!max_exist)
        {
            _dcubes.p1.release();
        }
        else
        {
            _dcubes.p1.use();
        }
    }
Ejemplo n.º 3
0
    public inter_point obb_intersection_cube(AB_RAY _ray, OBB _box, DCube_Ray _dcubes)
    {
        Vector3 _PA_pos_cube = _box.w2o.MultiplyPoint3x4(_ray.PA.position);
        Vector3 _PB_pos_cube = _box.w2o.MultiplyPoint3x4(_ray.PB.position);

        //object space
        Vector3 ray_full = _PB_pos_cube - _PA_pos_cube;
        Vector3 min_inter, max_inter;  // intersection point
        bool    min_exist, max_exist;

        Vector3 ray_min = _box.min_o - _PA_pos_cube;
        Vector3 ray_max = _box.max_o - _PA_pos_cube;

        Vector3 xyz_sclae_min;
        Vector3 xyz_sclae_max;

        //full ray on x , y , z value
        Vector3 ray_projected = new Vector3(ray_full.x, ray_full.y, ray_full.z);

        ray_projected.x = ray_projected.x == 0?0.0000001f : ray_projected.x;
        ray_projected.y = ray_projected.y == 0?0.0000001f : ray_projected.y;
        ray_projected.z = ray_projected.z == 0?0.0000001f : ray_projected.z;

        float _x1 = ray_min.x / ray_projected.x;
        float _x2 = ray_max.x / ray_projected.x;

        xyz_sclae_min.x = _x1 < _x2 ? _x1 : _x2;
        xyz_sclae_max.x = _x1 > _x2 ? _x1 : _x2;

        float _y1 = ray_min.y / ray_projected.y;
        float _y2 = ray_max.y / ray_projected.y;

        xyz_sclae_min.y = _y1 < _y2 ? _y1 : _y2;
        xyz_sclae_max.y = _y1 > _y2 ? _y1 : _y2;

        float _z1 = ray_min.z / ray_projected.z;
        float _z2 = ray_max.z / ray_projected.z;

        xyz_sclae_min.z = _z1 < _z2 ? _z1 : _z2;
        xyz_sclae_max.z = _z1 > _z2 ? _z1 : _z2;

        float min_scale = Mathf.Max(Mathf.Max(xyz_sclae_min.x, xyz_sclae_min.y), xyz_sclae_min.z);
        float max_scale = Mathf.Min(Mathf.Min(xyz_sclae_max.x, xyz_sclae_max.y), xyz_sclae_max.z);

        //two intersect point in object space
        Vector3 p0_o = _PA_pos_cube + Mathf.Max(Mathf.Max(xyz_sclae_min.x, xyz_sclae_min.y), xyz_sclae_min.z) * ray_full;
        Vector3 p1_o = _PA_pos_cube + Mathf.Min(Mathf.Min(xyz_sclae_max.x, xyz_sclae_max.y), xyz_sclae_max.z) * ray_full;
        //two intersect point in object space
        Vector3 p0_w = _box.o2w.MultiplyPoint3x4(p0_o);
        Vector3 p1_w = _box.o2w.MultiplyPoint3x4(p1_o);

        min_exist = false;
        max_exist = false;

        if (min_scale < max_scale)
        {
            if (min_scale > 0 && min_scale < 1)
            {
                min_exist = true;
            }

            if (max_scale > 0 && max_scale < 1)
            {
                max_exist = true;
            }
        }

        //debug info display
        _dcubes.p0.position = p0_w;
        _dcubes.p1.position = p1_w;
        _dcubes.x0.position = _ray.PA.position + xyz_sclae_min.x * _ray.fullRay;
        _dcubes.x1.position = _ray.PA.position + xyz_sclae_max.x * _ray.fullRay;
        _dcubes.y0.position = _ray.PA.position + xyz_sclae_min.y * _ray.fullRay;
        _dcubes.y1.position = _ray.PA.position + xyz_sclae_max.y * _ray.fullRay;
        _dcubes.z0.position = _ray.PA.position + xyz_sclae_min.z * _ray.fullRay;
        _dcubes.z1.position = _ray.PA.position + xyz_sclae_max.z * _ray.fullRay;
        if (!min_exist)
        {
            _dcubes.p0.release();
        }
        else
        {
            _dcubes.p0.use();
        }
        if (!max_exist)
        {
            _dcubes.p1.release();
        }
        else
        {
            _dcubes.p1.use();
        }

        inter_point inter = new inter_point(p0_o, p1_o, p0_w, p1_w, min_exist, max_exist);

        return(inter);
    }
Ejemplo n.º 4
0
    public inter_point aabb_intersection(AB_RAY _ray, AABB _box, DCube_Ray _dcubes)
    {
        bool min_exist, max_exist;

        Vector3 ray_min = _box.min - _ray.PA.position;
        Vector3 ray_max = _box.max - _ray.PA.position;

        Vector3 xyz_sclae_min;
        Vector3 xyz_sclae_max;

        Vector3 fullRay = new Vector3(_ray.fullRay.x == 0? 0.0001f : _ray.fullRay.x,
                                      _ray.fullRay.y == 0? 0.0001f : _ray.fullRay.y,
                                      _ray.fullRay.z == 0? 0.0001f : _ray.fullRay.z);

        float _x1 = ray_min.x / _ray.fullRay.x;
        float _x2 = ray_max.x / _ray.fullRay.x;

        xyz_sclae_min.x = _x1 < _x2 ? _x1 : _x2;
        xyz_sclae_max.x = _x1 > _x2 ? _x1 : _x2;

        float _y1 = ray_min.y / _ray.fullRay.y;
        float _y2 = ray_max.y / _ray.fullRay.y;

        xyz_sclae_min.y = _y1 < _y2 ? _y1 : _y2;
        xyz_sclae_max.y = _y1 > _y2 ? _y1 : _y2;

        float _z1 = ray_min.z / _ray.fullRay.z;
        float _z2 = ray_max.z / _ray.fullRay.z;

        xyz_sclae_min.z = _z1 < _z2 ? _z1 : _z2;
        xyz_sclae_max.z = _z1 > _z2 ? _z1 : _z2;


        float min_scale = Mathf.Max(Mathf.Max(xyz_sclae_min.x, xyz_sclae_min.y), xyz_sclae_min.z);
        float max_scale = Mathf.Min(Mathf.Min(xyz_sclae_max.x, xyz_sclae_max.y), xyz_sclae_max.z);

        min_exist = false;
        max_exist = false;

        if (min_scale < max_scale)
        {
            if (min_scale > 0 && min_scale < 1)
            {
                min_exist = true;
            }

            if (max_scale > 0 && max_scale < 1)
            {
                max_exist = true;
            }
        }

        _dcubes.p0.position = _ray.PA.position + min_scale * _ray.fullRay;
        _dcubes.p1.position = _ray.PA.position + max_scale * _ray.fullRay;
        _dcubes.x0.position = _ray.PA.position + xyz_sclae_min.x * _ray.fullRay;
        _dcubes.x1.position = _ray.PA.position + xyz_sclae_max.x * _ray.fullRay;
        _dcubes.y0.position = _ray.PA.position + xyz_sclae_min.y * _ray.fullRay;
        _dcubes.y1.position = _ray.PA.position + xyz_sclae_max.y * _ray.fullRay;
        _dcubes.z0.position = _ray.PA.position + xyz_sclae_min.z * _ray.fullRay;
        _dcubes.z1.position = _ray.PA.position + xyz_sclae_max.z * _ray.fullRay;
        if (!min_exist)
        {
            _dcubes.p0.release();
        }
        else
        {
            _dcubes.p0.use();
        }
        if (!max_exist)
        {
            _dcubes.p1.release();
        }
        else
        {
            _dcubes.p1.use();
        }

        inter_point inter = new inter_point(Vector3.zero, Vector3.zero, _dcubes.p0.position, _dcubes.p1.position, min_exist, max_exist);

        return(inter);
    }