Add test for bimanual manipulation (TOPP Polygon)