2011-04-27 11:58:34 +00:00
|
|
|
/*
|
2013-08-18 14:16:15 +00:00
|
|
|
* Copyright 2011-2013 Blender Foundation
|
2011-04-27 11:58:34 +00:00
|
|
|
*
|
2013-08-18 14:16:15 +00:00
|
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
|
|
* you may not use this file except in compliance with the License.
|
|
|
|
|
* You may obtain a copy of the License at
|
2011-04-27 11:58:34 +00:00
|
|
|
*
|
2013-08-18 14:16:15 +00:00
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
2011-04-27 11:58:34 +00:00
|
|
|
*
|
2013-08-18 14:16:15 +00:00
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
|
* See the License for the specific language governing permissions and
|
|
|
|
|
* limitations under the License
|
2011-04-27 11:58:34 +00:00
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Adapted from code with license:
|
|
|
|
|
*
|
|
|
|
|
* Copyright (c) 2002, Industrial Light & Magic, a division of Lucas
|
|
|
|
|
* Digital Ltd. LLC. All rights reserved.
|
|
|
|
|
*
|
|
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
|
* modification, are permitted provided that the following conditions are
|
|
|
|
|
* met:
|
|
|
|
|
* * Redistributions of source code must retain the above copyright
|
|
|
|
|
* notice, this list of conditions and the following disclaimer.
|
|
|
|
|
* * Redistributions in binary form must reproduce the above copyright
|
|
|
|
|
* notice, this list of conditions and the following disclaimer in
|
|
|
|
|
* the documentation and/or other materials provided with the
|
|
|
|
|
* distribution.
|
|
|
|
|
* * Neither the name of Industrial Light & Magic nor the names of its
|
|
|
|
|
* contributors may be used to endorse or promote products derived
|
|
|
|
|
* from this software without specific prior written permission.
|
|
|
|
|
*
|
|
|
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
|
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
|
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
|
|
|
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
|
|
|
* OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
|
|
|
* SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
|
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
|
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
|
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
|
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
|
|
|
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include "util_math.h"
|
|
|
|
|
#include "util_transform.h"
|
|
|
|
|
|
|
|
|
|
CCL_NAMESPACE_BEGIN
|
|
|
|
|
|
2012-04-30 12:49:26 +00:00
|
|
|
/* Transform Inverse */
|
|
|
|
|
|
2011-04-27 11:58:34 +00:00
|
|
|
static bool transform_matrix4_gj_inverse(float R[][4], float M[][4])
|
|
|
|
|
{
|
|
|
|
|
/* forward elimination */
|
|
|
|
|
for(int i = 0; i < 4; i++) {
|
|
|
|
|
int pivot = i;
|
|
|
|
|
float pivotsize = M[i][i];
|
|
|
|
|
|
|
|
|
|
if(pivotsize < 0)
|
|
|
|
|
pivotsize = -pivotsize;
|
|
|
|
|
|
|
|
|
|
for(int j = i + 1; j < 4; j++) {
|
|
|
|
|
float tmp = M[j][i];
|
|
|
|
|
|
|
|
|
|
if(tmp < 0)
|
|
|
|
|
tmp = -tmp;
|
|
|
|
|
|
|
|
|
|
if(tmp > pivotsize) {
|
|
|
|
|
pivot = j;
|
|
|
|
|
pivotsize = tmp;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(pivotsize == 0)
|
|
|
|
|
return false;
|
|
|
|
|
|
|
|
|
|
if(pivot != i) {
|
|
|
|
|
for(int j = 0; j < 4; j++) {
|
|
|
|
|
float tmp;
|
|
|
|
|
|
|
|
|
|
tmp = M[i][j];
|
|
|
|
|
M[i][j] = M[pivot][j];
|
|
|
|
|
M[pivot][j] = tmp;
|
|
|
|
|
|
|
|
|
|
tmp = R[i][j];
|
|
|
|
|
R[i][j] = R[pivot][j];
|
|
|
|
|
R[pivot][j] = tmp;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for(int j = i + 1; j < 4; j++) {
|
|
|
|
|
float f = M[j][i] / M[i][i];
|
|
|
|
|
|
|
|
|
|
for(int k = 0; k < 4; k++) {
|
|
|
|
|
M[j][k] -= f*M[i][k];
|
|
|
|
|
R[j][k] -= f*R[i][k];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* backward substitution */
|
|
|
|
|
for(int i = 3; i >= 0; --i) {
|
|
|
|
|
float f;
|
|
|
|
|
|
|
|
|
|
if((f = M[i][i]) == 0)
|
|
|
|
|
return false;
|
|
|
|
|
|
|
|
|
|
for(int j = 0; j < 4; j++) {
|
|
|
|
|
M[i][j] /= f;
|
|
|
|
|
R[i][j] /= f;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for(int j = 0; j < i; j++) {
|
|
|
|
|
f = M[j][i];
|
|
|
|
|
|
|
|
|
|
for(int k = 0; k < 4; k++) {
|
|
|
|
|
M[j][k] -= f*M[i][k];
|
|
|
|
|
R[j][k] -= f*R[i][k];
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
Transform transform_inverse(const Transform& tfm)
|
|
|
|
|
{
|
Cycles: merging features from tomato branch.
=== BVH build time optimizations ===
* BVH building was multithreaded. Not all building is multithreaded, packing
and the initial bounding/splitting is still single threaded, but recursive
splitting is, which was the main bottleneck.
* Object splitting now uses binning rather than sorting of all elements, using
code from the Embree raytracer from Intel.
http://software.intel.com/en-us/articles/embree-photo-realistic-ray-tracing-kernels/
* Other small changes to avoid allocations, pack memory more tightly, avoid
some unnecessary operations, ...
These optimizations do not work yet when Spatial Splits are enabled, for that
more work is needed. There's also other optimizations still needed, in
particular for the case of many low poly objects, the packing step and node
memory allocation.
BVH raytracing time should remain about the same, but BVH build time should be
significantly reduced, test here show speedup of about 5x to 10x on a dual core
and 5x to 25x on an 8-core machine, depending on the scene.
=== Threads ===
Centralized task scheduler for multithreading, which is basically the
CPU device threading code wrapped into something reusable.
Basic idea is that there is a single TaskScheduler that keeps a pool of threads,
one for each core. Other places in the code can then create a TaskPool that they
can drop Tasks in to be executed by the scheduler, and wait for them to complete
or cancel them early.
=== Normal ====
Added a Normal output to the texture coordinate node. This currently
gives the object space normal, which is the same under object animation.
In the future this might become a "generated" normal so it's also stable for
deforming objects, but for now it's already useful for non-deforming objects.
=== Render Layers ===
Per render layer Samples control, leaving it to 0 will use the common scene
setting.
Environment pass will now render environment even if film is set to transparent.
Exclude Layers" added. Scene layers (all object that influence the render,
directly or indirectly) are shared between all render layers. However sometimes
it's useful to leave out some object influence for a particular render layer.
That's what this option allows you to do.
=== Filter Glossy ===
When using a value higher than 0.0, this will blur glossy reflections after
blurry bounces, to reduce noise at the cost of accuracy. 1.0 is a good
starting value to tweak.
Some light paths have a low probability of being found while contributing much
light to the pixel. As a result these light paths will be found in some pixels
and not in others, causing fireflies. An example of such a difficult path might
be a small light that is causing a small specular highlight on a sharp glossy
material, which we are seeing through a rough glossy material. With path tracing
it is difficult to find the specular highlight, but if we increase the roughness
on the material the highlight gets bigger and softer, and so easier to find.
Often this blurring will be hardly noticeable, because we are seeing it through
a blurry material anyway, but there are also cases where this will lead to a
loss of detail in lighting.
2012-04-28 08:53:59 +00:00
|
|
|
Transform tfmR = transform_identity();
|
|
|
|
|
float M[4][4], R[4][4];
|
2011-04-27 11:58:34 +00:00
|
|
|
|
Cycles: merging features from tomato branch.
=== BVH build time optimizations ===
* BVH building was multithreaded. Not all building is multithreaded, packing
and the initial bounding/splitting is still single threaded, but recursive
splitting is, which was the main bottleneck.
* Object splitting now uses binning rather than sorting of all elements, using
code from the Embree raytracer from Intel.
http://software.intel.com/en-us/articles/embree-photo-realistic-ray-tracing-kernels/
* Other small changes to avoid allocations, pack memory more tightly, avoid
some unnecessary operations, ...
These optimizations do not work yet when Spatial Splits are enabled, for that
more work is needed. There's also other optimizations still needed, in
particular for the case of many low poly objects, the packing step and node
memory allocation.
BVH raytracing time should remain about the same, but BVH build time should be
significantly reduced, test here show speedup of about 5x to 10x on a dual core
and 5x to 25x on an 8-core machine, depending on the scene.
=== Threads ===
Centralized task scheduler for multithreading, which is basically the
CPU device threading code wrapped into something reusable.
Basic idea is that there is a single TaskScheduler that keeps a pool of threads,
one for each core. Other places in the code can then create a TaskPool that they
can drop Tasks in to be executed by the scheduler, and wait for them to complete
or cancel them early.
=== Normal ====
Added a Normal output to the texture coordinate node. This currently
gives the object space normal, which is the same under object animation.
In the future this might become a "generated" normal so it's also stable for
deforming objects, but for now it's already useful for non-deforming objects.
=== Render Layers ===
Per render layer Samples control, leaving it to 0 will use the common scene
setting.
Environment pass will now render environment even if film is set to transparent.
Exclude Layers" added. Scene layers (all object that influence the render,
directly or indirectly) are shared between all render layers. However sometimes
it's useful to leave out some object influence for a particular render layer.
That's what this option allows you to do.
=== Filter Glossy ===
When using a value higher than 0.0, this will blur glossy reflections after
blurry bounces, to reduce noise at the cost of accuracy. 1.0 is a good
starting value to tweak.
Some light paths have a low probability of being found while contributing much
light to the pixel. As a result these light paths will be found in some pixels
and not in others, causing fireflies. An example of such a difficult path might
be a small light that is causing a small specular highlight on a sharp glossy
material, which we are seeing through a rough glossy material. With path tracing
it is difficult to find the specular highlight, but if we increase the roughness
on the material the highlight gets bigger and softer, and so easier to find.
Often this blurring will be hardly noticeable, because we are seeing it through
a blurry material anyway, but there are also cases where this will lead to a
loss of detail in lighting.
2012-04-28 08:53:59 +00:00
|
|
|
memcpy(R, &tfmR, sizeof(R));
|
|
|
|
|
memcpy(M, &tfm, sizeof(M));
|
|
|
|
|
|
|
|
|
|
if(!transform_matrix4_gj_inverse(R, M)) {
|
2012-04-13 09:08:43 +00:00
|
|
|
/* matrix is degenerate (e.g. 0 scale on some axis), ideally we should
|
2012-06-09 17:22:52 +00:00
|
|
|
* never be in this situation, but try to invert it anyway with tweak */
|
Cycles: merging features from tomato branch.
=== BVH build time optimizations ===
* BVH building was multithreaded. Not all building is multithreaded, packing
and the initial bounding/splitting is still single threaded, but recursive
splitting is, which was the main bottleneck.
* Object splitting now uses binning rather than sorting of all elements, using
code from the Embree raytracer from Intel.
http://software.intel.com/en-us/articles/embree-photo-realistic-ray-tracing-kernels/
* Other small changes to avoid allocations, pack memory more tightly, avoid
some unnecessary operations, ...
These optimizations do not work yet when Spatial Splits are enabled, for that
more work is needed. There's also other optimizations still needed, in
particular for the case of many low poly objects, the packing step and node
memory allocation.
BVH raytracing time should remain about the same, but BVH build time should be
significantly reduced, test here show speedup of about 5x to 10x on a dual core
and 5x to 25x on an 8-core machine, depending on the scene.
=== Threads ===
Centralized task scheduler for multithreading, which is basically the
CPU device threading code wrapped into something reusable.
Basic idea is that there is a single TaskScheduler that keeps a pool of threads,
one for each core. Other places in the code can then create a TaskPool that they
can drop Tasks in to be executed by the scheduler, and wait for them to complete
or cancel them early.
=== Normal ====
Added a Normal output to the texture coordinate node. This currently
gives the object space normal, which is the same under object animation.
In the future this might become a "generated" normal so it's also stable for
deforming objects, but for now it's already useful for non-deforming objects.
=== Render Layers ===
Per render layer Samples control, leaving it to 0 will use the common scene
setting.
Environment pass will now render environment even if film is set to transparent.
Exclude Layers" added. Scene layers (all object that influence the render,
directly or indirectly) are shared between all render layers. However sometimes
it's useful to leave out some object influence for a particular render layer.
That's what this option allows you to do.
=== Filter Glossy ===
When using a value higher than 0.0, this will blur glossy reflections after
blurry bounces, to reduce noise at the cost of accuracy. 1.0 is a good
starting value to tweak.
Some light paths have a low probability of being found while contributing much
light to the pixel. As a result these light paths will be found in some pixels
and not in others, causing fireflies. An example of such a difficult path might
be a small light that is causing a small specular highlight on a sharp glossy
material, which we are seeing through a rough glossy material. With path tracing
it is difficult to find the specular highlight, but if we increase the roughness
on the material the highlight gets bigger and softer, and so easier to find.
Often this blurring will be hardly noticeable, because we are seeing it through
a blurry material anyway, but there are also cases where this will lead to a
loss of detail in lighting.
2012-04-28 08:53:59 +00:00
|
|
|
M[0][0] += 1e-8f;
|
|
|
|
|
M[1][1] += 1e-8f;
|
|
|
|
|
M[2][2] += 1e-8f;
|
2012-04-13 09:08:43 +00:00
|
|
|
|
Cycles: merging features from tomato branch.
=== BVH build time optimizations ===
* BVH building was multithreaded. Not all building is multithreaded, packing
and the initial bounding/splitting is still single threaded, but recursive
splitting is, which was the main bottleneck.
* Object splitting now uses binning rather than sorting of all elements, using
code from the Embree raytracer from Intel.
http://software.intel.com/en-us/articles/embree-photo-realistic-ray-tracing-kernels/
* Other small changes to avoid allocations, pack memory more tightly, avoid
some unnecessary operations, ...
These optimizations do not work yet when Spatial Splits are enabled, for that
more work is needed. There's also other optimizations still needed, in
particular for the case of many low poly objects, the packing step and node
memory allocation.
BVH raytracing time should remain about the same, but BVH build time should be
significantly reduced, test here show speedup of about 5x to 10x on a dual core
and 5x to 25x on an 8-core machine, depending on the scene.
=== Threads ===
Centralized task scheduler for multithreading, which is basically the
CPU device threading code wrapped into something reusable.
Basic idea is that there is a single TaskScheduler that keeps a pool of threads,
one for each core. Other places in the code can then create a TaskPool that they
can drop Tasks in to be executed by the scheduler, and wait for them to complete
or cancel them early.
=== Normal ====
Added a Normal output to the texture coordinate node. This currently
gives the object space normal, which is the same under object animation.
In the future this might become a "generated" normal so it's also stable for
deforming objects, but for now it's already useful for non-deforming objects.
=== Render Layers ===
Per render layer Samples control, leaving it to 0 will use the common scene
setting.
Environment pass will now render environment even if film is set to transparent.
Exclude Layers" added. Scene layers (all object that influence the render,
directly or indirectly) are shared between all render layers. However sometimes
it's useful to leave out some object influence for a particular render layer.
That's what this option allows you to do.
=== Filter Glossy ===
When using a value higher than 0.0, this will blur glossy reflections after
blurry bounces, to reduce noise at the cost of accuracy. 1.0 is a good
starting value to tweak.
Some light paths have a low probability of being found while contributing much
light to the pixel. As a result these light paths will be found in some pixels
and not in others, causing fireflies. An example of such a difficult path might
be a small light that is causing a small specular highlight on a sharp glossy
material, which we are seeing through a rough glossy material. With path tracing
it is difficult to find the specular highlight, but if we increase the roughness
on the material the highlight gets bigger and softer, and so easier to find.
Often this blurring will be hardly noticeable, because we are seeing it through
a blurry material anyway, but there are also cases where this will lead to a
loss of detail in lighting.
2012-04-28 08:53:59 +00:00
|
|
|
if(!transform_matrix4_gj_inverse(R, M))
|
2012-04-13 09:08:43 +00:00
|
|
|
return transform_identity();
|
|
|
|
|
}
|
2011-04-27 11:58:34 +00:00
|
|
|
|
Cycles: merging features from tomato branch.
=== BVH build time optimizations ===
* BVH building was multithreaded. Not all building is multithreaded, packing
and the initial bounding/splitting is still single threaded, but recursive
splitting is, which was the main bottleneck.
* Object splitting now uses binning rather than sorting of all elements, using
code from the Embree raytracer from Intel.
http://software.intel.com/en-us/articles/embree-photo-realistic-ray-tracing-kernels/
* Other small changes to avoid allocations, pack memory more tightly, avoid
some unnecessary operations, ...
These optimizations do not work yet when Spatial Splits are enabled, for that
more work is needed. There's also other optimizations still needed, in
particular for the case of many low poly objects, the packing step and node
memory allocation.
BVH raytracing time should remain about the same, but BVH build time should be
significantly reduced, test here show speedup of about 5x to 10x on a dual core
and 5x to 25x on an 8-core machine, depending on the scene.
=== Threads ===
Centralized task scheduler for multithreading, which is basically the
CPU device threading code wrapped into something reusable.
Basic idea is that there is a single TaskScheduler that keeps a pool of threads,
one for each core. Other places in the code can then create a TaskPool that they
can drop Tasks in to be executed by the scheduler, and wait for them to complete
or cancel them early.
=== Normal ====
Added a Normal output to the texture coordinate node. This currently
gives the object space normal, which is the same under object animation.
In the future this might become a "generated" normal so it's also stable for
deforming objects, but for now it's already useful for non-deforming objects.
=== Render Layers ===
Per render layer Samples control, leaving it to 0 will use the common scene
setting.
Environment pass will now render environment even if film is set to transparent.
Exclude Layers" added. Scene layers (all object that influence the render,
directly or indirectly) are shared between all render layers. However sometimes
it's useful to leave out some object influence for a particular render layer.
That's what this option allows you to do.
=== Filter Glossy ===
When using a value higher than 0.0, this will blur glossy reflections after
blurry bounces, to reduce noise at the cost of accuracy. 1.0 is a good
starting value to tweak.
Some light paths have a low probability of being found while contributing much
light to the pixel. As a result these light paths will be found in some pixels
and not in others, causing fireflies. An example of such a difficult path might
be a small light that is causing a small specular highlight on a sharp glossy
material, which we are seeing through a rough glossy material. With path tracing
it is difficult to find the specular highlight, but if we increase the roughness
on the material the highlight gets bigger and softer, and so easier to find.
Often this blurring will be hardly noticeable, because we are seeing it through
a blurry material anyway, but there are also cases where this will lead to a
loss of detail in lighting.
2012-04-28 08:53:59 +00:00
|
|
|
memcpy(&tfmR, R, sizeof(R));
|
|
|
|
|
|
|
|
|
|
return tfmR;
|
2011-04-27 11:58:34 +00:00
|
|
|
}
|
|
|
|
|
|
2012-04-30 12:49:26 +00:00
|
|
|
/* Motion Transform */
|
|
|
|
|
|
2013-04-05 23:03:10 +00:00
|
|
|
float4 transform_to_quat(const Transform& tfm)
|
2012-04-30 12:49:26 +00:00
|
|
|
{
|
|
|
|
|
double trace = tfm[0][0] + tfm[1][1] + tfm[2][2];
|
|
|
|
|
float4 qt;
|
|
|
|
|
|
2012-06-09 17:45:22 +00:00
|
|
|
if(trace > 0.0) {
|
2012-04-30 12:49:26 +00:00
|
|
|
double s = sqrt(trace + 1.0);
|
|
|
|
|
|
|
|
|
|
qt.w = (float)(s/2.0);
|
|
|
|
|
s = 0.5/s;
|
|
|
|
|
|
2012-06-09 17:45:22 +00:00
|
|
|
qt.x = (float)((double)(tfm[2][1] - tfm[1][2]) * s);
|
|
|
|
|
qt.y = (float)((double)(tfm[0][2] - tfm[2][0]) * s);
|
|
|
|
|
qt.z = (float)((double)(tfm[1][0] - tfm[0][1]) * s);
|
2012-04-30 12:49:26 +00:00
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
int i = 0;
|
|
|
|
|
|
|
|
|
|
if(tfm[1][1] > tfm[i][i])
|
|
|
|
|
i = 1;
|
|
|
|
|
if(tfm[2][2] > tfm[i][i])
|
|
|
|
|
i = 2;
|
|
|
|
|
|
|
|
|
|
int j = (i + 1)%3;
|
|
|
|
|
int k = (j + 1)%3;
|
|
|
|
|
|
2012-06-09 17:45:22 +00:00
|
|
|
double s = sqrt((double)(tfm[i][i] - (tfm[j][j] + tfm[k][k])) + 1.0);
|
2012-04-30 12:49:26 +00:00
|
|
|
|
|
|
|
|
double q[3];
|
|
|
|
|
q[i] = s * 0.5;
|
|
|
|
|
if(s != 0.0)
|
|
|
|
|
s = 0.5/s;
|
|
|
|
|
|
2012-06-09 17:45:22 +00:00
|
|
|
double w = (double)(tfm[k][j] - tfm[j][k]) * s;
|
|
|
|
|
q[j] = (double)(tfm[j][i] + tfm[i][j]) * s;
|
|
|
|
|
q[k] = (double)(tfm[k][i] + tfm[i][k]) * s;
|
2012-04-30 12:49:26 +00:00
|
|
|
|
|
|
|
|
qt.x = (float)q[0];
|
|
|
|
|
qt.y = (float)q[1];
|
|
|
|
|
qt.z = (float)q[2];
|
|
|
|
|
qt.w = (float)w;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return qt;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void transform_decompose(Transform *decomp, const Transform *tfm)
|
|
|
|
|
{
|
|
|
|
|
/* extract translation */
|
|
|
|
|
decomp->y = make_float4(tfm->x.w, tfm->y.w, tfm->z.w, 0.0f);
|
|
|
|
|
|
|
|
|
|
/* extract rotation */
|
|
|
|
|
Transform M = *tfm;
|
|
|
|
|
M.x.w = 0.0f; M.y.w = 0.0f; M.z.w = 0.0f; M.w.w = 1.0f;
|
|
|
|
|
|
|
|
|
|
Transform R = M;
|
|
|
|
|
float norm;
|
|
|
|
|
int iteration = 0;
|
|
|
|
|
|
|
|
|
|
do {
|
|
|
|
|
Transform Rnext;
|
|
|
|
|
Transform Rit = transform_inverse(transform_transpose(R));
|
|
|
|
|
|
|
|
|
|
for(int i = 0; i < 4; i++)
|
|
|
|
|
for(int j = 0; j < 4; j++)
|
|
|
|
|
Rnext[i][j] = 0.5f * (R[i][j] + Rit[i][j]);
|
|
|
|
|
|
|
|
|
|
norm = 0.0f;
|
|
|
|
|
for(int i = 0; i < 3; i++) {
|
|
|
|
|
norm = max(norm,
|
|
|
|
|
fabsf(R[i][0] - Rnext[i][0]) +
|
|
|
|
|
fabsf(R[i][1] - Rnext[i][1]) +
|
|
|
|
|
fabsf(R[i][2] - Rnext[i][2]));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
R = Rnext;
|
|
|
|
|
iteration++;
|
|
|
|
|
} while(iteration < 100 && norm > 1e-4f);
|
|
|
|
|
|
|
|
|
|
if(transform_negative_scale(R))
|
|
|
|
|
R = R * transform_scale(-1.0f, -1.0f, -1.0f); /* todo: test scale */
|
|
|
|
|
|
|
|
|
|
decomp->x = transform_to_quat(R);
|
|
|
|
|
|
|
|
|
|
/* extract scale and pack it */
|
|
|
|
|
Transform scale = transform_inverse(R) * M;
|
|
|
|
|
decomp->y.w = scale.x.x;
|
|
|
|
|
decomp->z = make_float4(scale.x.y, scale.x.z, scale.y.x, scale.y.y);
|
|
|
|
|
decomp->w = make_float4(scale.y.z, scale.z.x, scale.z.y, scale.z.z);
|
|
|
|
|
}
|
|
|
|
|
|
2012-11-29 00:43:50 +00:00
|
|
|
void transform_motion_decompose(DecompMotionTransform *decomp, const MotionTransform *motion, const Transform *mid)
|
2012-04-30 12:49:26 +00:00
|
|
|
{
|
2012-11-29 00:43:50 +00:00
|
|
|
Transform pre, post;
|
|
|
|
|
|
|
|
|
|
transform_decompose(&pre, &motion->pre);
|
2012-10-17 12:55:23 +00:00
|
|
|
transform_decompose(&decomp->mid, mid);
|
2012-11-29 00:43:50 +00:00
|
|
|
transform_decompose(&post, &motion->post);
|
2012-11-11 15:02:05 +00:00
|
|
|
|
|
|
|
|
/* ensure rotation around shortest angle, negated quaternions are the same
|
|
|
|
|
* but this means we don't have to do the check in quat_interpolate */
|
2012-11-29 00:43:50 +00:00
|
|
|
if(dot(decomp->mid.x, post.x) < 0.0f)
|
2012-11-11 15:02:05 +00:00
|
|
|
decomp->mid.x = -decomp->mid.x;
|
2012-11-29 00:43:50 +00:00
|
|
|
if(dot(pre.x, decomp->mid.x) < 0.0f)
|
|
|
|
|
pre.x = -pre.x;
|
|
|
|
|
|
|
|
|
|
/* drop scale of pre/post */
|
|
|
|
|
pre.y.w = decomp->mid.y.w;
|
|
|
|
|
post.y.w = decomp->mid.y.w;
|
|
|
|
|
|
|
|
|
|
/* store translation/rotation part of pre/post */
|
|
|
|
|
decomp->pre_x = pre.x;
|
|
|
|
|
decomp->pre_y = pre.y;
|
|
|
|
|
decomp->post_x = post.x;
|
|
|
|
|
decomp->post_y = post.y;
|
2012-04-30 12:49:26 +00:00
|
|
|
}
|
|
|
|
|
|
2011-04-27 11:58:34 +00:00
|
|
|
CCL_NAMESPACE_END
|
|
|
|
|
|
