125 |
|
Mat3x3d orderTensor(0.0); |
126 |
|
for (std::vector<std::pair<StuntDouble*, StuntDouble*> >::iterator j = sdPairs_.begin(); j != sdPairs_.end(); ++j) { |
127 |
|
Vector3d vec = j->first->getPos() - j->second->getPos(); |
128 |
+ |
currentSnapshot_->wrapVector(vec); |
129 |
|
vec.normalize(); |
130 |
|
orderTensor +=outProduct(vec, vec); |
131 |
|
} |
156 |
|
double angle = 0.0; |
157 |
|
for (std::vector<std::pair<StuntDouble*, StuntDouble*> >::iterator j = sdPairs_.begin(); j != sdPairs_.end(); ++j) { |
158 |
|
Vector3d vec = j->first->getPos() - j->second->getPos(); |
159 |
+ |
currentSnapshot_->wrapVector(vec); |
160 |
|
vec.normalize(); |
161 |
|
|
162 |
|
angle += acos(dot(vec, director)) ; |