diff --git a/lecture_04/assignment_03/adam_anouar/Capture.PNG b/lecture_04/assignment_03/adam_anouar/Capture.PNG new file mode 100644 index 0000000..247e52a Binary files /dev/null and b/lecture_04/assignment_03/adam_anouar/Capture.PNG differ diff --git a/lecture_04/assignment_03/adam_anouar/assignment_03.ghx b/lecture_04/assignment_03/adam_anouar/assignment_03.ghx new file mode 100644 index 0000000..36bd37e --- /dev/null +++ b/lecture_04/assignment_03/adam_anouar/assignment_03.ghx @@ -0,0 +1,6005 @@ + + + + + + + + 0 + 2 + 2 + + + + + + + 1 + 0 + 7 + + + + + + c4f913db-409d-41a9-88e1-f6f90989047d + Shaded + 1 + + 100;150;0;0 + + + 100;0;150;0 + + + + + + 637527254194888879 + + assignment_03.ghx + + + + + 0 + + + + + + 114 + 92 + + 0.377149671 + + + + + 0 + + + + + + + 0 + + + + + 2 + + + + + GhPython, Version=7.28.23058.3001, Culture=neutral, PublicKeyToken=null + 7.28.23058.3001 + + 00000000-0000-0000-0000-000000000000 + + + + + + + Pufferfish, Version=3.0.0.0, Culture=neutral, PublicKeyToken=null + 3.0.0.0 + Michael Pryor + 1c9de8a1-315f-4c56-af06-8f69fee80a7a + Pufferfish + 3.0.0.0 + + + + + + + 58 + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;170;135;255 + + A group of Grasshopper objects + bfe572e7-d997-4c3c-8488-4e03d01804ea + b278407c-79b3-49ef-a2c8-ee682b33d9ef + 6fe2e9d2-130c-4a02-b347-a1c6b831fc5a + 9a4be73c-3082-4c74-be27-41c7c1688c53 + 4 + 3dd78fb5-3c65-4715-b2db-b9489d44fd71 + Group + + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;170;135;255 + + A group of Grasshopper objects + d5ffda3e-a3ab-4688-9de8-1d9d9e2789e3 + 4b0a07e0-a378-4f92-8f0a-6c1f1fb427f2 + 1d31a79f-b7ba-423f-944c-23f606999dae + eaec99d4-5f03-4209-953f-02aee1235de3 + 4a5bf47a-b0af-4831-a451-6b776364bb7e + 5 + 5a4ca04f-0f26-4978-bcce-92edaa3c4b8e + Group + + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;170;135;255 + + A group of Grasshopper objects + 781a5de8-c54c-4805-927f-519a45da032f + 4b0a07e0-a378-4f92-8f0a-6c1f1fb427f2 + 1d31a79f-b7ba-423f-944c-23f606999dae + eaec99d4-5f03-4209-953f-02aee1235de3 + 4a5bf47a-b0af-4831-a451-6b776364bb7e + 20c7f0ab-fd13-4bd7-a130-c6fe893d2a0b + 47c152bc-c823-4835-aad3-3bf5c281e892 + d19cf29a-0512-4632-b4e0-ecc00c5b8487 + 2ceac33a-a5ff-4a42-8067-32e6a2c7fbee + ac227038-eb23-4cb5-94d8-f63bb92375a4 + b3787c61-219b-4ed9-b49f-1e7dd56236b1 + b395bfb0-5717-46c4-924c-a3ba167b1e0d + 4e66fe1b-29b3-4955-9524-ca986decd9ac + 78471367-17af-4599-8661-808ba87f82a6 + bfa816f1-e4c0-482e-9515-4b540fd2f427 + 82091d9c-f1c0-4207-8d3d-b1dca673d5df + 5d051c72-528a-498d-a91b-f91e344562b4 + baea3a7f-42ad-4480-b62c-39cd2f8c2e8a + 18 + 8b8d6fbf-db19-4267-9188-c4fdd76620b6 + Group + + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + 4e66fe1b-29b3-4955-9524-ca986decd9ac + Data + Robot + false + 846547a4-0964-4bea-b2e5-d3fd03e0ff69 + 1 + + + + + + 1254 + 168 + 50 + 24 + + + 1279.353 + 180.9772 + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 46.70692 + 119.7138 + + + 272.0458 + 119.7138 + + + 272.0458 + 139.8124 + + + 46.70692 + 139.8124 + + A quick note + Cambria + 82091d9c-f1c0-4207-8d3d-b1dca673d5df + false + Scribble + Scribble + 22 + 1) Load robot from ROS + + + + + + 41.70692 + 114.7138 + 235.3389 + 30.09864 + + + 46.70692 + 119.7138 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + aacb02be-ffde-4997-b910-3a5670a6e5b1 + Data + Target planes + false + 44d4a187-3a93-413f-992e-d4cc7e2e19ad + 1 + + + + + + 1240 + 476 + 50 + 24 + + + 1265.041 + 488.8133 + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;240;218;146 + + A group of Grasshopper objects + 0c3c0677-cbf3-46be-b539-e48399697bc7 + de6b7a53-8f17-48cc-bb14-1aedc473dd1c + 04770360-9eb5-44e4-911f-142deec44bdc + aacb02be-ffde-4997-b910-3a5670a6e5b1 + 50ee1702-2c6a-4092-b68b-7fd9ec30c129 + 9dbe68e7-ae2d-4df4-89a9-ae0ec5759854 + d17c9d6f-7bf6-411c-816c-4c1caad151b9 + 37fef6aa-0c60-4da4-9d31-1ae0bdd95cd2 + d6cabb95-93fe-48fe-9b1b-2070fdd10e56 + 3974a64b-9fea-4aa6-a9ad-21315ef8260a + b171143f-e5e1-4bc8-92f7-eb329037f691 + 11 + cf91e427-c398-45be-b915-f55275cc67b7 + Group + + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + d385349b-7e03-4362-b9d0-eacd34e2562b + Data + Pickup plane + false + 3a86f18b-7506-4d48-8a5c-6048a1108886 + 1 + + + + + + 1241 + 348 + 50 + 24 + + + 1266.929 + 360.6916 + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;240;218;146 + + A group of Grasshopper objects + d385349b-7e03-4362-b9d0-eacd34e2562b + 66c3b06d-1415-476b-875b-53498de1860a + c9e84bc7-5f07-46ef-9e42-32f7d85d0c13 + 39a429c7-2480-4ff8-8f4c-5bd8a47369a7 + 224add91-1cc7-47af-8c77-af2d42147144 + ff0bbdd7-eb5b-4ed6-a652-505db2c0ac8c + 13d747bd-3e05-4a41-8ea0-75bad3d5248b + dd675efd-9233-4ad4-bb47-4b8f4932cc90 + 68575641-3532-400d-95f0-a0242e51e625 + eb5acce9-f665-4261-a8bc-ffd4947a64da + 0bd900d0-2016-4c53-af3b-1c52cf194064 + 11 + 3c032157-3bf9-40ee-9b12-e4e807d15ccc + Group + + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 46.70692 + 281.4785 + + + 269.3387 + 281.4785 + + + 269.3387 + 301.5771 + + + 46.70692 + 301.5771 + + A quick note + Cambria + ff0bbdd7-eb5b-4ed6-a652-505db2c0ac8c + false + Scribble + Scribble + 22 + 2) Define pick-up plane + + + + + + 41.70692 + 276.4785 + 232.6318 + 30.09863 + + + 46.70692 + 281.4785 + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 46.70692 + 431.5476 + + + 263.9891 + 431.5476 + + + 263.9891 + 451.7751 + + + 46.70692 + 451.7751 + + A quick note + Cambria + 9dbe68e7-ae2d-4df4-89a9-ae0ec5759854 + false + Scribble + Scribble + 22 + 3) Define target planes + + + + + + 41.70692 + 426.5476 + 227.2822 + 30.22754 + + + 46.70692 + 431.5476 + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + Robot Visualize + + + + + """ +Visualizes the robot. + +COMPAS FAB v0.27.0 +""" +from compas.artists import Artist +from compas.geometry import Frame +from compas.geometry import Transformation +from compas_fab.robots import PlanningScene +from ghpythonlib.componentbase import executingcomponent as component + + +class RobotVisualize(component): + def RunScript( + self, + robot, + group, + configuration, + show_visual, + show_collision, + show_frames, + show_base_frame, + show_end_effector_frame, + show_cm, + show_acm, + ): + + visual = None + collision = None + collision_meshes = None + attached_meshes = None + frames = None + base_frame = None + ee_frame = None + + if robot: + show_visual = True if show_visual is None else show_visual + show_cm = True if show_cm is None else show_cm + show_acm = True if show_acm is None else show_acm + configuration = configuration or robot.zero_configuration() + + robot.update(configuration, visual=show_visual, collision=show_collision) + compas_frames = robot.transformed_frames(configuration, group) + + if show_visual: + visual = robot.artist.draw_visual() + + if show_collision: + collision = robot.artist.draw_collision() + + if show_base_frame: + base_compas_frame = compas_frames[0] + artist = Artist(base_compas_frame) + base_frame = artist.draw() + + if show_end_effector_frame: + ee_compas_frame = robot.forward_kinematics( + configuration, group, options=dict(solver="model") + ) + artist = Artist(ee_compas_frame) + ee_frame = artist.draw() + + if show_frames: + frames = [] + for compas_frame in compas_frames[1:]: + artist = Artist(compas_frame) + frame = artist.draw() + frames.append(frame) + + if show_cm or show_acm: + scene = PlanningScene(robot) + scene = robot.client.get_planning_scene() + + collision_meshes = [] + attached_meshes = [] + + if show_cm: + for co in scene.world.collision_objects: + header = co.header + frame_id = header.frame_id + cms = co.to_collision_meshes() + + for cm in cms: + if cm.frame != Frame.worldXY(): + t = Transformation.from_frame(cm.frame) + mesh = cm.mesh.transformed(t) + else: + mesh = cm.mesh + + collision_meshes.append(Artist(mesh).draw()) + + if show_acm: + for aco in scene.robot_state.attached_collision_objects: + for acm in aco.to_attached_collision_meshes(): + frame_id = aco.object["header"]["frame_id"] + frame = robot.forward_kinematics( + configuration, options=dict(link=frame_id) + ) + t = Transformation.from_frame(frame) + + # Local CM frame + if ( + acm.collision_mesh.frame + and acm.collision_mesh.frame != Frame.worldXY() + ): + t = t * Transformation.from_frame( + acm.collision_mesh.frame + ) + + mesh = acm.collision_mesh.mesh.transformed(t) + + attached_meshes.append(Artist(mesh).draw()) + + return ( + visual, + collision, + collision_meshes, + attached_meshes, + frames, + base_frame, + ee_frame, + ) + + Visualizes the robot. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALDwAACw8BkvkDpQAAAdhJREFUSEu1lLFKA0EQhlUIQVBMOhGLgGAtxAcIYmmRJpWNrZ2dhSCWqURtxC6VRSofIYWlhS8QyBMEOzvP/zt2jtm9VSLEg+9ud2bnn9nZu1spiuJfyRqXSdb4F3ZvX1vigmfOXzP8FQm/iEJ8iH7qjyZUIUZiIgjseb9HvjMxE4jbE4jt2Lo0CGca0BOI3Ti8nzGFdYTFv9cShAWlUzyK6zC/E9aGHFFbND8Q1c5TBwHPgiQPYU4C2uZFPVEbNa/aA9wqg5wIE2RP6AuSsH2DAzV/2Q49aRPtwzYzTW5VBXKwC+sjIvQ+qiiso52IWSG00B941CKfwA7UDs0qqiUJ61nnD5z10ffALe2hb48x8Ws88lEIhWWLqBnC4jQBRIUsStYosdxbUx6croFgAJcWo6st5sE+ruw28EiMbfs3xbjBnxWKEw8quw1SEEvEgaQtCQydWJv1zjb3OpFoisT8G2KMJNINYlBWq8t2NfQakWCKxH48cAlNg+CT8AmPvUYkCArmq82JRmydnJeCa+sbX42dvfsgPk31ogko2L7kX9m+GpcJYLXR/AzjqD0QTUDBCyWA5v5hlSTQTfWiCSiQX4X91H5l8+jUzgHeUi2oGZZN1rg8ipVvhzuVIxcFIsQAAAAASUVORK5CYII= + + false + 7a58f25a-3dc8-4dfa-bf0f-35404273569e + true + true + Robot Visualize + Robot Visualize + + + + + + 2356 + 139 + 257 + 204 + + + 2503 + 241 + + + + + + 10 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 7 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The robot. + 439bbb30-bb2a-4f39-bfd6-8205cd93fd09 + robot + robot + true + 0 + true + 619d4216-bdfd-4395-b679-83b02e397c53 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + 2 + + + + + + 2358 + 141 + 130 + 20 + + + 2424.5 + 151 + + + + + + + + true + The planning group used for end-effector and base visualization. + ad36f822-0439-4ba3-b51a-c348f6f591ec + group + group + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 2358 + 161 + 130 + 20 + + + 2424.5 + 171 + + + + + + + + true + The robot's full configuration. + 9fb95b19-f673-4906-9998-b63a5811ea88 + configuration + configuration + true + 0 + true + 4ca3f55b-10fb-41c3-9f24-2b4809b96eeb + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 2358 + 181 + 130 + 20 + + + 2424.5 + 191 + + + + + + + + true + Whether or not to show the robot's visual meshes. + 22d8ace2-7a15-4a22-9430-2f721280765e + show_visual + show_visual + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 201 + 130 + 20 + + + 2424.5 + 211 + + + + + + + + true + Whether or not to show the robot's collision meshes. + ad827435-eaa9-47db-8456-0f04c22dde3a + show_collision + show_collision + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 221 + 130 + 20 + + + 2424.5 + 231 + + + + + + + + true + Whether or not to show the robot's joint frames. + 35824dc3-741e-4a85-9d9f-f350f6328850 + show_frames + show_frames + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 241 + 130 + 20 + + + 2424.5 + 251 + + + + + + + + true + Whether or not to show the robot's base frame. + 5c36de85-2908-4ed4-8bfb-be05a5fc15a0 + show_base_frame + show_base_frame + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 261 + 130 + 20 + + + 2424.5 + 271 + + + + + + + + true + Whether or not to show the robot's end-effector frame. + 43679585-4dff-44fc-8144-04d51b6597a3 + show_end_effector_frame + show_end_effector_frame + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 281 + 130 + 20 + + + 2424.5 + 291 + + + + + + + + true + Whether or not to show the collision meshes (if any). + b0245b8b-4b25-480e-8434-34500dd361dd + show_cm + show_cm + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 301 + 130 + 20 + + + 2424.5 + 311 + + + + + + + + true + Whether or not to show the attached collision meshes (if any). + c258dd5f-afd6-4742-9840-e8ae6df45c59 + show_acm + show_acm + true + 0 + true + 0 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 2358 + 321 + 130 + 20 + + + 2424.5 + 331 + + + + + + + + Rhino meshes of the robot's visual geometry (if any). + b51fd205-41de-4772-b77b-54118aa40c2c + visual + visual + false + 0 + + + + + + 2518 + 141 + 93 + 28 + + + 2564.5 + 155.2857 + + + + + + + + Rhino meshes of the robot's collision geometry (if any). + 3fd4309e-805a-4b2a-8b39-fb39cda51d21 + collision + collision + false + 0 + + + + + + 2518 + 169 + 93 + 29 + + + 2564.5 + 183.8571 + + + + + + + + Rhino meshes of the scene's collision meshes (if any). + ba8f5aaf-7d4f-4021-b0f3-328651e5f766 + collision_meshes + collision_meshes + false + 0 + + + + + + 2518 + 198 + 93 + 28 + + + 2564.5 + 212.4286 + + + + + + + + Rhino meshes of the scene's attached collision meshes (if any). + 00b4652c-1968-4bef-b124-5b86f4dc25bc + attached_meshes + attached_meshes + false + 0 + + + + + + 2518 + 226 + 93 + 29 + + + 2564.5 + 241 + + + + + + + + The robot's joint frames as Rhino planes (if any). + 243eeb3c-e1ad-4233-9a1a-b0ec9fd1c962 + frames + frames + false + 0 + + + + + + 2518 + 255 + 93 + 28 + + + 2564.5 + 269.5714 + + + + + + + + The robot's base frame as a Rhino plane (if any). + 91fd1995-e0da-4f23-a4c6-afeefc044dee + base_frame + base_frame + false + 0 + + + + + + 2518 + 283 + 93 + 29 + + + 2564.5 + 298.1429 + + + + + + + + The robot's end-effector frame as a Rhino plane (if any). + 5a2c4711-ae2f-4f0f-b633-afc7c8fccfd2 + ee_frame + ee_frame + false + 0 + + + + + + 2518 + 312 + 93 + 29 + + + 2564.5 + 326.7143 + + + + + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 46.70692 + 651.1613 + + + 317.5712 + 651.1613 + + + 317.5712 + 671.2599 + + + 46.70692 + 671.2599 + + A quick note + Cambria + fccb98c9-c6e5-4caa-8384-ca0ddf85fd1f + false + Scribble + Scribble + 22 + 4) Solve IK for pick-up plane + + + + + + 41.70692 + 646.1613 + 280.8643 + 30.09863 + + + 46.70692 + 651.1613 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + 02bc89eb-6961-419b-a5c7-ecf1d7beb296 + Data + Pickup config + false + 1d8af690-69c5-4c9f-b553-1a05f97e8281 + 1 + + + + + + 1242 + 734 + 50 + 24 + + + 1267.176 + 746.6949 + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 73.59002 + 675.2849 + + + 238.8635 + 675.2849 + + + 238.8635 + 689.9958 + + + 73.59002 + 689.9958 + + A quick note + Cambria + 6e5b9db8-970d-4e5b-bf3d-6ec1c492b072 + false + Scribble + Scribble + 16 + Results in pickup config + + + + + + 68.59002 + 670.2849 + 175.2734 + 24.71094 + + + 73.59002 + 675.2849 + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;240;218;146 + + A group of Grasshopper objects + fccb98c9-c6e5-4caa-8384-ca0ddf85fd1f + 02bc89eb-6961-419b-a5c7-ecf1d7beb296 + 6e5b9db8-970d-4e5b-bf3d-6ec1c492b072 + fb4c5d39-e0a5-4c45-b606-72de43c589ac + b96209a7-93e4-4212-b096-c83e82b4da7b + 98209ace-c305-4683-b351-d9b9daf31e36 + df49cbca-ec61-4dc7-8c55-18e7e63a3700 + 5c90bf29-e6aa-4294-8822-68408c74406a + 8 + 3962a36b-d451-45d1-acb9-c99a5708db90 + Group + + + + + + + + + + + 00027467-0d24-4fa7-b178-8dc0ac5f42ec + Value List + + + + + Provides a list of preset values to choose from + 137a3255-a54e-4e4c-a9c3-e6d902b2a8bb + 2 + 3 + Value List + List + false + 0 + + + + + 0 + Pickup config + false + + + + + 1 + Trajectory + true + + + + + + 1591 + 171 + 123 + 22 + + + + + + + + + + eeafc956-268e-461d-8e73-ee05c6f72c01 + Stream Filter + + + + + Filters a collection of input streams + 471af287-d88e-43f4-9bb2-98daa088f633 + Stream Filter + Filter + + + + + + 2046 + 170 + 77 + 64 + + + 2078 + 202 + + + + + + 3 + 2e3ab970-8545-46bb-836c-1c11e5610bce + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + Index of Gate stream + fde7ac2c-1b3d-473c-8b2b-4addc4d52e1a + Gate + G + false + 137a3255-a54e-4e4c-a9c3-e6d902b2a8bb + 1 + + + + + + 2048 + 172 + 15 + 20 + + + 2057 + 182 + + + + + + 1 + + + + + 1 + {0} + + + + + 0 + + + + + + + + + + + 2 + Input stream at index 0 + e6a67ce5-d55f-4ec2-a44c-573291be81a5 + false + Stream 0 + 0 + true + a38644b3-ef3b-4bc2-bf1d-8843907a4a1f + 1 + + + + + + 2048 + 192 + 15 + 20 + + + 2057 + 202 + + + + + + + + 2 + Input stream at index 1 + 14985ec3-7977-426f-bc6b-ad27afc61e04 + false + Stream 1 + 1 + true + a4b043bc-8e30-4b4c-bb40-e7f42497696d + 1 + + + + + + 2048 + 212 + 15 + 20 + + + 2057 + 222 + + + + + + + + 2 + Filtered stream + ddfd1927-535b-4f08-acf1-f1762fa62a54 + false + Stream + S(1) + false + 0 + + + + + + 2093 + 172 + 28 + 60 + + + 2107 + 202 + + + + + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;0;155;194 + + A group of Grasshopper objects + 7a58f25a-3dc8-4dfa-bf0f-35404273569e + 137a3255-a54e-4e4c-a9c3-e6d902b2a8bb + 471af287-d88e-43f4-9bb2-98daa088f633 + 766f518e-d29b-4814-a406-a45e5ded4a64 + e4b338fe-125d-4929-92e1-4e17c08f9b3b + f53212f5-507f-4bda-b372-34bf2b7020a3 + a38644b3-ef3b-4bc2-bf1d-8843907a4a1f + e9d20ac9-0dbc-44cb-9f48-878ae446678f + 619d4216-bdfd-4395-b679-83b02e397c53 + df7fb28b-31b3-40c8-ab8a-ec66c12ea055 + 10 + ca0ff086-508f-4122-8664-195d1a456efe + Group + + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 1582.769 + 120.3864 + + + 1707.131 + 120.3864 + + + 1707.131 + 135.9303 + + + 1582.769 + 135.9303 + + A quick note + Cambria + 766f518e-d29b-4814-a406-a45e5ded4a64 + false + Scribble + Scribble + 22 + Visualization + + + + + + 1577.769 + 115.3864 + 134.3623 + 25.54395 + + + 1582.769 + 120.3864 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + b96209a7-93e4-4212-b096-c83e82b4da7b + Data + Pickup plane + false + d385349b-7e03-4362-b9d0-eacd34e2562b + 1 + 2 + + + + + + 201 + 724 + 50 + 24 + + + 226.7217 + 736.2081 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + 98209ace-c305-4683-b351-d9b9daf31e36 + Data + Robot + false + 4e66fe1b-29b3-4955-9524-ca986decd9ac + 1 + 2 + + + + + + 70 + 709 + 50 + 24 + + + 95.8785 + 721.4962 + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 46.70692 + 861.2363 + + + 379.9403 + 861.2363 + + + 379.9403 + 881.4102 + + + 46.70692 + 881.4102 + + A quick note + Cambria + ba94b074-3f68-4274-8b84-f87aa5c4cb3e + false + Scribble + Scribble + 22 + 5) Plan trajectory to selected plane + + + + + + 41.70692 + 856.2363 + 343.2334 + 30.17383 + + + 46.70692 + 861.2363 + + + + + + + + + + 7f5c6c55-f846-4a08-9c9a-cfdc285cc6fe + Scribble + + + + + false + + 75.11641 + 888.1221 + + + 314.8351 + 888.1221 + + + 314.8351 + 902.833 + + + 75.11641 + 902.833 + + A quick note + Cambria + 01b0a494-be40-47b6-bdc4-7c92967b9f38 + false + Scribble + Scribble + 16 + From pickup config to target plane + + + + + + 70.11641 + 883.1221 + 249.7187 + 24.71094 + + + 75.11641 + 888.1221 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + 55db7485-e593-4762-a166-64303d976c7a + Data + Target planes + false + aacb02be-ffde-4997-b910-3a5670a6e5b1 + 1 + 2 + + + + + + 81 + 988 + 50 + 24 + + + 106.0911 + 1000.628 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + 538c02c6-6b3b-4712-a784-dda0bc63f847 + Data + Robot + false + 4e66fe1b-29b3-4955-9524-ca986decd9ac + 1 + 2 + + + + + + 82 + 931 + 50 + 24 + + + 107.0106 + 943.0975 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + c666c109-2ccb-4c50-90cd-00130af76eaa + Data + Pickup config + false + 02bc89eb-6961-419b-a5c7-ecf1d7beb296 + 1 + 2 + + + + + + 81 + 959 + 50 + 24 + + + 106.6234 + 971.4724 + + + + + + + + + + 57da07bd-ecab-415d-9d86-af36d7073abc + Number Slider + + + + + Numeric slider for single values + e4b338fe-125d-4929-92e1-4e17c08f9b3b + Number Slider + + false + 0 + + + + + + 1591 + 205 + 160 + 20 + + + 1591.409 + 205.586 + + + + + + 3 + 1 + 1 + 100 + 0 + 0 + 21 + + + + + + + + + 59daf374-bc21-4a5e-8282-5504fb7ae9ae + List Item + + + + + 0 + Retrieve a specific item from a list. + df7fb28b-31b3-40c8-ab8a-ec66c12ea055 + List Item + Item + + + + + + 2163 + 190 + 64 + 64 + + + 2197 + 222 + + + + + + 3 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 2e3ab970-8545-46bb-836c-1c11e5610bce + cb95db89-6165-43b6-9c41-5702bc5bf137 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + 1 + Base list + 39c89e61-bc93-43d0-a501-c5bba7a3da6e + List + L + false + ddfd1927-535b-4f08-acf1-f1762fa62a54 + 1 + + + + + + 2165 + 192 + 17 + 20 + + + 2175 + 202 + + + + + + + + Item index + 83d287eb-3d9d-4785-b735-156766b364e7 + Index + i + false + e4b338fe-125d-4929-92e1-4e17c08f9b3b + 1 + + + + + + 2165 + 212 + 17 + 20 + + + 2175 + 222 + + + + + + 1 + + + + + 1 + {0} + + + + + 0 + + + + + + + + + + + Wrap index to list bounds + 60da4aea-66d4-49fc-8aa9-a5189edc913b + Wrap + W + false + 0 + + + + + + 2165 + 232 + 17 + 20 + + + 2175 + 242 + + + + + + 1 + + + + + 1 + {0} + + + + + true + + + + + + + + + + + Item at {i'} + 4ca3f55b-10fb-41c3-9f24-2b4809b96eeb + false + Item + i + false + 0 + + + + + + 2212 + 192 + 13 + 60 + + + 2218.5 + 222 + + + + + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + bcf27a28-24e5-4d31-8438-444d7fe511cb + Data + Trajectory + false + 4e17b2ad-e9af-41eb-b6a5-7585e1f6e333 + 1 + + + + + + 1246 + 954 + 50 + 24 + + + 1271.31 + 966.862 + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + GhPython Script + + + + + configs = trajectory.points + GhPython provides a Python script component + + 182 + 182 + + + 558 + 571 + + true + true + 2 + false + f53212f5-507f-4bda-b372-34bf2b7020a3 + false + true + GhPython Script + get configs + + + + + + 1704 + 315 + 132 + 28 + + + 1774 + 329 + + + + + + 1 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + Script variable Python + 50f68354-3c25-4a84-a5f7-ddaf267be516 + trajectory + trajectory + true + 0 + true + e9d20ac9-0dbc-44cb-9f48-878ae446678f + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 1706 + 317 + 53 + 24 + + + 1734 + 329 + + + + + + + + Script output configs. + a4b043bc-8e30-4b4c-bb40-e7f42497696d + configs + configs + false + 0 + + + + + + 1789 + 317 + 45 + 24 + + + 1811.5 + 329 + + + + + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + a38644b3-ef3b-4bc2-bf1d-8843907a4a1f + Data + Pickup config + false + 02bc89eb-6961-419b-a5c7-ecf1d7beb296 + 1 + 2 + + + + + + 1605 + 298 + 50 + 24 + + + 1630.11 + 310.7518 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + e9d20ac9-0dbc-44cb-9f48-878ae446678f + Data + Trajectory + false + bcf27a28-24e5-4d31-8438-444d7fe511cb + 1 + 2 + + + + + + 1596 + 322 + 50 + 24 + + + 1621.626 + 334.0815 + + + + + + + + + + 8ec86459-bf01-4409-baee-174d0d2b13d0 + Data + + + + + Contains a collection of generic data + 619d4216-bdfd-4395-b679-83b02e397c53 + Data + Robot + false + 4e66fe1b-29b3-4955-9524-ca986decd9ac + 1 + 2 + + + + + + 1591 + 273 + 50 + 24 + + + 1616.464 + 285.9058 + + + + + + + + + + c552a431-af5b-46a9-a8a4-0fcbc27ef596 + Group + + + + + 1 + + 150;240;218;146 + + A group of Grasshopper objects + ba94b074-3f68-4274-8b84-f87aa5c4cb3e + 01b0a494-be40-47b6-bdc4-7c92967b9f38 + 55db7485-e593-4762-a166-64303d976c7a + 97392278-c93e-4240-86e9-5e59dc2eb992 + 4a09e38e-e49b-43a1-809e-f310b5a4c3e2 + 1f8b3c58-8382-468d-8885-a179a0ad05e0 + 538c02c6-6b3b-4712-a784-dda0bc63f847 + c666c109-2ccb-4c50-90cd-00130af76eaa + 13b3eb29-3c6d-41ba-80fe-d6214ebc9674 + 9d4e5cda-5bb7-42fe-acfa-968fa6c6c067 + cd76efff-9d02-4eb1-b6dd-080d6a0e6d4d + bcf27a28-24e5-4d31-8438-444d7fe511cb + d93333c1-6121-4133-94e5-b1cdbd79792d + 8a1cd44e-8393-4da1-ba94-6a53dd4e3f37 + 54d5165c-c7b9-4b61-a3f4-725adfe6cedb + 15 + 4c3c7466-b1c2-4942-9ac0-63cb70a5b6b7 + Group + + + + + + + + + + + 59e0b89a-e487-49f8-bab8-b5bab16be14c + Panel + + + + + A panel for custom notes and text values + ecc8c71a-07d9-4980-90b1-a3cd2f8081a6 + Panel + + false + 0 + 0 + Define multiple target planes in any way you like, for example, +reference a curve from Rhino, divide it and assign a plane to each point + +Make sure all planes are oriented in a way that makes sense +for the robot to reach it as well. + + + + + + -530 + 485 + 523 + 96 + + 0 + 0 + 0 + + + + + 3 + + 255;255;250;90 + + true + true + true + false + false + true + + + + + Courier New + 8 + + + + + + + + + + + 59e0b89a-e487-49f8-bab8-b5bab16be14c + Panel + + + + + A panel for custom notes and text values + fb166dfc-4abf-4aa5-9ecf-d86922966dfe + Panel + + false + 0 + 0 + Define one pick-up plane in any way you like, +for example, reference a point from Rhino and assign a plane to it. + +Make sure the plane is oriented in a way that makes sense +for the robot to reach it. You can check this by observing the +results of the IK solution for this pickup-plane. + + + + + + -536 + 293 + 529 + 96 + + 0 + 0 + 0 + + -535.2353 + 293.4706 + + + + + + 3 + + 255;255;250;90 + + true + true + true + false + false + true + + + + + Courier New + 8 + + + + + + + + + + + 59e0b89a-e487-49f8-bab8-b5bab16be14c + Panel + + + + + A panel for custom notes and text values + c7cc41e4-23fe-4958-87c2-e75feb10ebac + Panel + + false + 0 + 0 + Load the robot from ROS. + +Make sure ROS/MoveIt is running before you start (ie. "Compose up"). + + + + + + -536 + 124 + 529 + 96 + + 0 + 0 + 0 + + -535.2353 + 124.4706 + + + + + + 3 + + 255;255;250;90 + + true + true + true + false + false + true + + + + + Courier New + 8 + + + + + + + + + + + 59e0b89a-e487-49f8-bab8-b5bab16be14c + Panel + + + + + A panel for custom notes and text values + 3f032319-94be-407d-8e0f-7615f6976834 + Panel + + false + 0 + 0 + Use inverse kinematics of the robot to find +a feasible configuration to reach the pickup plane. + +You can use the COMPAS FAB component or +code it in a GHPython component. + + + + + + -530 + 680 + 523 + 96 + + 0 + 0 + 0 + + -529.5882 + 680.8822 + + + + + + 3 + + 255;255;250;90 + + true + true + true + false + false + true + + + + + Courier New + 8 + + + + + + + + + + + 59e0b89a-e487-49f8-bab8-b5bab16be14c + Panel + + + + + A panel for custom notes and text values + 1f02a236-cf56-4437-8d21-1243b22a7b8e + Panel + + false + 0 + 0 + With the pickup config and a list of target planes, you are ready to compute the solution trajectory for each plane. + +First create a constraint from the selected plane, then use the plan free-space motion to calculate a trajectory. + + + + + + -530 + 942 + 523 + 96 + + 0 + 0 + 0 + + -529.353 + 942.6469 + + + + + + 3 + + 255;255;250;90 + + true + true + true + false + false + true + + + + + Courier New + 8 + + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + ROS Connect + + + + + """ +Connect or disconnect to ROS. + +COMPAS FAB v0.27.0 +""" +from ghpythonlib.componentbase import executingcomponent as component +from scriptcontext import sticky as st + +from compas_fab.backends import RosClient +from compas_fab.ghpython.components import create_id + + +class ROSConnect(component): + def RunScript(self, ip, port, connect): + ros_client = None + + ip = ip or '127.0.0.1' + port = port or 9090 + + key = create_id(self, 'ros_client') + ros_client = st.get(key, None) + + if ros_client: + st[key].close() + if connect: + st[key] = RosClient(ip, port) + st[key].run(5) + + ros_client = st.get(key, None) + is_connected = ros_client.is_connected if ros_client else False + return (ros_client, is_connected) + + Connect or disconnect to ROS. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALEAAACxABrSO9dQAAAdZJREFUSEu1lD2O4kAQRrkBcwP2BnADfARuABEhcAMcEEyCQKuVCCEkY27A3ADCyUAimQyHm/V+r9bNNp5iSLwtPWF/9dvdZRohhP+KK9aJK9aJK9aJKzpk4k08W4XYiB/CYquJPJbX6zVMp9PQbrcV0XhIt9sN6/VaIVZoQLyXMGVC8piYXwp5jMfj0Gq1zK/f7yvUVsdLGnkRBV0RlHT2/g2WHH+KonmJI4PD4ZA6HwVFPd9IR1hTzWZTj76Tcjay1Wr1QWIKnE6n0Ov17DnhXeSiWnTJbvHZ7/d3BkNrg3E2m/2OBbiH4XCITkLg+YhNnMVtakRuib0CWgMMYlMUxetutzPH8vwZ00f+HB8auznHe6CxagDdnMt3ztPOkunAWYsiPcF3YYxGo19ZloXtdvtT78d4b9yDVpEmf8Eg8qiJt7gLCi0WC9v2IxjV6Mu9aU3SAh2MYhI1wZaPBMcZfwadl8n5oqX8Sya7OZkhgSJoge1Xu04pE/Ot3E4hTUQBmyDB+d7ZBIU4f4INBmE+n3/meR4ul8tS2pe4+5e/91CURRjH7BuYIIYCX/vf8fgqaKYFHxEvz6CZh8nBFUGLQl7nN7y4Kq5YJ65YJ65YJ65YH6HxB7b14P1B22tpAAAAAElFTkSuQmCC + + false + 5d051c72-528a-498d-a91b-f91e344562b4 + true + true + ROS Connect + ROS + + + + + + 329 + 114 + 153 + 64 + + + 392 + 146 + + + + + + 3 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 2 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The ip address ROS. Defaults to 127.0.0.1. + 9f8ec376-61c8-4a5a-9978-8260b3433971 + ip + ip + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 331 + 116 + 46 + 20 + + + 355.5 + 126 + + + + + + + + true + The port of ROS. Defaults to 9090. + 606cb857-159f-4994-b643-f4573ca19d5f + port + port + true + 0 + true + 0 + 48d01794-d3d8-4aef-990e-127168822244 + + + + + + 331 + 136 + 46 + 20 + + + 355.5 + 146 + + + + + + + + true + If True, connects to ROS. If False, disconnects from ROS. Defaults to False. + f3e97277-64e0-4595-adcd-93143d53f341 + connect + connect + true + 0 + true + f9dd4743-5ef1-4938-a2ce-b61e2f89ff71 + 1 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 331 + 156 + 46 + 20 + + + 355.5 + 166 + + + + + + + + The ROS client. + 1c3a0665-a31f-4f6b-a343-89073c77e7a7 + ros_client + ros_client + false + 0 + + + + + + 407 + 116 + 73 + 30 + + + 443.5 + 131 + + + + + + + + True if connection established. + 17ce31a9-caeb-4613-ab0b-fb88664811c6 + is_connected + is_connected + false + 0 + + + + + + 407 + 146 + 73 + 30 + + + 443.5 + 161 + + + + + + + + + + + + + + 2e78987b-9dfb-42a2-8b76-3923ac8bd91a + Boolean Toggle + + + + + Boolean (true/false) toggle + f9dd4743-5ef1-4938-a2ce-b61e2f89ff71 + Boolean Toggle + Toggle + false + 0 + true + + + + + + 106 + 163 + 104 + 22 + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + ROS Robot + + + + + """ +Load robot directly from ROS. + +COMPAS FAB v0.27.0 +""" +from compas_ghpython.artists import RobotModelArtist +from ghpythonlib.componentbase import executingcomponent as component +from scriptcontext import sticky as st + +from compas_fab.ghpython.components import create_id + + +class ROSRobot(component): + def RunScript(self, ros_client, load): + key = create_id(self, 'robot') + + if ros_client and ros_client.is_connected and load: + # Load URDF from ROS + st[key] = ros_client.load_robot(load_geometry=True, precision='12f') + st[key].artist = RobotModelArtist(st[key].model) + + robot = st.get(key, None) + if robot: # client sometimes need to be restarted, without needing to reload geometry + robot.client = ros_client + return robot + + Load robot directly from ROS. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALEAAACxABrSO9dQAAAVtJREFUSEu9lMFRwzAQRVMCJaSElJASUgIlUAGTEhguXHPinBJSAiWkBDow/9n6ZmWtQzwYduaNpdVqtf5redN13Z+SOtckdS5B9iCeeKbrmXMJsrNg8CkOzXo1Gao5iYtg4z6uR2SP4iqY+Ans3Y5xk00sTjfsBcmOgbjOmMK2wvs/mgNKQL8o3sRzmb8Iy5BRySLbifHNpwsM3gWHvJY5ByAb44xKRtkoTz+vJkNiBn7CQXAIr29oqNd7OWTIhHxMrmNOD0oQb2EdSYL2VUUlDjlJ5kKQMDa8lahsdEPdNFfUHFLiiYsNJ766D9WG3lHLYy7TOCOjEArLi2gcQ7ATR2bvxC1yZ/7VjI1bQu4cXjt+KeaYxd8idQLJQmLDoelPbY7UaWTxCzGnLHaO1Glkv2546xhubUz2E8i2m+YxreP7Ji9htvmt4x8O4Ffhn9q93C/R2qTO9eg2XxfZxOCoCLXEAAAAAElFTkSuQmCC + + false + baea3a7f-42ad-4480-b62c-39cd2f8c2e8a + true + true + ROS Robot + Robot + + + + + + 525 + 137 + 124 + 44 + + + 595 + 159 + + + + + + 2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The ROS client. + f7ba96f4-94e2-4197-b4a3-31f6a0ca2f34 + ros_client + ros_client + true + 0 + true + 1c3a0665-a31f-4f6b-a343-89073c77e7a7 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 527 + 139 + 53 + 20 + + + 555 + 149 + + + + + + + + true + If True, loads the robot from ROS. Defaults to False. + e89e10b5-2ece-44bd-87f9-1811ce89ed0b + load + load + true + 0 + true + f9dd4743-5ef1-4938-a2ce-b61e2f89ff71 + 1 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 527 + 159 + 53 + 20 + + + 555 + 169 + + + + + + + + The robot. + 846547a4-0964-4bea-b2e5-d3fd03e0ff69 + robot + robot + false + 0 + + + + + + 610 + 139 + 37 + 40 + + + 628.5 + 159 + + + + + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + Inverse Kinematics + + + + + """ +Calculate the robot's inverse kinematic for a given plane. + +COMPAS FAB v0.27.0 +""" +from compas_rhino.conversions import RhinoPlane +from ghpythonlib.componentbase import executingcomponent as component + + +class InverseKinematics(component): + def RunScript(self, robot, plane, start_configuration, group): + configuration = None + if robot and robot.client and robot.client.is_connected and plane: + frame = RhinoPlane.from_geometry(plane).to_compas_frame() + configuration = robot.inverse_kinematics(frame, start_configuration, group) + return configuration + + Calculate the robot's inverse kinematic for a given plane. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALEAAACxABrSO9dQAAAYFJREFUSEu1lLFxwzAMRVWn8gApNIKKDOAubbqk1AgeQRP4NIJG0AgqMoCq1BpBGzD/ywANkbAt3dm4eyfwkwBEElIRQngprvhMXHEL7+ff0tNTXFFBkhqMIAgz6MG3+AcvzuKKDJRETDqBFjSgE005efEWV0QgEzJBl+gs/CdzZLTzHpmAoEqCe9VgNWjePj5/oHMn3B13xnV37yITJEEMhH0BOsrqWLBuuQfYEVR2btFTAQEDmHQMawCdyTyZzCYeAAeEfrz8VXKC5Mv2dQzrJFALWDyNtDFeHQXJ0yOybzcD3scJWJ3YnQyazytQSoHlkmG6Az5XfQ9jMTosbIveLkCQnG2qBRg8p2tk7iDzHFhiI2RBFpi+YWzZFFgFRlnHYs1q3g5SYL0E1t78FlyRwLh9OiTr76344iW5Xq57/lvJhaIogZ6psunX7JEL11azH1H8cPaSC9fE/EW04se+3ksu5MdDbrbpI3Lh0tf246H/ki7iv+Xoze/BFZ9HKP4BuwtzfPsUblIAAAAASUVORK5CYII= + + false + df49cbca-ec61-4dc7-8c55-18e7e63a3700 + true + true + Inverse Kinematics + IK + + + + + + 504 + 704 + 207 + 84 + + + 619 + 746 + + + + + + 4 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The robot. + 249e3fc8-1590-4989-8d02-71555d17803d + robot + robot + true + 0 + true + 846547a4-0964-4bea-b2e5-d3fd03e0ff69 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + 2 + + + + + + 506 + 706 + 98 + 20 + + + 556.5 + 716 + + + + + + + + true + The plane or frame to calculate the inverse kinematic for. + 7f79fc84-f4dc-442f-b7ec-2c6ef6d32d53 + plane + plane + true + 0 + true + b96209a7-93e4-4212-b096-c83e82b4da7b + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 506 + 726 + 98 + 20 + + + 556.5 + 736 + + + + + + + + true + If passed, calculates the inverse such that the joint positions differ the least from the start_configuration. Defaults to the zero configuration. + 8aab3d36-825a-4b59-a5df-f5a5a92c336a + start_configuration + start_configuration + true + 0 + true + 0 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 506 + 746 + 98 + 20 + + + 556.5 + 756 + + + + + + + + true + The planning group used for calculation. Defaults to the robot's main planning group. + fd831072-ab33-48dd-88f3-f5635811e6b2 + group + group + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 506 + 766 + 98 + 20 + + + 556.5 + 776 + + + + + + + + The planning group's configuration. + 1d8af690-69c5-4c9f-b553-1a05f97e8281 + configuration + configuration + false + 0 + + + + + + 634 + 706 + 75 + 80 + + + 671.5 + 746 + + + + + + + + + + + + + + fbac3e32-f100-4292-8692-77240a42fd1a + Point + + + + + Contains a collection of three-dimensional points + 13d747bd-3e05-4a41-8ea0-75bad3d5248b + Point + Pt + false + 0 + + + + + + 315 + 294 + 50 + 24 + + + 340 + 306 + + + + + + 1 + + + + + 1 + {0} + + + + + + + 0.0788496805924328 + 0.563241716990942 + 0 + + + + + + + + + + + + + + cfb6b17f-ca82-4f5d-b604-d4f69f569de3 + Plane Normal + + + + + Create a plane perpendicular to a vector. + dd675efd-9233-4ad4-bb47-4b8f4932cc90 + Plane Normal + Pl + + + + + + 444 + 300 + 65 + 44 + + + 476 + 322 + + + + + + Origin of plane + a4967eb6-ce45-4b5a-a8bb-b57de9bc5816 + Origin + O + false + 13d747bd-3e05-4a41-8ea0-75bad3d5248b + 1 + + + + + + 446 + 302 + 15 + 20 + + + 455 + 312 + + + + + + 1 + + + + + 1 + {0} + + + + + + + 0 + 0 + 0 + + + + + + + + + + + + Z-Axis direction of plane + 6f2ccb4f-ad90-40cb-aa81-912ca1f36990 + Z-Axis + Z + false + 1f4c1d7b-92ac-410e-b8cf-de51d8691d13 + 1 + + + + + + 446 + 322 + 15 + 20 + + + 455 + 332 + + + + + + 1 + + + + + 1 + {0} + + + + + + 0 + 0 + 1 + + + + + + + + + + + + Plane definition + 3a86f18b-7506-4d48-8a5c-6048a1108886 + Plane + P + false + 0 + + + + + + 491 + 302 + 16 + 40 + + + 499 + 322 + + + + + + + + + + + + 9103c240-a6a9-4223-9b42-dbd19bf38e2b + Unit Z + + + + + Unit vector parallel to the world {z} axis. + 68575641-3532-400d-95f0-a0242e51e625 + Unit Z + Z + + + + + + 230 + 332 + 63 + 28 + + + 259 + 346 + + + + + + Unit multiplication + 1ec380b2-779c-4e5e-b32f-e1e05e1eaa2d + Factor + F + false + 0 + + + + + + 232 + 334 + 12 + 24 + + + 239.5 + 346 + + + + + + 1 + + + + + 1 + {0} + + + + + 1 + + + + + + + + + + + World {z} vector + 351348f7-2844-4518-aa54-7e8529b995cf + Unit vector + V + false + 0 + + + + + + 274 + 334 + 17 + 24 + + + 282.5 + 346 + + + + + + + + + + + + a3371040-e552-4bc8-b0ff-10a840258e88 + Negative + + + + + Compute the negative of a value. + eb5acce9-f665-4261-a8bc-ffd4947a64da + Negative + Neg + + + + + + 343 + 332 + 61 + 28 + + + 372 + 346 + + + + + + Input value + 28852126-05f6-43ae-8988-6d8909c2ffdf + Value + x + false + 351348f7-2844-4518-aa54-7e8529b995cf + 1 + + + + + + 345 + 334 + 12 + 24 + + + 352.5 + 346 + + + + + + + + Output value + 1f4c1d7b-92ac-410e-b8cf-de51d8691d13 + Result + y + false + 0 + + + + + + 387 + 334 + 15 + 24 + + + 394.5 + 346 + + + + + + + + + + + + d5967b9f-e8ee-436b-a8ad-29fdcecf32d5 + Curve + + + + + Contains a collection of generic curves + b171143f-e5e1-4bc8-92f7-eb329037f691 + Curve + Crv + false + 0 + + + + + + 205 + 462 + 50 + 24 + + + 230.4504 + 474.1136 + + + + + + 1 + + + + + 1 + {0} + + + + + -1 + + Y2BkYGD4DwQgGgR4mIBEWFBGZl6+c35ubn6ejkJYalFxZn6erbmekYWekbGBqYWesYGBoY6Cc2lOSWlRqm1eamlJUWKOjkJAaVJOZrJ3amVIfnZqnq2pqZGRhWGqpXmyuampqbEBK8gSSbDZeu6p+bmpJUWVen6lRUnFzqVFZaksQFn2MohlXIlFyRmZZanGKbmc+QWpeXkgVSwpiSWJIEUcHBxMIHcKqDMwGAFp18d8PJzMQAY/iMgEWsP0q56JIRbqqd//mRhEoP6TFFwfF8h9RXD/PwaBZkalD15SleJ/gPKqULUCzFCFINewMaCDD/YYQhDx/egiHNgVgsHO03c5+N89sd8Fpr/YT9vo0yuW+h+DBtlvIB4dV9Z7Zf+y+txSO7fXcPvPyHInLJW7YK/tlnb9NAdCfJKWe/maKQ/s34X//XY38Slc/J3J+s0CS57Yv1u/yKLh8UW4eP3DCfLtTq/sM74VF9pobIGLP13ZMrMn7bP9hWPZonmzFsPFb0naHv9fz9QA43Pj8ecoGAWEAQA= + + 00000000-0000-0000-0000-000000000000 + + + + + + + + + + + + + 2162e72e-72fc-4bf8-9459-d4d82fa8aa14 + Divide Curve + + + + + Divide a curve into equal length segments + true + 37fef6aa-0c60-4da4-9d31-1ae0bdd95cd2 + Divide Curve + Divide + + + + + + 293 + 443 + 65 + 64 + + + 325 + 475 + + + + + + Curve to divide + 17b7b741-c039-457b-bc69-9a5f2f8e5819 + Curve + C + false + b171143f-e5e1-4bc8-92f7-eb329037f691 + 1 + + + + + + 295 + 445 + 15 + 20 + + + 304 + 455 + + + + + + + + Number of segments + c4252d68-c3f0-4449-bc33-3963a1f5b379 + Count + N + false + 0 + + + + + + 295 + 465 + 15 + 20 + + + 304 + 475 + + + + + + 1 + + + + + 1 + {0} + + + + + 10 + + + + + + + + + + + Split segments at kinks + c67cd2ce-aeaf-48f1-b87d-ae648d16cb78 + Kinks + K + false + 0 + + + + + + 295 + 485 + 15 + 20 + + + 304 + 495 + + + + + + 1 + + + + + 1 + {0} + + + + + false + + + + + + + + + + + 1 + Division points + 02d756d0-695e-4b84-977a-5211a88fe540 + Points + P + false + 0 + + + + + + 340 + 445 + 16 + 20 + + + 348 + 455 + + + + + + + + 1 + Tangent vectors at division points + ff7cd25b-7346-40cf-93bd-b862456b2fad + Tangents + T + false + 0 + + + + + + 340 + 465 + 16 + 20 + + + 348 + 475 + + + + + + + + 1 + Parameter values at division points + 9f8a284b-b097-43d8-8703-768571059955 + Parameters + t + false + 0 + + + + + + 340 + 485 + 16 + 20 + + + 348 + 495 + + + + + + + + + + + + 2a5cfb31-028a-4b34-b4e1-9b20ae15312e + Cross Product + + + + + Compute vector cross product. + d6cabb95-93fe-48fe-9b1b-2070fdd10e56 + Cross Product + XProd + + + + + + 423 + 478 + 66 + 64 + + + 455 + 510 + + + + + + First vector + 7677fda3-a48e-4b19-9a38-3848beb2729e + Vector A + A + false + ff7cd25b-7346-40cf-93bd-b862456b2fad + 1 + + + + + + 425 + 480 + 15 + 20 + + + 434 + 490 + + + + + + + + Second vector + ab1ebaa3-5740-431c-8fc9-a779c8b99336 + Vector B + B + false + 351348f7-2844-4518-aa54-7e8529b995cf + 1 + + + + + + 425 + 500 + 15 + 20 + + + 434 + 510 + + + + + + + + Unitize output + 45f1c846-268d-49fd-a50d-dcd25e91cccc + Unitize + U + false + 0 + + + + + + 425 + 520 + 15 + 20 + + + 434 + 530 + + + + + + 1 + + + + + 1 + {0} + + + + + false + + + + + + + + + + + Cross product vector + 633bc054-2115-4c2b-8be8-c286377bce3d + Vector + V + false + 0 + + + + + + 470 + 480 + 17 + 30 + + + 478.5 + 495 + + + + + + + + Vector length + 8243a1a9-6216-4bc2-93b0-d7d17da9a8c7 + Length + L + false + 0 + + + + + + 470 + 510 + 17 + 30 + + + 478.5 + 525 + + + + + + + + + + + + bc3e379e-7206-4e7b-b63a-ff61f4b38a3e + Construct Plane + + + + + Construct a plane from an origin point and {x}, {y} axes. + true + 3974a64b-9fea-4aa6-a9ad-21315ef8260a + Construct Plane + Pl + + + + + + 527 + 443 + 68 + 64 + + + 559 + 475 + + + + + + Origin of plane + ada5ea08-627b-4ef2-9244-2c11db2d896f + Origin + O + false + 02d756d0-695e-4b84-977a-5211a88fe540 + 1 + + + + + + 529 + 445 + 15 + 20 + + + 538 + 455 + + + + + + 1 + + + + + 1 + {0} + + + + + + + 0 + 0 + 0 + + + + + + + + + + + + X-Axis direction of plane + 07101ef1-80e2-4825-a3da-9039e03fb50f + X-Axis + X + false + ff7cd25b-7346-40cf-93bd-b862456b2fad + 1 + + + + + + 529 + 465 + 15 + 20 + + + 538 + 475 + + + + + + 1 + + + + + 1 + {0} + + + + + + 1 + 0 + 0 + + + + + + + + + + + + Y-Axis direction of plane + c37c73c0-ad8c-442c-941a-484cdb43364c + Y-Axis + Y + false + 633bc054-2115-4c2b-8be8-c286377bce3d + 1 + + + + + + 529 + 485 + 15 + 20 + + + 538 + 495 + + + + + + 1 + + + + + 1 + {0} + + + + + + 0 + 1 + 0 + + + + + + + + + + + + Constructed plane + 44d4a187-3a93-413f-992e-d4cc7e2e19ad + Plane + Pl + false + 0 + + + + + + 574 + 445 + 19 + 60 + + + 583.5 + 475 + + + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + Inverse Kinematics + + + + + """ +Calculate the robot's inverse kinematic for a given plane. + +COMPAS FAB v0.27.0 +""" +from compas_rhino.conversions import RhinoPlane +from ghpythonlib.componentbase import executingcomponent as component + + +class InverseKinematics(component): + def RunScript(self, robot, plane, start_configuration, group): + configuration = None + if robot and robot.client and robot.client.is_connected and plane: + frame = RhinoPlane.from_geometry(plane).to_compas_frame() + configuration = robot.inverse_kinematics(frame, start_configuration, group) + return configuration + + Calculate the robot's inverse kinematic for a given plane. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALDwAACw8BkvkDpQAAAYFJREFUSEu1lLFxwzAMRVWn8gApNIKKDOAubbqk1AgeQRP4NIJG0AgqMoCq1BpBGzD/ywANkbAt3dm4eyfwkwBEElIRQngprvhMXHEL7+ff0tNTXFFBkhqMIAgz6MG3+AcvzuKKDJRETDqBFjSgE005efEWV0QgEzJBl+gs/CdzZLTzHpmAoEqCe9VgNWjePj5/oHMn3B13xnV37yITJEEMhH0BOsrqWLBuuQfYEVR2btFTAQEDmHQMawCdyTyZzCYeAAeEfrz8VXKC5Mv2dQzrJFALWDyNtDFeHQXJ0yOybzcD3scJWJ3YnQyazytQSoHlkmG6Az5XfQ9jMTosbIveLkCQnG2qBRg8p2tk7iDzHFhiI2RBFpi+YWzZFFgFRlnHYs1q3g5SYL0E1t78FlyRwLh9OiTr76344iW5Xq57/lvJhaIogZ6psunX7JEL11azH1H8cPaSC9fE/EW04se+3ksu5MdDbrbpI3Lh0tf246H/ki7iv+Xoze/BFZ9HKP4BuwtzfPsUblIAAAAASUVORK5CYII= + + false + 0bd900d0-2016-4c53-af3b-1c52cf194064 + true + true + Inverse Kinematics + IK + + + + + + 652 + 287 + 207 + 84 + + + 767 + 329 + + + + + + 4 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The robot. + a98f5131-0055-48d7-a0c2-fe32212117c6 + robot + robot + true + 0 + true + 846547a4-0964-4bea-b2e5-d3fd03e0ff69 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + 2 + + + + + + 654 + 289 + 98 + 20 + + + 704.5 + 299 + + + + + + + + true + The plane or frame to calculate the inverse kinematic for. + 84d72e79-136b-457e-8f5b-27843e5bf7b3 + plane + plane + true + 0 + true + 3a86f18b-7506-4d48-8a5c-6048a1108886 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 654 + 309 + 98 + 20 + + + 704.5 + 319 + + + + + + + + true + If passed, calculates the inverse such that the joint positions differ the least from the start_configuration. Defaults to the zero configuration. + 1682b475-974e-4465-847b-6f521d231a4b + start_configuration + start_configuration + true + 0 + true + 0 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 654 + 329 + 98 + 20 + + + 704.5 + 339 + + + + + + + + true + The planning group used for calculation. Defaults to the robot's main planning group. + 9da8c8d9-ac45-43a1-8553-97c0c52b171a + group + group + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 654 + 349 + 98 + 20 + + + 704.5 + 359 + + + + + + + + The planning group's configuration. + ac00155a-4a35-4e0d-98f3-e0b82a464386 + configuration + configuration + false + 0 + + + + + + 782 + 289 + 75 + 80 + + + 819.5 + 329 + + + + + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + Constraints From Plane + + + + + """ +Create a position and an orientation constraint from a plane calculated for the group's end-effector link. + +COMPAS FAB v0.27.0 +""" +import math + +from compas_rhino.conversions import RhinoPlane +from ghpythonlib.componentbase import executingcomponent as component + + +class ConstraintsFromPlane(component): + def RunScript(self, robot, plane, group, tolerance_position, tolerance_xaxis, tolerance_yaxis, tolerance_zaxis): + goal_constraints = None + if robot and plane: + tolerance_position = tolerance_position or 0.001 + tolerance_xaxis = tolerance_xaxis or 1. + tolerance_yaxis = tolerance_yaxis or 1. + tolerance_zaxis = tolerance_zaxis or 1. + + frame = RhinoPlane.from_geometry(plane).to_compas_frame() + tolerances_axes = [math.radians(tolerance_xaxis), math.radians(tolerance_yaxis), math.radians(tolerance_zaxis)] + goal_constraints = robot.constraints_from_frame(frame, tolerance_position, tolerances_axes, group) + + return goal_constraints + + Create a position and an orientation constraint from a plane calculated for the group's end-effector link. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALDwAACw8BkvkDpQAAAd9JREFUSEu1lTFLw0AYho92ENShVFHE1p4ILipkcBXqDxA6OQfHThn8ARk7OBQdXfIPzOyUwUFwKfgHSifBJU7idL7f9S7ctV+bVHB4yN17+Z4vuZxVKKX+FTacRYjnBpdXgQ1dIJdgyK1VgQ1dIA/BiFurAhu6QJ4CDP62TWzoAnFuGvS49TLY0AJpYOREwt1TBhtaII2cBmPunjLY0AJp5jQgJHffMtjQBdIYZNxaFdjQZVmDo44MwdLmbEi8CNGl66Z4GqzV0zcai0fRBcVxhTwGGM7XW9gQ8hAoMLhpXXyLIFYQJ2ACRvKk3Yd4RHJDDhIw9428CeHILUnzTvQhzoHaudqeSqWc4Jrp8VRuGwWur0xORBA3wNfG7bqWU5P6fe398PhgQHOqxbVrGng/K4vkOUhNpl8bDXqds9Zn57T9U3uo0Zaprevmh21AYBzRHBR/9VbeAxmIgPeKBAro6fQHBa9oNNy73E3b5/u6gVkj9BsB2rqYaj3RIkyx3p5VoFpWuAgU0R4X5x5j75hiTG9K8shmRXEVUDg0gtDMZxvYo6u/G+EJykBhA4yNhOS2IT25lRdPT3iCKkAggT3/LrR9npzwJqsAWQBsI/pNYv/jzQWrAKk+vtzaFCV+ASnZhhTkLZwXAAAAAElFTkSuQmCC + + false + d93333c1-6121-4133-94e5-b1cdbd79792d + true + true + Constraints From Plane + Constraints From Plane + + + + + + 501 + 973 + 193 + 144 + + + 614 + 1045 + + + + + + 7 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The robot. + cbf6a458-85d1-42a7-94f7-416fdfa1b2f0 + robot + robot + true + 0 + true + 538c02c6-6b3b-4712-a784-dda0bc63f847 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + 2 + + + + + + 503 + 975 + 96 + 20 + + + 552.5 + 985 + + + + + + + + true + The plane or frame from which we create position and orientation constraints. + 87942239-75a1-43f9-98a8-39af07ed3dbf + plane + plane + true + 0 + true + 1b843cc6-0c2b-4427-85b3-c5303911f7e9 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 503 + 995 + 96 + 20 + + + 552.5 + 1005 + + + + + + + + true + The planning group for which we specify the constraint. Defaults to the robot's main planning group. + 5f458976-1a25-4cf2-bb59-977ecaa69acf + group + group + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 503 + 1015 + 96 + 20 + + + 552.5 + 1025 + + + + + + + + true + The allowed tolerance to the frame's position (defined in the robot's units). Defaults to 0.001 + f4df44e0-61e9-4a9c-adc5-322c77ee723c + tolerance_position + tolerance_position + true + 0 + true + 0 + 39fbc626-7a01-46ab-a18e-ec1c0c41685b + + + + + + 503 + 1035 + 96 + 20 + + + 552.5 + 1045 + + + + + + + + true + The allowed tolerance of the frame's X-axis in degrees. + 38431b6b-d582-43ce-b820-9189820976ff + tolerance_xaxis + tolerance_xaxis + true + 0 + true + 0 + 39fbc626-7a01-46ab-a18e-ec1c0c41685b + + + + + + 503 + 1055 + 96 + 20 + + + 552.5 + 1065 + + + + + + + + true + The allowed tolerance of the frame's Y-axis in degrees. + 27304578-70c5-46fe-966d-55f6d2a284f3 + tolerance_yaxis + tolerance_yaxis + true + 0 + true + 0 + 39fbc626-7a01-46ab-a18e-ec1c0c41685b + + + + + + 503 + 1075 + 96 + 20 + + + 552.5 + 1085 + + + + + + + + true + The allowed tolerance of the frame's Z-axis in degrees. + 745b4728-c179-4f50-ad5c-43f1ca9fb8f8 + tolerance_zaxis + tolerance_zaxis + true + 0 + true + 0 + 39fbc626-7a01-46ab-a18e-ec1c0c41685b + + + + + + 503 + 1095 + 96 + 20 + + + 552.5 + 1105 + + + + + + + + A list containing a position and an orientation constraint. + 1a96f4f6-fa5c-4bec-8121-df8feb673fae + constraints + constraints + false + 0 + + + + + + 629 + 975 + 63 + 140 + + + 660.5 + 1045 + + + + + + + + + + + + + + 59daf374-bc21-4a5e-8282-5504fb7ae9ae + List Item + + + + + 0 + Retrieve a specific item from a list. + 8a1cd44e-8393-4da1-ba94-6a53dd4e3f37 + List Item + Item + + + + + + 240 + 988 + 64 + 64 + + + 274 + 1020 + + + + + + 3 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + 2e3ab970-8545-46bb-836c-1c11e5610bce + cb95db89-6165-43b6-9c41-5702bc5bf137 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + 1 + Base list + 5adfeb6c-e7f6-49be-a873-3d13194ccef5 + List + L + false + 55db7485-e593-4762-a166-64303d976c7a + 1 + + + + + + 242 + 990 + 17 + 20 + + + 252 + 1000 + + + + + + + + Item index + 3c505437-9eea-46c1-ab35-c8afc8032305 + Index + i + false + 0 + + + + + + 242 + 1010 + 17 + 20 + + + 252 + 1020 + + + + + + 1 + + + + + 1 + {0} + + + + + 0 + + + + + + + + + + + Wrap index to list bounds + 578930d2-94b0-4edd-8d4a-cd8a25689009 + Wrap + W + false + 0 + + + + + + 242 + 1030 + 17 + 20 + + + 252 + 1040 + + + + + + 1 + + + + + 1 + {0} + + + + + true + + + + + + + + + + + Item at {i'} + 1b843cc6-0c2b-4427-85b3-c5303911f7e9 + false + Item + i + false + 0 + + + + + + 289 + 990 + 13 + 60 + + + 295.5 + 1020 + + + + + + + + + + + + + + 410755b1-224a-4c1e-a407-bf32fb45ea7e + 00000000-0000-0000-0000-000000000000 + Plan Motion + + + + + """ +Calculate a motion path. + +COMPAS FAB v0.27.0 +""" +from ghpythonlib.componentbase import executingcomponent as component +from scriptcontext import sticky as st + +from compas_fab.ghpython.components import create_id + + +class PlanMotion(component): + def RunScript(self, robot, goal_constraints, start_configuration, group, attached_collision_meshes, path_constraints, planner_id, compute): + + key = create_id(self, 'trajectory') + + path_constraints = list(path_constraints) if path_constraints else None + attached_collision_meshes = list(attached_collision_meshes) if attached_collision_meshes else None + planner_id = str(planner_id) if planner_id else 'RRTConnect' + + if robot and robot.client and robot.client.is_connected and start_configuration and goal_constraints and compute: + st[key] = robot.plan_motion(goal_constraints, + start_configuration=start_configuration, + group=group, + options=dict( + attached_collision_meshes=attached_collision_meshes, + path_constraints=path_constraints, + planner_id=planner_id, + )) + + trajectory = st.get(key, None) + return trajectory + + Calculate a motion path. +COMPAS FAB v0.27.0 + true + true + 2 + + iVBORw0KGgoAAAANSUhEUgAAABgAAAAYCAYAAADgdz34AAAABGdBTUEAALGPC/xhBQAAAAlwSFlzAAALEAAACxABrSO9dQAAAY1JREFUSEu1lM1tAjEQhSmBDkgJFMCBEnKJuKYESuAQiRoicaADKIEOkgK455icckHK5n3e8WbsHRJAG0sfjOc9478xo6Zp/pUwOSRhckjC5LWojcVWHMRezDvNGz1qM7ETm0j3qL0KAk+a5NyAtTO+iQ3fZ7z3Ins9+6QHAybGpyDBj58sPgb+lWk1h6QHA14EP/gkZpZjEgJ2M6n8U9NqVkn3ZhuQV1ucvdqD4OjWPm9avQvuZJy0wPxuprR6l6dCCN593ul3Yg5Fvui0Z78UC583jTyBuqUGahwjiyt3XnTasiTorVKNydGXtWZ63nm63C5fdP4+hiOaiHZIcRD8OgHHwCTh41ILV2kaY4t7S/kuaC+JaoBHb3IedvAl6grj1RNAsbtsoJY/zJDZeqP58iPkLrr3YH2Ck/cnzQz8QRHUTHsD2h0QpFetxtt4Fhztruc3U77cmqKmzbsQTMJ9+HG9B5j86eOKHZifms8FQSKsrORNHxfewS38BBdU0S2EySEJk0MSJoejGX0DqCUOkgYB1loAAAAASUVORK5CYII= + + false + 54d5165c-c7b9-4b61-a3f4-725adfe6cedb + true + true + Plan Motion + Plan Motion + + + + + + 895 + 884 + 224 + 164 + + + 1046 + 966 + + + + + + 8 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 84fa917c-1ed8-4db3-8be1-7bdc4a6495a2 + 1 + 8ec86459-bf01-4409-baee-174d0d2b13d0 + + + + + true + The robot. + 3ab0c3a7-74d4-4e20-8d40-f9d959596a64 + robot + robot + true + 0 + true + 538c02c6-6b3b-4712-a784-dda0bc63f847 + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + 2 + + + + + + 897 + 886 + 134 + 20 + + + 965.5 + 896 + + + + + + + + 1 + true + The goal to be achieved, defined in a set of constraints. Constraints can be very specific, for example defining value domains for each joint, such that the goal configuration is included, or defining a volume in space, to which a specific robot link (e.g. the end-effector) is required to move to. + e4550953-1c4d-4196-accf-09e0629aecf8 + goal_constraints + goal_constraints + true + 1 + true + 1a96f4f6-fa5c-4bec-8121-df8feb673fae + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 897 + 906 + 134 + 20 + + + 965.5 + 916 + + + + + + + + true + The robot's full configuration, i.e. values for all configurable joints of the entire robot, at the starting position. Defaults to the all-zero configuration. + 045b29a2-7cdc-4ea7-b8be-65710ec81364 + start_configuration + start_configuration + true + 0 + true + c666c109-2ccb-4c50-90cd-00130af76eaa + 1 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 897 + 926 + 134 + 20 + + + 965.5 + 936 + + + + + + + + true + The planning group used for calculation. Defaults to the robot's main planning group. + bc8ad3dc-fbe4-440a-98c4-151f7e612cbb + group + group + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 897 + 946 + 134 + 20 + + + 965.5 + 956 + + + + + + + + 1 + true + A list of attached collision meshes to be included for planning. + 8ef44a5c-ec14-4d30-9c85-7fed0cea4feb + attached_collision_meshes + attached_collision_meshes + true + 1 + true + 0 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 897 + 966 + 134 + 20 + + + 965.5 + 976 + + + + + + + + 1 + true + Optional constraints that can be imposed along the solution path. Note that path calculation won't work if the start_configuration violates these constraints. Defaults to None. + 79c1632c-fba5-40b8-a628-530ad610655d + path_constraints + path_constraints + true + 1 + true + 0 + 87f87f55-5b71-41f4-8aea-21d494016f81 + + + + + + 897 + 986 + 134 + 20 + + + 965.5 + 996 + + + + + + + + true + The name of the algorithm used for path planning. Defaults to 'RRTConnect' + 59c97f48-1889-4f3b-b990-cedd3ddf9849 + planner_id + planner_id + true + 0 + true + 0 + 37261734-eec7-4f50-b6a8-b8d1f3c4396b + + + + + + 897 + 1006 + 134 + 20 + + + 965.5 + 1016 + + + + + + + + true + If True, calculates a trajectory. + 2dd1af7b-a420-4d72-8c10-01811c07df29 + compute + compute + true + 0 + true + e8dd8875-225b-4b6d-a8de-4f454ff7d868 + 1 + d60527f5-b5af-4ef6-8970-5f96fe412559 + + + + + + 897 + 1026 + 134 + 20 + + + 965.5 + 1036 + + + + + + + + The calculated trajectory. + 4e17b2ad-e9af-41eb-b6a5-7585e1f6e333 + trajectory + trajectory + false + 0 + + + + + + 1061 + 886 + 56 + 160 + + + 1089 + 966 + + + + + + + + + + + + + + 2e78987b-9dfb-42a2-8b76-3923ac8bd91a + Boolean Toggle + + + + + Boolean (true/false) toggle + e8dd8875-225b-4b6d-a8de-4f454ff7d868 + Boolean Toggle + Toggle + false + 0 + false + + + + + + 735 + 1033 + 104 + 22 + + + + + + + + + + b83c36e8-c587-4607-a4b3-d9fdad45d185 + 1c9de8a1-315f-4c56-af06-8f69fee80a7a + Flip Plane + + + + + Flip a plane by specified axes with the option of using a guide plane. + 711d6fa3-3862-4211-a255-f8c00962a10d + Flip Plane + FlipPln + + + + + + 701 + 443 + 67 + 104 + + + 734 + 495 + + + + + + Plane to flip + abc3aafd-8660-4da2-b7a9-b9b7e034def6 + Plane + Pl + false + 44d4a187-3a93-413f-992e-d4cc7e2e19ad + 1 + + + + + + 703 + 445 + 16 + 20 + + + 712.5 + 455 + + + + + + + + Optional guide plane to determine if the plane should flip, based on the guide plane axis angle to the axis of plane to flip + 70ee89b8-6d85-4c25-a81f-6e6012e6adde + Guide + G + true + 0 + + + + + + 703 + 465 + 16 + 20 + + + 712.5 + 475 + + + + + + + + Flip the planes X axis + 46e3bfc4-b95f-44bc-908c-be468fd2a325 + Flip X + X + false + 0 + + + + + + 703 + 485 + 16 + 20 + + + 712.5 + 495 + + + + + + 1 + + + + + 1 + {0} + + + + + false + + + + + + + + + + + Flip the planes Y axis + 21e47292-bdcc-4ecc-9890-bf40fedfefdc + Flip Y + Y + false + 0 + + + + + + 703 + 505 + 16 + 20 + + + 712.5 + 515 + + + + + + 1 + + + + + 1 + {0} + + + + + false + + + + + + + + + + + Flip the planes Z axis + 1352c30f-e3c9-4c38-800e-8703728f4f9d + Flip Z + Z + false + 0 + + + + + + 703 + 525 + 16 + 20 + + + 712.5 + 535 + + + + + + 1 + + + + + 1 + {0} + + + + + true + + + + + + + + + + + Resulting flipped plane + a4e35366-aed9-4624-91f1-08abb1a092fd + Flipped + F + false + 0 + + + + + + 749 + 445 + 17 + 50 + + + 757.5 + 470 + + + + + + + + True if plane was flipped, False if plane was not flipped + 4aa67233-ed42-4970-aca1-04b6a9204c9f + Result Boolean + R + false + 0 + + + + + + 749 + 495 + 17 + 50 + + + 757.5 + 520 + + + + + + + + + + + + + + + + + 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 + + + + + \ No newline at end of file