TwoTransformsFixture()
: m_expected_first_transform(Matrix4d::translation(Vector3d(1.0, 2.0, 3.0)))
, m_expected_second_transform(Matrix4d::translation(Vector3d(4.0, 5.0, 6.0)))
{
m_sequence.set_transform(1.0, m_expected_first_transform);
m_sequence.set_transform(3.0, m_expected_second_transform);
m_sequence.prepare();
}
TransformSequence TransformSequence::operator*(const TransformSequence& rhs) const
{
TransformSequence result;
size_t lhs_i = 0, rhs_i = 0;
Transformd scratch;
while (lhs_i < m_size && rhs_i < rhs.m_size)
{
const double lhs_t = m_keys[lhs_i].m_time;
const double rhs_t = rhs.m_keys[rhs_i].m_time;
if (lhs_t == rhs_t)
{
result.set_transform(lhs_t, m_keys[lhs_i].m_transform * rhs.m_keys[rhs_i].m_transform);
++lhs_i;
++rhs_i;
}
else if (lhs_t < rhs_t)
{
result.set_transform(lhs_t, m_keys[lhs_i].m_transform * rhs.evaluate(lhs_t, scratch));
++lhs_i;
}
else
{
result.set_transform(rhs_t, evaluate(rhs_t, scratch) * rhs.m_keys[rhs_i].m_transform);
++rhs_i;
}
}
while (lhs_i < m_size)
{
const double lhs_t = m_keys[lhs_i].m_time;
result.set_transform(lhs_t, m_keys[lhs_i].m_transform * rhs.evaluate(lhs_t, scratch));
++lhs_i;
}
while (rhs_i < rhs.m_size)
{
const double rhs_t = rhs.m_keys[rhs_i].m_time;
result.set_transform(rhs_t, evaluate(rhs_t, scratch) * rhs.m_keys[rhs_i].m_transform);
++rhs_i;
}
return result;
}