| 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)) ; |