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 Samsvoid Matrix3x3::loadIdentity() { 2987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[0] = 1.f; 3087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[1] = 0.f; 3187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[2] = 0.f; 3287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[3] = 0.f; 3387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[4] = 1.f; 3487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[5] = 0.f; 3587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[6] = 0.f; 3687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[7] = 0.f; 3787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams m[8] = 1.f; 3887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams} 3987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams 4087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix3x3::load(const float *v) { 4187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams memcpy(m, v, sizeof(m)); 4287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams} 4387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams 4487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix3x3::load(const rs_matrix3x3 *v) { 4587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams memcpy(m, v->m, sizeof(m)); 4687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams} 4787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams 4887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix3x3::loadMultiply(const rs_matrix3x3 *lhs, const rs_matrix3x3 *rhs) { 491bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet // Use a temporary variable to support the case where one of the inputs 501bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet // is also the destination, e.g. left.loadMultiply(left, right); 511bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet Matrix3x3 temp; 5287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams for (int i=0 ; i<3 ; i++) { 5387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams float ri0 = 0; 5487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams float ri1 = 0; 5587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams float ri2 = 0; 5687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams for (int j=0 ; j<3 ; j++) { 5787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams const float rhs_ij = ((const Matrix3x3 *)rhs)->get(i, j); 5887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams ri0 += ((const Matrix3x3 *)lhs)->get(j, 0) * rhs_ij; 5987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams ri1 += ((const Matrix3x3 *)lhs)->get(j, 1) * rhs_ij; 6087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams ri2 += ((const Matrix3x3 *)lhs)->get(j, 2) * rhs_ij; 6187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams } 621bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet temp.set(i, 0, ri0); 631bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet temp.set(i, 1, ri1); 641bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet temp.set(i, 2, ri2); 6587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams } 661bb2eed69caa28cf8198d58db7d9134cc2f563f5Jean-Luc Brouillet load(&temp); 6787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams} 6887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams 6987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Samsvoid Matrix3x3::transpose() { 7087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams int i, j; 7187fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams float temp; 7287fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams for (i = 0; i < 2; ++i) { 7387fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams for (j = i + 1; j < 3; ++j) { 7487fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams temp = get(i, j); 7587fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams set(i, j, get(j, i)); 7687fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams set(j, i, temp); 7787fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams } 7887fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams } 7987fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams} 8087fe59a2f4d4c74539bfa0bff5f9a7e320e99415Jason Sams 81