187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams/*
287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * Copyright (C) 2011 The Android Open Source Project
387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams *
487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * Licensed under the Apache License, Version 2.0 (the "License");
587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * you may not use this file except in compliance with the License.
687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * You may obtain a copy of the License at
787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams *
887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams *      http://www.apache.org/licenses/LICENSE-2.0
987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams *
1087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * Unless required by applicable law or agreed to in writing, software
1187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * distributed under the License is distributed on an "AS IS" BASIS,
1287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
1387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * See the License for the specific language governing permissions and
1487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams * limitations under the License.
1587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams */
1687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
1787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams#include "rsMatrix2x2.h"
1887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams#include "rsMatrix3x3.h"
1987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams#include "rsMatrix4x4.h"
2087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
2187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams#include "stdlib.h"
2287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams#include "string.h"
2387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams#include "math.h"
2487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
2587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsusing namespace android;
2687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsusing namespace android::renderscript;
2787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
2887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
2987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix2x2::loadIdentity() {
3087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    m[0] = 1.f;
3187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    m[1] = 0.f;
3287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    m[2] = 0.f;
3387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    m[3] = 1.f;
3487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams}
3587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
3687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix2x2::load(const float *v) {
3787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    memcpy(m, v, sizeof(m));
3887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams}
3987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
4087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix2x2::load(const rs_matrix2x2 *v) {
4187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    memcpy(m, v->m, sizeof(m));
4287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams}
4387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
4487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix2x2::loadMultiply(const rs_matrix2x2 *lhs, const rs_matrix2x2 *rhs) {
451bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet    // Use a temporary variable to support the case where one of the inputs
461bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet    // is also the destination, e.g. left.loadMultiply(left, right);
471bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet    Matrix2x2 temp;
4887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    for (int i=0 ; i<2 ; i++) {
4987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams        float ri0 = 0;
5087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams        float ri1 = 0;
5187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams        for (int j=0 ; j<2 ; j++) {
5287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams            const float rhs_ij = ((const Matrix2x2 *)rhs)->get(i, j);
5387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams            ri0 += ((const Matrix2x2 *)lhs)->get(j, 0) * rhs_ij;
5487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams            ri1 += ((const Matrix2x2 *)lhs)->get(j, 1) * rhs_ij;
5587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams        }
561bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet        temp.set(i, 0, ri0);
571bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet        temp.set(i, 1, ri1);
5887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    }
591bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet    load(&temp);
6087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams}
6187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
6287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix2x2::transpose() {
6387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    float temp = m[1];
6487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    m[1] = m[2];
6587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams    m[2] = temp;
6687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams}
6787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams
68