#include "Sphere.h"
#include "util/Solver.h"
#include <math.h>
#include <iostream>
using namespace std;

Sphere::Sphere(double radius)
{
    m_radius = radius;
    m_radius2 = radius * radius;
}

Solver::Result Sphere::intersect(const Ray & ray)
{
    Solver::Result res;
    QuadraticSolver solver(1.0,
                           2 * ( ray.getOrigin()[0] * ray.getDirection()[0]
                               + ray.getOrigin()[1] * ray.getDirection()[1]
                               + ray.getOrigin()[2] * ray.getDirection()[2] ),
                             ray.getOrigin()[0] * ray.getOrigin()[0]
                           + ray.getOrigin()[1] * ray.getOrigin()[1]
                           + ray.getOrigin()[2] * ray.getOrigin()[2]
                           - m_radius2);
    Solver::Result quadSolutions = solver.solve();
    for (int i = 0; i < quadSolutions.numResults; i++)
    {
        if (quadSolutions.results[i] >= 0.0)
        {
            res.results[res.numResults++] = quadSolutions.results[i];
        }
    }
    return res;
}

Vector Sphere::getNormalAt(const Vector & pt)
{
    Vector normal = pt;
    return normal.normalize();
}