11 using namespace gtsam;
16 TEST(testSimWall2D2D, construction ) {
35 TEST(testSimWall2D2D, intersection1 ) {
36 SimWall2D w1(2.0, 2.0, 6.0, 2.0), w2(4.0, 4.0, 4.0, 0.0);
40 w1.intersects(w2,
pt);
45 TEST(testSimWall2D2D, intersection2 ) {
53 TEST(testSimWall2D2D, reflection1 ) {
54 SimWall2D wall1(1.0, 1.0, 7.0, 1.0), wall2(7.0, 1.0, 1.0, 1.0);
56 Rot2 actual1 = wall1.reflection(
init, intersection);