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
|
/*!
@file
@author Shin'ichiro Nakaoka
*/
#include "ColdetLinkPair.h"
namespace cnoid {
class Link;
ColdetLinkPair::ColdetLinkPair(Link* link1, Link* link2)
: ColdetModelPair(link1->coldetModel, link2->coldetModel) {
links[0] = link1;
links[1] = link2;
}
ColdetLinkPair::ColdetLinkPair(const ColdetLinkPair& org)
: ColdetModelPair(org) {
links[0] = org.links[0];
links[1] = org.links[1];
}
ColdetLinkPair::~ColdetLinkPair() { }
void ColdetLinkPair::updatePositions() {
model(0)->setPosition(links[0]->R, links[0]->p);
model(1)->setPosition(links[1]->R, links[1]->p);
}
Link* ColdetLinkPair::link(int index) { return links[index]; }
}
|