Transform SequenceΒΆ
Demonstrates how to easily compute the result of applying multiple transforms in a sequence
1 public static void main(String[] args) {
2 InvertibleTransformSequence<Se2_F64> sequence = new InvertibleTransformSequence<Se2_F64>();
3
4 // add a few easy to understand transforms
5 sequence.addTransform(true,new Se2_F64(2,0,0));
6 sequence.addTransform(true,new Se2_F64(3,0,0));
7 sequence.addTransform(false,new Se2_F64(0,4,0));
8
9 Se2_F64 result = new Se2_F64();
10 sequence.computeTransform(result);
11
12 // should be (x=5,y=-4,yaw=0)
13 result.print();
14 }