/*
# ______       ____   ___
#   |     \/   ____| |___|    
#   |     |   |   \  |   |       
#-----------------------------------------------------------------------
# Copyright 2020, tyra - https://github.com/h4570/tyra
# Licenced under Apache License 2.0
# Sandro Sobczyński <sandro.sobczynski@gmail.com>
*/

#include "./utils.hpp"

#include <fastmath.h>

/** Exponential ease-in-out animation 
 * @param t Time
 * @param b Start value
 * @param c Change
 * @param d Duration
 * @returns Current animation position
*/
float Utils::expoEaseInOut(float t, float b, float c, float d)
{
    if (t == 0)
        return b;

    if (t == d)
        return b + c;

    if ((t /= d / 2) < 1)
        return c / 2 * powf(2, 10 * (t - 1)) + b;

    return c / 2 * (-powf(2, -10 * --t) + 2) + b;
}

/** Calculates minimum and maximum X, Y, Z of mesh vertices + current position */
void Utils::getMinMax(const Mesh &t_mesh, Vector3 &t_min, Vector3 &t_max)
{
    Vector3 calc = Vector3();
    u8 isInitialized = 0;
    const Vector3 *boundingBox = t_mesh.getCurrentBoundingBoxVertices();
    for (u32 i = 0; i < 8; i++)
    {
        calc.set(
            boundingBox[i].x + t_mesh.position.x,
            boundingBox[i].y + t_mesh.position.y,
            boundingBox[i].z + t_mesh.position.z);
        if (isInitialized == 0)
        {
            isInitialized = 1;
            t_min.set(calc);
            t_max.set(calc);
        }

        if (t_min.x > calc.x)
            t_min.x = calc.x;
        if (calc.x > t_max.x)
            t_max.x = calc.x;

        if (t_min.y > calc.y)
            t_min.y = calc.y;
        if (calc.y > t_max.y)
            t_max.y = calc.y;

        if (t_min.z > calc.z)
            t_min.z = calc.z;
        if (calc.z > t_max.z)
            t_max.z = calc.z;
    }
}