/*
 * Copyright (c) 1987, 1988, 1989, 1990, 1991 Stanford University
 * Copyright (c) 1991 Silicon Graphics, Inc.
 *
 * Permission to use, copy, modify, distribute, and sell this software and 
 * its documentation for any purpose is hereby granted without fee, provided
 * that (i) the above copyright notices and this permission notice appear in
 * all copies of the software and related documentation, and (ii) the names of
 * Stanford and Silicon Graphics may not be used in any advertising or
 * publicity relating to the software without the specific, prior written
 * permission of Stanford and Silicon Graphics.
 * 
 * THE SOFTWARE IS PROVIDED "AS-IS" AND WITHOUT WARRANTY OF ANY KIND, 
 * EXPRESS, IMPLIED OR OTHERWISE, INCLUDING WITHOUT LIMITATION, ANY 
 * WARRANTY OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE.  
 *
 * IN NO EVENT SHALL STANFORD OR SILICON GRAPHICS BE LIABLE FOR
 * ANY SPECIAL, INCIDENTAL, INDIRECT OR CONSEQUENTIAL DAMAGES OF ANY KIND,
 * OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
 * WHETHER OR NOT ADVISED OF THE POSSIBILITY OF DAMAGE, AND ON ANY THEORY OF 
 * LIABILITY, ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE 
 * OF THIS SOFTWARE.
 */

/*
 * Implementation of transformation matrix operations.
 */

#include <InterViews/transformer.h>
#include <OS/math.h>
#include <math.h>

static const double RADPERDEG = M_PI/180.0;

Transformer::Transformer() {
    identity_ = true;
    mat00 = mat11 = 1;
    mat01 = mat10 = mat20 = mat21 = 0;
    ref();
}

Transformer::Transformer(const Transformer& t) {
    mat00 = t.mat00;	mat01 = t.mat01;
    mat10 = t.mat10;	mat11 = t.mat11;
    mat20 = t.mat20;	mat21 = t.mat21;
    update();
    ref();
}

Transformer::Transformer(
    float a00, float a01, float a10, float a11, float a20, float a21
) {
    mat00 = a00;	mat01 = a01;
    mat10 = a10;	mat11 = a11;
    mat20 = a20;	mat21 = a21;
    update();
    ref();
}

Transformer::~Transformer() { }

boolean Transformer::operator ==(const Transformer& t) const {
    if (identity_) {
	return t.identity_;
    }
    if (t.identity_) {
	return false;
    }
    return (
	mat00 == t.mat00 && mat01 == t.mat01 &&
	mat10 == t.mat10 && mat11 == t.mat11 &&
	mat20 == t.mat20 && mat21 == t.mat21
    );
}

boolean Transformer::operator !=(const Transformer& t) const {
    if (identity_) {
	return !t.identity_;
    }
    if (t.identity_) {
	return true;
    }
    return (
	mat00 != t.mat00 || mat01 != t.mat01 ||
	mat10 != t.mat10 || mat11 != t.mat11 ||
	mat20 != t.mat20 || mat21 != t.mat21
    );
}

Transformer& Transformer::operator =(const Transformer& t) {
    mat00 = t.mat00;
    mat01 = t.mat01;
    mat10 = t.mat10;
    mat11 = t.mat11;
    mat20 = t.mat20;
    mat21 = t.mat21;
    update();
    return *this;
}

void Transformer::matrix(
    float& a00, float& a01, float& a10, float& a11, float& a20, float& a21
) const {
    a00 = mat00;
    a01 = mat01;
    a10 = mat10;
    a11 = mat11;
    a20 = mat20;
    a21 = mat21;
}

void Transformer::update() {
    identity_ = (
	mat00 == 1 && mat11 == 1 &&
	mat01 == 0 && mat10 == 0 && mat20 == 0 && mat21 == 0
    );
}

void Transformer::translate(float dx, float dy) {
    mat20 += dx;
    mat21 += dy;
    update();
}

void Transformer::scale(float sx, float sy) {
    mat00 *= sx;
    mat01 *= sy;
    mat10 *= sx;
    mat11 *= sy;
    mat20 *= sx;
    mat21 *= sy;
    update();
}

void Transformer::skew(float sx, float sy) {
    mat01 += mat00*sy;
    mat10 += mat11*sx;
    update();
}

void Transformer::rotate(float angle) {
    float tmp1, tmp2, m00, m01, m10, m11, m20, m21;

    angle *= RADPERDEG;
    tmp1 = cos(angle);
    tmp2 = sin(angle);
    
    m00 = mat00*tmp1;
    m01 = mat01*tmp2;
    m10 = mat10*tmp1;
    m11 = mat11*tmp2;
    m20 = mat20*tmp1;
    m21 = mat21*tmp2;

    mat01 = mat00*tmp2 + mat01*tmp1;
    mat11 = mat10*tmp2 + mat11*tmp1;
    mat21 = mat20*tmp2 + mat21*tmp1;
    mat00 = m00 - m01;
    mat10 = m10 - m11;
    mat20 = m20 - m21;
    update();
}

void Transformer::premultiply(const Transformer& t) {
    float tmp1 = mat00;
    float tmp2 = mat10;

    mat00  = t.mat00*tmp1 + t.mat01*tmp2;
    mat10  = t.mat10*tmp1 + t.mat11*tmp2;
    mat20 += t.mat20*tmp1 + t.mat21*tmp2;

    tmp1 = mat01;
    tmp2 = mat11;

    mat01  = t.mat00*tmp1 + t.mat01*tmp2;
    mat11  = t.mat10*tmp1 + t.mat11*tmp2;
    mat21 += t.mat20*tmp1 + t.mat21*tmp2;
    update();
}

void Transformer::postmultiply(const Transformer& t) {
    float tmp = mat00*t.mat01 + mat01*t.mat11;
    mat00 = mat00*t.mat00 + mat01*t.mat10;
    mat01 = tmp;

    tmp = mat10*t.mat01 + mat11*t.mat11;
    mat10 = mat10*t.mat00 + mat11*t.mat10;
    mat11 = tmp;

    tmp = mat20*t.mat01 + mat21*t.mat11;
    mat20 = mat20*t.mat00 + mat21*t.mat10;
    mat21 = tmp;

    mat20 += t.mat20;
    mat21 += t.mat21;
    update();
}    

void Transformer::invert() {
    float d = det();
    float t00 = mat00;
    float t20 = mat20;

    mat20 = (mat10*mat21 - mat11*mat20)/d;
    mat21 = (mat01*t20 - mat00*mat21)/d;
    mat00 = mat11/d;
    mat11 = t00/d;
    mat10 = -mat10/d;
    mat01 = -mat01/d;
    update();
}

void Transformer::transform(float& x, float& y) const {
    float tx = x;
    x = tx*mat00 + y*mat10 + mat20;
    y = tx*mat01 + y*mat11 + mat21;
}

void Transformer::transform(float x, float y, float& tx, float& ty) const {
    tx = x*mat00 + y*mat10 + mat20;
    ty = x*mat01 + y*mat11 + mat21;
}

void Transformer::inverse_transform(float& tx, float& ty) const {
    float d = det();
    float a = (tx - mat20) / d;
    float b = (ty - mat21) / d;

    tx = a*mat11 - b*mat10;
    ty = b*mat00 - a*mat01;
}

void Transformer::inverse_transform(
    float tx, float ty, float& x, float& y
) const {
    float d = det();
    float a = (tx - mat20) / d;
    float b = (ty - mat21) / d;

    x = a*mat11 - b*mat10;
    y = b*mat00 - a*mat01;
}