1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
|
#include "SimTKmolmodel.h"
#include "SimTKsimbody_aux.h"
#include <vector>
#include <list>
using namespace SimTK;
using namespace std;
/*
Vec3 GeometricCenter (Compound & myCompound, SimbodyMatterSubsystem & matter, State & state) {
Vec3 center(0);
for (int i = 0 ; i < myCompound.getNAtoms(); i++) {
center += (myCompound.getAtomMobilizedBody(AtomIndex(i))).findBodyTransformInAnotherBody(state,matter.Ground()) / myCompound.getNAtoms();
}
return center;
}
Vec3 GeometricCenter (Biopolymer & myCompound, int firstResidue, int lastResidue, Matter & matter, State & state) {
Vec3 center(0);
for (int i = firstResidue ; i <= lastResidue) {
Compound myResidue = myCompound.updResidue(AtomIndex(i));
for (int j = 0; j <= myResidue.getNAtoms(); j++) {
center += matter.getMobilizedBody(myResidue.getAtomMobilizedBodyIndex(AtomIndex(j))).findBodyTransformInAnotherBody(state,matter.Ground()) / myResidue.getNAtoms();
}
}
return center;
}
*/
Vec3 GeometricCenter (Biopolymer & myCompound , list<int> residueList, SimbodyMatterSubsystem & matter, State & state) {
Vec3 center(0);
list<int>::iterator i;
for(i=residueList.begin(); i != residueList.end(); ++i) {
cout<<"[GeometricCenter.h : GeometricCenter] i ="<<*i<<endl;
Compound myResidue = myCompound.updResidue(Compound::Index( *i ));
cout<<"[GeometricCenter.h] : myResidue.getNAtoms()"<<myResidue.getNAtoms()<<endl;
for (int j = 0; j < myResidue.getNAtoms(); j++) {
center += (matter.getMobilizedBody(myResidue.getAtomMobilizedBodyIndex(Compound::AtomIndex(j))).findBodyTransformInAnotherBody(state,matter.Ground())).T() / myResidue.getNAtoms();
}
}
return center;
}
|
