use i_comparable::IComparableError;
use i_shape::IShape;

use mat::Mat3x1;
use ray::Ray3;

#[test]
fn test_intersect_ray_ray() {
    //parallel rays, no intersection
    {
        let a = Ray3::init(&[20f64, 0f64, 0f64], &[1f64, 1f64, 1f64]);
        let b = Ray3::init(&[25f64, 0f64, 0f64], &[1f64, 1f64, 1f64]);

        match a.get_intersect(&b) {
            (false, None) => (),
            _ => panic!("unexpected result for parallel rays, no intersection"),
        }
    }

    //colinear rays, intersection
    {
        let a = Ray3::init(&[20f64, 0f64, 0f64], &[1f64, 1f64, 1f64]);
        let b = Ray3::init(&[22f64, 2f64, 2f64], &[1f64, 1f64, 1f64]);

        match a.get_intersect(&b) {
            (true, Some(loc)) => {
                assert!(loc.is_equal(&b._ori, 0.0001f64).unwrap());
            }
            _ => panic!("unexpected result for parallel rays, no intersection"),
        }
    }

    //colinear rays, intersection
    {
        let a = Ray3::init(&[25f64, 5f64, 5f64], &[1f64, 1f64, 1f64]);
        let b = Ray3::init(&[22f64, 2f64, 2f64], &[1f64, 1f64, 1f64]);

        match a.get_intersect(&b) {
            (true, Some(loc)) => {
                assert!(loc.is_equal(&a._ori, 0.0001f64).unwrap());
            }
            _ => panic!("unexpected result for parallel rays, no intersection"),
        }
    }

    //rays, intersection
    {
        let a = Ray3::init(&[5f64, 5f64, 0f64], &[-1f64, 0f64, 0f64]);
        let b = Ray3::init(&[0f64, 0f64, 0f64], &[0f64, 1f64, 0f64]);

        match a.get_intersect(&b) {
            (true, Some(loc)) => {
                assert!(loc
                    .is_equal(
                        &Mat3x1 {
                            _val: [0f64, 5f64, 0f64]
                        },
                        0.0001f64
                    )
                    .unwrap());
            }
            _ => panic!("unexpected result for ray intersection"),
        }
    }

    //non-coplaner rays, no intersection
    {
        let a = Ray3::init(&[5f64, 5f64, 2f64], &[-1f64, -1f64, 0f64]);
        let b = Ray3::init(&[5f64, 5f64, 0f64], &[1f64, 1f64, 0f64]);

        match a.get_intersect(&b) {
            (false, None) => (),
            _ => panic!("unexpected result for ray intersection"),
        }
    }
}