{ "cells": [ { "cell_type": "markdown", "id": "579dca47", "metadata": {}, "source": [ "# Location Designator\n", "This example will show you waht location designator are, how to use them and what they are capable of. \n", "\n", "Location Deisgnator are used to semantically describe locations in the world. You could, for example, create a location designator that describes every position where a robot can be placed without colliding with the environment. Location designator can describe locations for:\n", "\n", " * Visibility \n", " * Reachability\n", " * Occupany \n", " * URDF Links (for example a table)\n", "\n", "To find locations that fit the given constrains, location designator create Costmaps. Costmaps are a 2D distribution that have a value greater than 0 for every position that fits the costmap criteria.\n", "\n", "Location designator work similar to other designator, meaning you have to create a location designator description which describes the location. This description can then be resolved to the actual 6D pose on runtime.\n", "\n", "## Occupancy\n", "\n", "We will start with a simple location designator that describes a location where the robot can be placed without colliding with the environment. To do this we need a BulletWorld since the costmaps are mostly created from the current state of the BulletWorld. " ] }, { "cell_type": "code", "execution_count": 1, "id": "69417dcf", "metadata": {}, "outputs": [ { "name": "stderr", "output_type": "stream", "text": [ "Unknown tag \"material\" in /robot[@name='plane']/link[@name='planeLink']/collision[1]\n", "Unknown tag \"contact\" in /robot[@name='plane']/link[@name='planeLink']\n", "Unknown tag \"material\" in /robot[@name='plane']/link[@name='planeLink']/collision[1]\n", "Scalar element defined multiple times: limit\n", "Unknown tag \"contact\" in /robot[@name='plane']/link[@name='planeLink']\n", "Scalar element defined multiple times: limit\n" ] } ], "source": [ "from pycram.bullet_world import BulletWorld, Object\n", "from pycram.pose import Pose\n", "\n", "world = BulletWorld()\n", "kitchen = Object(\"kitchen\", \"environment\", \"kitchen.urdf\")" ] }, { "cell_type": "code", "execution_count": 12, "id": "953e329b", "metadata": {}, "outputs": [], "source": [ "world.exit()" ] }, { "cell_type": "markdown", "id": "aa09bc52", "metadata": {}, "source": [ "Next up we will create the location designator description, the ```CostmapLocation``` that we will be using needs a target as parameter. This target describes what the location designator is for, this could either be a pose or object that the robot should be able to see or reach.\n", "\n", "In this case we only want poses where the robot can be placed, this is the default behaviour of the location designator which we will be extending later. " ] }, { "cell_type": "code", "execution_count": 3, "id": "d13c7900", "metadata": {}, "outputs": [ { "name": "stdout", "output_type": "stream", "text": [ "CostmapLocation.Location(pose=header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274742\n", " nsecs: 490613698\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32\n", " y: 0.46\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.8863025691598214\n", " w: -0.46310663556107684, reachable_arms=None)\n" ] } ], "source": [ "from pycram.designators.location_designator import CostmapLocation\n", "\n", "target = kitchen.get_pose()\n", "\n", "location_description = CostmapLocation(target)\n", "\n", "pose = location_description.resolve()\n", "\n", "print(pose)" ] }, { "cell_type": "markdown", "id": "548444a1", "metadata": {}, "source": [ "## Reachable\n", "Next we want to locations from where the robot can reach a specific point, like an object the robot should pick up. This can also be done with the ```CostmapLocation``` description, but this time we need to provide an additional argument. The additional argument is the robo which should be able to reach the pose. \n", "\n", "Since a robot is needed we will use the PR2 and use a milk as a target point for the robot to reach. The torso of the PR2 will be set to 0.2 since otherwise the arms of the robot will be too low to reach on the countertop.\n" ] }, { "cell_type": "code", "execution_count": 4, "id": "ac67b83f", "metadata": {}, "outputs": [ { "name": "stderr", "output_type": "stream", "text": [ "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='base_laser_link']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='wide_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='narrow_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='laser_tilt_link']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='base_laser_link']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='wide_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='narrow_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='laser_tilt_link']\n" ] } ], "source": [ "pr2 = Object(\"pr2\", \"robot\", \"pr2.urdf\")\n", "pr2.set_joint_state(\"torso_lift_joint\", 0.2)\n", "milk = Object(\"milk\", \"milk\", \"milk.stl\", pose=Pose([1.3, 1, 0.9]))\n" ] }, { "cell_type": "code", "execution_count": 5, "id": "a84e7525", "metadata": {}, "outputs": [ { "name": "stdout", "output_type": "stream", "text": [ "CostmapLocation.Location(pose=header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274760\n", " nsecs: 13957262\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.52\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.038376519503587225\n", " w: 0.99926335004882, reachable_arms=['left'])\n" ] } ], "source": [ "from pycram.designators.location_designator import CostmapLocation\n", "from pycram.designators.object_designator import BelieveObject\n", "\n", "target = BelieveObject(names=[\"milk\"]).resolve()\n", "robot_desig = BelieveObject(names=[\"pr2\"]).resolve()\n", "\n", "location_description = CostmapLocation(target=target, reachable_for=robot_desig)\n", "\n", "print(location_description.resolve())" ] }, { "cell_type": "markdown", "id": "4b811f25", "metadata": {}, "source": [ "As you can see we get a pose near the countertop where the robot can be placed without colliding with it. Furthermore, we get a list of arms with which the robot can reach the given object." ] }, { "cell_type": "markdown", "id": "a9f835b1", "metadata": {}, "source": [ "## Visibile\n", "The ```CostmapLocation``` can also find position from which the robot can see a given object or location. This is very similar to how rechable locations are described, meaning we provide a object designator or a pose and a robot designator but this time we use the ```visible_for``` parameter. \n", "\n", "For this example we need the milk as well as the PR2, so if you did not spawn them during the previous location designator you can spawn them with the following cell. " ] }, { "cell_type": "code", "execution_count": null, "id": "79eb94b6", "metadata": {}, "outputs": [], "source": [ "pr2 = Object(\"pr2\", \"robot\", \"pr2.urdf\")\n", "milk = Object(\"milk\", \"milk\", \"milk.stl\", pose=Pose([1.3, 1, 0.9]))" ] }, { "cell_type": "code", "execution_count": 6, "id": "7d6fb946", "metadata": {}, "outputs": [ { "name": "stdout", "output_type": "stream", "text": [ "CostmapLocation.Location(pose=header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274771\n", " nsecs: 450996160\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.040000000000000036\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4847685323929452\n", " w: 0.8746424812468178, reachable_arms=None)\n" ] } ], "source": [ "from pycram.designators.location_designator import CostmapLocation\n", "from pycram.designators.object_designator import BelieveObject\n", "\n", "target = BelieveObject(names=[\"milk\"]).resolve()\n", "robot_desig = BelieveObject(names=[\"pr2\"]).resolve()\n", "\n", "location_description = CostmapLocation(target=target, visible_for=robot_desig)\n", "\n", "print(location_description.resolve())" ] }, { "cell_type": "markdown", "id": "b1813244", "metadata": {}, "source": [ "## Semantic \n", "Semantic location designator are used to create location descriptions for semantic entities, like a table. An example of this is: You have a robot that picked up an object and should place it on a table. Semantic location designator then allows to find poses that are on this table.\n", "\n", "Semantic location designator need an object from which the target entity is a part and the urdf link representing the entity. In this case we want a position on the kitchen island, so we have to provide the kitchen object designator since the island is a part of the kitchen and the link name of the island surface. \n", "\n", "For this example we need the kitchen as well as the milk. If you spawned them in one of the previous examples you don't need to execute the following cell." ] }, { "cell_type": "code", "execution_count": 8, "id": "d98a23dd", "metadata": {}, "outputs": [], "source": [ "kitchen = Object(\"kitchen\", \"environment\", \"kitchen.urdf\")\n", "milk = Object(\"milk\", \"milk\", \"milk.stl\")" ] }, { "cell_type": "code", "execution_count": 7, "id": "328d9091", "metadata": {}, "outputs": [ { "name": "stdout", "output_type": "stream", "text": [ "SemanticCostmapLocation.Location(pose=header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274773\n", " nsecs: 737708330\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: -1.2074999952316285\n", " y: 1.019200015068054\n", " z: 0.9398907270729542\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.6339889056055381\n", " w: 0.7733421413379024)\n" ] } ], "source": [ "from pycram.designators.location_designator import SemanticCostmapLocation \n", "from pycram.designators.object_designator import BelieveObject\n", "\n", "kitchen_desig = BelieveObject(names=[\"kitchen\"]).resolve()\n", "milk_desig = BelieveObject(names=[\"milk\"]).resolve()\n", "\n", "location_description = SemanticCostmapLocation(urdf_link_name=\"kitchen_island_surface\", \n", " part_of=kitchen_desig,\n", " for_object=milk_desig)\n", "\n", "print(location_description.resolve())" ] }, { "cell_type": "markdown", "id": "8c811caf", "metadata": {}, "source": [ "## Location Designator as Generator\n", "Location designator descriptions implement an iter method, so they can be used as generators which generate valid poses for the location described in the description. This can be useful if the first pose does not work for some reason. \n", "\n", "We will see this at the example of a location designator for visibility. For this example we need the milk, if you already have a milk spawned in you world you can ignore the following cell." ] }, { "cell_type": "code", "execution_count": null, "id": "df047308", "metadata": {}, "outputs": [], "source": [ "milk = Object(\"milk\", \"milk\", \"milk.stl\")" ] }, { "cell_type": "code", "execution_count": 8, "id": "2b829201", "metadata": {}, "outputs": [ { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 531814098\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.040000000000000036\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4847685323929452\n", " w: 0.8746424812468178\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 552193641\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.14\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.462503191327324\n", " w: 0.8866176165698721\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 563171625\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.07999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.47630463962315017\n", " w: 0.8792803251941107\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 573374509\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2897841486884302\n", " w: 0.9570920264890528\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 583716392\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.12\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4672596576628943\n", " w: 0.8841201345522874\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 590449094\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.8399999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4305820312855819\n", " w: -0.9025514469181145\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 595685720\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.16000000000000003\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4575815808579404\n", " w: 0.8891676427196101\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 600539922\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.17999999999999994\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.45248757199274703\n", " w: 0.8917707088664152\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 605951786\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.8599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4357547566964745\n", " w: -0.9000654376301738\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 611063957\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.56\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.31112296937408407\n", " w: 0.9503696638297399\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 615926027\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.24105194839799401\n", " w: -0.9705122143350545\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 621160984\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1818560533826626\n", " w: 0.9833251628266624\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 626298904\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.27855064570538285\n", " w: 0.9604215417081784\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 631211280\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.26693358189581146\n", " w: 0.963714928210761\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 636164426\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.25492921973695737\n", " w: 0.9669597162882775\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 641395807\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.6799999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.24253562503633305\n", " w: 0.9701425001453319\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 646407604\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.7\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2297529205473612\n", " w: 0.9732489894677302\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 651324272\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.72\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.21658354046964728\n", " w: 0.9762640882454053\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 656409263\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.20303247854724604\n", " w: 0.9791720036106843\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 661525011\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18910752115495127\n", " w: 0.9819563867314218\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 666525125\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.17481945560118778\n", " w: 0.9846005067758722\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 671670436\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.3400000000000001\n", " y: 1.54\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.25340132485392697\n", " w: -0.9673612399524154\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 676738023\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.38\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.28742592162387626\n", " w: 0.9578028709388302\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 681830883\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.4\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.28024791740743743\n", " w: 0.9599276560183033\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 686803102\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.42000000000000004\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2729138941134418\n", " w: 0.9620384640958162\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 696910858\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.45999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.25777359982088077\n", " w: 0.9662053463086325\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 711693286\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.52\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.23387468342275874\n", " w: 0.9722667496391638\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 716694116\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.54\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.22559175289915115\n", " w: 0.9742219259613737\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 721538782\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.56\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.21715175965388986\n", " w: 0.9761378556736847\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 726935386\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.20855609483322654\n", " w: 0.978010406543772\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 731891155\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19980661196694868\n", " w: 0.9798353524007435\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 736720800\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.36\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19090564985857\n", " w: 0.9816083907812102\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 742129087\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1601822430069672\n", " w: 0.9870874576374967\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 747352361\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.30000000000000004\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19750682822707502\n", " w: 0.9803015111707626\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 752288341\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.25204812820445166\n", " w: -0.9677147002441537\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 757542848\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1839003684741493\n", " w: -0.9829448888290087\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 762562751\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22975292054736132\n", " w: -0.9732489894677301\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 773855686\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20625493742825682\n", " w: -0.9784982885965953\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 778794765\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.19406429543489445\n", " w: -0.9809888119837851\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 783638477\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1815876718680465\n", " w: -0.983374759400272\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 789254188\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16883374428281583\n", " w: -0.9856445438348679\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 794201612\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.15581315965859366\n", " w: -0.9877865454019941\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 799483537\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.14253858850979537\n", " w: -0.9897892456405228\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 804498434\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.12902474983213136\n", " w: -0.9916413736481329\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 810191392\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11528840285654064\n", " w: -0.9933320613806784\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 815313339\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1013483022634038\n", " w: -0.9948510047380591\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 820359230\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.08722511445123857\n", " w: -0.9961886264202018\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 825942516\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07294129363792093\n", " w: -0.9973362360219479\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 835538625\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.04398948723626534\n", " w: -0.999031993988526\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 841140031\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.029373685715314044\n", " w: -0.9995685001977093\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 846122741\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.02\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.014701114509569024\n", " w: -0.9998919327768259\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 851179838\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 856514930\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.0147011145095689\n", " w: 0.9998919327768259\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 861835479\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.96\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.029373685715313923\n", " w: 0.9995685001977093\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 871950626\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.058520917957273134\n", " w: 0.9982861824954997\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 886819601\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.10134830226340368\n", " w: 0.9948510047380591\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 892334938\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11528840285654074\n", " w: 0.9933320613806784\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 897228717\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.12902474983213125\n", " w: 0.9916413736481329\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 902060031\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.14253858850979526\n", " w: 0.9897892456405228\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 907245159\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.15581315965859333\n", " w: 0.9877865454019941\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 917491197\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18158767186804636\n", " w: 0.983374759400272\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 927996635\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.7\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.20625493742825649\n", " w: 0.9784982885965954\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 933149814\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.6799999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2181528108906758\n", " w: 0.9759146228541189\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 938318729\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.12993279108591818\n", " w: -0.9915228034698058\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 943486928\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.14521314468540475\n", " w: -0.9894003954974829\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 948514699\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16018224300696732\n", " w: -0.9870874576374967\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 953556537\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1748194556011879\n", " w: -0.9846005067758722\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 959163904\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.18910752115495139\n", " w: -0.9819563867314218\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 964154720\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20303247854724596\n", " w: -0.9791720036106843\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 969098091\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2165835404696474\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ " w: -0.9762640882454053\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 974899768\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22975292054736132\n", " w: -0.9732489894677301\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 979987144\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.32\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.24253562503633316\n", " w: -0.9701425001453319\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 985614061\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2549292197369575\n", " w: -0.9669597162882775\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 991364717\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.26693358189581157\n", " w: -0.9637149282107609\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274779\n", " nsecs: 996544599\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.27855064570538274\n", " w: -0.9604215417081784\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 1642704\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.4\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.28978414868842994\n", " w: -0.9570920264890529\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 7374048\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.42\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.30063938487909386\n", " w: -0.9537378886567944\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 17172813\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.46\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3212426175868359\n", " w: -0.946996927474402\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 22615194\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.48\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.33100694143550047\n", " w: -0.9436283191604177\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 27799606\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.5\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3404252637530187\n", " w: -0.9402715776831115\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 32859325\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2297529205473612\n", " w: 0.9732489894677302\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 37750720\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.36\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2992447144182441\n", " w: 0.9541763992536934\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 43346643\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.38\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2921759507632702\n", " w: 0.9563645820478606\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 48295021\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.4\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.28494683992052416\n", " w: 0.9585433210968126\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 53171157\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.42000000000000004\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2775557578256552\n", " w: 0.9607095301379217\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 63730955\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.45999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.26228249672773757\n", " w: 0.964991135664087\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 68866491\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.48\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2543984682342504\n", " w: 0.9670994878294927\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 74641227\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.5\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.24634882831815283\n", " w: 0.9691812290723925\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 79569578\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.52\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2381335274951276\n", " w: 0.9712324248513984\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 94710350\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.21249940721913327\n", " w: 0.9771611954695688\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 99810123\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.20362949657007584\n", " w: 0.9790480213588185\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 104767799\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19460032568057914\n", " w: 0.9808826195039917\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 110119104\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.78\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.44175176239054637\n", " w: -0.8971373252879663\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 115175485\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.8\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4472135954999581\n", " w: -0.8944271909999159\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 125389814\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.8399999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4575815808579405\n", " w: -0.88916764271961\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 130516052\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.8599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4625031913273241\n", " w: -0.886617616569872\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 135543584\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.88\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4672596576628944\n", " w: -0.8841201345522873\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 140773057\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.9\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4718579255320243\n", " w: -0.8816745987679437\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 145755529\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.92\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4763046396231503\n", " w: -0.8792803251941106\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 155652761\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.18541469776456046\n", " w: -0.9826603634282176\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 165594339\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.4\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20362949657007595\n", " w: -0.9790480213588184\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 170762777\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.42\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.21249940721913338\n", " w: -0.9771611954695688\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 176393508\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.44\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2212077963865126\n", " w: -0.975226697141656\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 181800127\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.46\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22975292054736132\n", " w: -0.9732489894677301\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 186979532\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.48\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.23813352749512795\n", " w: -0.9712324248513984\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 192549467\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.5\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.24634882831815316\n", " w: -0.9691812290723923\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 197446823\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.52\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2543984682342505\n", " w: -0.9670994878294926\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 202584981\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.54\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.26228249672773746\n", " w: -0.964991135664087\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 208003759\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.56\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.27000133739072624\n", " w: -0.9628599471404028\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 218611955\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.38\n", " y: 1.6\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2849468399205243\n", " w: -0.9585433210968126\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 224246740\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.24105194839799388\n", " w: 0.9705122143350545\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 229452848\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2520481282044517\n", " w: 0.9677147002441537\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 239398479\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.27313183871594643\n", " w: 0.9619766102560114\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 244698524\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.62\n", " y: 0.56\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2832223886346635\n", " w: 0.9590542625816725\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 249553918\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.52\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2415067072620041\n", " w: -0.970399150013779\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 254461526\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.5\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2337072209964503\n", " w: -0.9723070167668834\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 260652303\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.48\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22576236623138388\n", " w: -0.9741824028351193\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 265647649\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.46\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2176729840000491\n", " w: -0.9760217579729021\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 270534515\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.44\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2094402855416525\n", " w: -0.9778214391146428\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 276278972\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.42\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20106587226819744\n", " w: -0.9795777228015289\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 281295299\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.32000000000000006\n", " y: 1.4\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.19255175447759681\n", " w: -0.9812868193589473\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 291850566\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.5800000000000001\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.109116771891509\n", " w: 0.9940289382568177\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 301547050\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.15538883846571666\n", " w: -0.987853384303701\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 306936025\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.14080797783928262\n", " w: -0.9900369252592612\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 312083721\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.76\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20759148751784476\n", " w: -0.9782156072717959\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 322208881\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.76\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.23690237287865085\n", " w: -0.9715334609391818\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 327419042\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1259418045976842\n", " w: -0.9920376312694387\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 332365989\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11081290072074987\n", " w: -0.9938412856356156\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 337442398\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.09544671133600852\n", " w: -0.9954345409393531\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 342834949\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07987139440172839\n", " w: -0.9968051767302994\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 347866296\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.06411760041507703\n", " w: -0.9979423496961197\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 352699756\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.048218183523956716\n", " w: -0.9988368269029982\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 358116388\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.03220784866722593\n", " w: -0.9994811926615873\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 367881774\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 378154516\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.96\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.03220784866722559\n", " w: 0.9994811926615873\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 383191823\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.04821818352395659\n", " w: 0.9988368269029982\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 388308048\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.06411760041507647\n", " w: 0.9979423496961197\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 393875360\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.02\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.019988012385059234\n", " w: -0.9998002197243681\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 398878574\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.9\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.07987139440172826\n", " w: 0.9968051767302994\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 403767585\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.88\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.09544671133600839\n", " w: 0.9954345409393531\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 409764766\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11081290072074974\n", " w: 0.9938412856356156\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 414951086\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.12594180459768387\n", " w: 0.9920376312694387\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 420086860\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1408079778392827\n", " w: 0.9900369252592612\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 425303459\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.15538883846571652\n", " w: 0.987853384303701\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 430182456\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.19999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.42639010612608985\n", " w: 0.9045393730500524\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 439953804\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.76\n", " y: 0.7\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2508413082792208\n", " w: 0.9680282217274292\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 444996356\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.76\n", " y: 0.6799999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.26429951415565045\n", " w: 0.9644406497120946\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 449827671\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.21999999999999997\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.42074799971825544\n", " w: 0.9071775574456673\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 459795713\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.16966474960750313\n", " w: 0.9855018380199112\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 464710474\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18361903731082782\n", " w: 0.9829974817551899\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 469603061\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19723795041962533\n", " w: 0.9803556451177631\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 474538803\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.72\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2105105702112428\n", " w: 0.9775915813003595\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 479656457\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.7\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2234286783119913\n", " w: 0.9747202807512301\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 484713554\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.6799999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.23598659172200467\n", " w: 0.9717563112876766\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 489722967\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.54\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.29966801066347837\n", " w: 0.9540435437573033\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 495101213\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.56\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.28978414868843\n", " w: 0.9570920264890529\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 500093221\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.27958765375807687\n", " w: 0.9601201715754407\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 504960298\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.26907449567543756\n", " w: 0.9631193673564087\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 510034799\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.25824169214694126\n", " w: 0.9660803426408615\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 520272731\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.23561137872925123\n", " w: 0.9718473533499493\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 525383234\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2091538614095483\n", " w: -0.9778827446363267\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 530594825\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22298919663900926\n", " w: -0.9748209159544584\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 535787105\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2364131519649989\n", " w: -0.9716526239237839\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 540748596\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.32\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2494216469887946\n", " w: -0.968394982439189\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 545828580\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2620133869693898\n", " w: -0.9650642388197942\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 551100015\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.27418956380748766\n", " w: -0.9616756641919664\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 556114435\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.28595355428832064\n", " w: -0.9582434788663455\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 561120033\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.4\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2973106238302744\n", " w: -0.9547808088549189\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 576299428\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.46\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.32901544105897723\n", " w: -0.9443245414288282\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 581553220\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.48\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3388256770636712\n", " w: -0.9408491699323249\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 586688756\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16526799202163722\n", " w: -0.986248696228865\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 591904163\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.14989306719919182\n", " w: -0.9887022142210559\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 596948146\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.13417783310578185\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ " w: -0.9909572690600927\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 602478742\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1181477706660459\n", " w: -0.9929960243055576\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 607594251\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1018321670517163\n", " w: -0.9948015931599383\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 612650632\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.08526395561915981\n", " w: -0.9963583983046331\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 617755174\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.5\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.348274344733734\n", " w: -0.9373926502807072\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 623017311\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.28\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3414984092253549\n", " w: 0.9398823524763895\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 633030652\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.31999999999999995\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3283172310655621\n", " w: 0.9445675178543047\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 642996549\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.36\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.31445729338494877\n", " w: 0.9492716211058941\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 648130416\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.38\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.30726504947082267\n", " w: 0.9516239747787426\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 658495664\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.42000000000000004\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2923421549950705\n", " w: 0.956313789722201\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 663693428\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.43999999999999995\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2846066718231622\n", " w: 0.9586443774172688\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 668989658\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.45999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.27668575238610654\n", " w: 0.9609604541429029\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 674111604\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.118147770666046\n", " w: 0.9929960243055576\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 689298868\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1652679920216371\n", " w: 0.986248696228865\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 694329023\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18028099412059023\n", " w: 0.98361514992343\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 699700593\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19491429857518042\n", " w: 0.980820277222563\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 704817295\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 0.48\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2685777507719221\n", " w: 0.9632580089416829\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 709985494\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.52\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3573727461303603\n", " w: -0.9339618409352949\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 725260019\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.72\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1992714456774268\n", " w: 0.9799443305298665\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 730535745\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18653633316717202\n", " w: 0.9824480629572974\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 735648155\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.17350299206578973\n", " w: 0.9848333421164306\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 745638370\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.14658716786698345\n", " w: 0.9891977568801583\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 750993490\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.13273315102540856\n", " w: 0.9911518100769761\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 756010770\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11863788246444575\n", " w: 0.9929375875876351\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 766157150\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.88\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.08980559531591699\n", " w: 0.9959593139531121\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 776026725\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.78\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.44905302228992916\n", " w: -0.8935051108820141\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 781177997\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.8\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.45444055086395463\n", " w: -0.8907770684803609\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 786368846\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.82\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4596385968199327\n", " w: -0.8881060524021911\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 791400432\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.8399999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4646554007634895\n", " w: -0.8854915914571526\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 796447515\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.8599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4694988454310717\n", " w: -0.8829330858784774\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 801863670\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.88\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.47417646391727253\n", " w: -0.8804298274518597\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 811674118\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7200000000000001\n", " y: 1.92\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4830626649951742\n", " w: -0.8755857820269582\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 817228317\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.06027527671563066\n", " w: 0.9981817925692965\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 822241544\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.0453144211719414\n", " w: 0.9989727740203193\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 827241659\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.96\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.030261389333680402\n", " w: 0.9995420192846299\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 837271690\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.5\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.26028139898560493\n", " w: -0.9655328028306943\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 842413663\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.52\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2685777507719222\n", " w: -0.9632580089416829\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 847511768\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.54\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2766857523861069\n", " w: -0.9609604541429028\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 852662086\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.56\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2846066718231625\n", " w: -0.9586443774172687\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 857846021\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.58\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2923421549950704\n", " w: -0.956313789722201\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 862745523\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.6\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.29989418608804097\n", " w: -0.9539724719039808\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 872780323\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.78\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2586642746412807\n", " w: -0.965967283620051\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 878543853\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.78\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.24446768710590874\n", " w: -0.9696574394914358\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 883789777\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.62\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3072650494708228\n", " w: -0.9516239747787425\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 889155864\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.6400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3144572933849491\n", " w: -0.949271621105894\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 894259214\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.6600000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3214736955877749\n", " w: -0.9469185091892219\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 899432420\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.44000000000000006\n", " y: 1.6800000000000002\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.32831723106556243\n", " w: -0.9445675178543046\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 904673814\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.44\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20222362266654906\n", " w: -0.9793393724524799\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 910182476\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.42\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.19406429543489445\n", " w: -0.9809888119837851\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 915421962\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.4\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.18577782633153045\n", " w: -0.9825917764990361\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 920648336\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.17736668961131188\n", " w: -0.984144835588911\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 925647974\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16883374428281583\n", " w: -0.9856445438348679\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 930770635\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16018224300696732\n", " w: -0.9870874576374967\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 945842981\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.13355495513623172\n", " w: -0.9910414088011454\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 950952291\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1244698049186115\n", " w: -0.9922233960472424\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 955973386\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11528840285654064\n", " w: -0.9933320613806784\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 960946798\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.10601640419687727\n", " w: -0.9943643809193712\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 966043710\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.09665984254808918\n", " w: -0.9953174743962745\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 975826501\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07771896040148105\n", " w: -0.9969753072138312\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 980881214\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.06814844237248041\n", " w: -0.9976751925362306\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 985726118\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.05852091795727326\n", " w: -0.9982861824954997\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274780\n", " nsecs: 990745067\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.04884401130138775\n", " w: -0.998806418962148\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 651359\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.029373685715314044\n", " w: -0.9995685001977093\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 5742549\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.019596546487295398\n", " w: -0.9998079692449802\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 10806322\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.02\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.009802508435994913\n", " w: -0.9999519542599845\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 15769958\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 20790576\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.009802508435994568\n", " w: 0.9999519542599845\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 25753021\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.96\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.019596546487295054\n", " w: 0.9998079692449802\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 30631065\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.029373685715313923\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ " w: 0.9995685001977093\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 40457248\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.9\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.04884401130138718\n", " w: 0.9988064189621481\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 50108432\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.0681484423724803\n", " w: 0.9976751925362306\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 55038452\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.07771896040148094\n", " w: 0.9969753072138312\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 60004949\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.08722511445123822\n", " w: 0.9961886264202018\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 65036773\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.09665984254808906\n", " w: 0.9953174743962745\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 70619344\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.10601640419687715\n", " w: 0.9943643809193712\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 75681686\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11528840285654074\n", " w: 0.9933320613806784\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 80657243\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.12446980491861137\n", " w: 0.9922233960472424\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 85528135\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.72\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1335549551362316\n", " w: 0.9910414088011454\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 90592145\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.7\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.14253858850979526\n", " w: 0.9897892456405228\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 95740079\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.6799999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.15141583868980985\n", " w: 0.9884701532134703\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 105350255\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.82\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.41877059356618074\n", " w: -0.9080920602913719\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 110445022\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.8\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4132162824305707\n", " w: -0.9106329139308873\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 115334749\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.78\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4074863545094142\n", " w: -0.9132112958612744\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 120264768\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.76\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4015745542537586\n", " w: -0.9158263358169468\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 125533103\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.74\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.39547449103824484\n", " w: -0.9184769604829732\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 130464076\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.72\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.38917965434243373\n", " w: -0.9211618732046523\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 140286207\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.6800000000000002\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3759791344880546\n", " w: -0.92662812952641\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 145173072\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1601822430069672\n", " w: 0.9870874576374967\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 150280237\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.16883374428281572\n", " w: 0.9856445438348679\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 155116558\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.17736668961131177\n", " w: 0.984144835588911\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 165024995\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.19406429543489434\n", " w: 0.9809888119837851\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 175313949\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.54\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.21025370759033932\n", " w: 0.97764685773776\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 180224657\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.28\n", " y: 0.52\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2181528108906758\n", " w: 0.9759146228541189\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 185202121\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.015146300779705028\n", " w: 0.9998852882069477\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 190119743\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 204694509\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.045314421171941524\n", " w: -0.9989727740203193\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 209732055\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.060275276715631224\n", " w: -0.9981817925692965\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 214566707\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07511489790725079\n", " w: -0.9971748854199965\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 219425439\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.08980559531591756\n", " w: -0.9959593139531121\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 224565505\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1043213182852834\n", " w: -0.9945436453727009\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 229576110\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11863788246444586\n", " w: -0.992937587587635\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 239255189\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.26\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3532994517154836\n", " w: 0.9355102871788951\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 244370698\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.28\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3469462477349362\n", " w: 0.9378850149046248\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 249405860\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.29999999999999993\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3404252637530184\n", " w: 0.9402715776831116\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 254323244\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.31999999999999995\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.333732774306416\n", " w: 0.9426677226646422\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 259426355\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.33999999999999997\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3268651565841618\n", " w: 0.945070986440284\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 264454603\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.36\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3198189174888669\n", " w: 0.9474786857846721\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 269366741\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.38\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.31259072316227876\n", " w: 0.949887909067635\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 274355411\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.4\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.30517743100798345\n", " w: 0.9522955085494037\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 279339790\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.42000000000000004\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2975761242082042\n", " w: 0.954698093797837\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 284818410\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.43999999999999995\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2897841486884302\n", " w: 0.9570920264890528\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 290004253\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 0.45999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2817991524325849\n", " w: 0.9594734168742127\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 295041561\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.13273315102540847\n", " w: -0.9911518100769761\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 305027246\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16018224300696732\n", " w: -0.9870874576374967\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 309917688\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.17350299206579006\n", " w: -0.9848333421164306\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 314843654\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.18653633316717214\n", " w: -0.9824480629572974\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 319965600\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.19927144567742694\n", " w: -0.9799443305298665\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 324929714\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.21169969595797175\n", " w: -0.9773347628787704\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 330038547\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.32\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22381453572523027\n", " w: -0.9746317528164674\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 334857463\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.23561137872925156\n", " w: -0.9718473533499493\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 339883804\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.24708746132252005\n", " w: -0.968993181842469\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 344886541\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.25824169214694137\n", " w: -0.9660803426408615\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 349734067\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.4\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.26907449567543745\n", " w: -0.9631193673564087\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 354714155\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.42\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.279587653758077\n", " w: -0.9601201715754407\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 359755277\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.020000000000000018\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.5019268181932333\n", " w: 0.8649100931185951\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 364704370\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.040000000000000036\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4980607264560787\n", " w: 0.8671421525690255\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 369681596\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.05999999999999994\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4940621544428503\n", " w: 0.8694265854845302\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 374783277\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.07999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4899250213574801\n", " w: 0.8717645745543189\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 380334615\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.09999999999999998\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.485642931178632\n", " w: 0.8741572761215378\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 395060062\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.16000000000000003\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4718579255320242\n", " w: 0.8816745987679439\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 400159597\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.24818097361470035\n", " w: 0.9687136854280832\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 405255794\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2600106280423077\n", " w: 0.9656057545939982\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 410379886\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.27147628587876454\n", " w: 0.9624451289322791\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 415443658\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.28258038836387406\n", " w: 0.9592436208347294\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 425361633\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.56\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3037209700241181\n", " w: 0.9527610258441561\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 430411100\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.54\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.31376900083198\n", " w: 0.9494993491924578\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 435678482\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.52\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3234782004912284\n", " w: 0.9462356227742414\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 440664052\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.5\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.33285654607102944\n", " w: 0.9429774757318781\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 445927381\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.72\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4026632411101451\n", " w: -0.9153481929073073\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 451204538\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.74\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.40889188854854913\n", " w: -0.9125828310236835\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 456284523\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.76\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4149176692753375\n", " w: -0.9098589603466691\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 461382865\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.78\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.42074799971825555\n", " w: -0.9071775574456672\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 466621875\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.8\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.42639010612608996\n", " w: -0.9045393730500524\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 471570014\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.82\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.431851012959552\n", " w: -0.9019449554190149\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 476725578\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.8399999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.43713753446032066\n", " w: -0.8993946719688481\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 481986045\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.8599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4422562689555396\n", " w: -0.8968887292019704\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 486861705\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.64\n", " y: 1.88\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4472135954999581\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ " w: -0.8944271909999159\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 492344141\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.48\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3419126035072468\n", " w: 0.9397317551104125\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 497493743\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.5\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.26524245096731186\n", " w: -0.9641817474962141\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 502514123\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.52\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2736191269923746\n", " w: -0.9618381222138842\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 507708787\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.54\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.281799152432585\n", " w: -0.9594734168742127\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 513143777\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.56\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.28978414868843033\n", " w: -0.9570920264890528\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 518277168\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.58\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2975761242082045\n", " w: -0.9546980937978369\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 528309106\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.62\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3125907231622791\n", " w: -0.9498879090676349\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 533605575\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.6400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.31981891748886704\n", " w: -0.947478685784672\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 538553953\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.6600000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3268651565841624\n", " w: -0.9450709864402838\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 543909788\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.6800000000000002\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3337327743064161\n", " w: -0.9426677226646422\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 549043178\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.7000000000000002\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3404252637530187\n", " w: -0.9402715776831115\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 554302453\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.4600000000000001\n", " y: 1.72\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3469462477349363\n", " w: -0.9378850149046247\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 559303998\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.19999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.440129716426979\n", " w: 0.8979342028890018\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 570015192\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.14\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.4556305656033062\n", " w: 0.8901689658081837\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 575116872\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.12\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.46045980691414007\n", " w: 0.8876805541503051\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 580507040\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.09999999999999998\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.46513157479819833\n", " w: 0.8852415591948607\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 585680961\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.07999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.46965228516834534\n", " w: 0.8828514773370157\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 590764999\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.68\n", " y: 0.05999999999999994\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.47402808681175435\n", " w: 0.8805097233498265\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 595724582\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2352787683598465\n", " w: -0.9719279300231441\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 600659370\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2241560186834192\n", " w: -0.9745532716521959\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 605915069\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.32\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2127504693463683\n", " w: -0.9771065641949706\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 610809803\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20106587226819744\n", " w: -0.9795777228015289\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 620926618\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.17688234506337097\n", " w: -0.9842320031399521\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 625990629\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16439898730535749\n", " w: -0.9863939238321437\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 631091356\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.15166786590894046\n", " w: -0.9884315142945553\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 636087656\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.13870121188940082\n", " w: -0.9903342737785114\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 641154050\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.12551308179458903\n", " w: -0.9920919646375657\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 646355867\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11211934139151168\n", " w: -0.9936947485450115\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 651412963\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.09853761796664212\n", " w: -0.9951333266680702\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 656320095\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.08478721951666247\n", " w: -0.9963990803923061\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 661324501\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07088902009067946\n", " w: -0.9974842088126424\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 666399717\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.05686531167414731\n", " w: -0.9983818589739109\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 671593189\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.04273962422769448\n", " w: -0.9990862447861423\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 676582574\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.028536516746297248\n", " w: -0.9995927506799899\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 681653261\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.02\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.01428134341204036\n", " w: -0.9998980164148479\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 686815500\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 706691741\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.056865311674147184\n", " w: 0.9983818589739109\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 711645841\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.9\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.07088902009067935\n", " w: 0.9974842088126424\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 716599464\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.88\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.08478721951666214\n", " w: 0.9963990803923062\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 721657037\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.09853761796664222\n", " w: 0.9951333266680702\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 727007627\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11211934139151178\n", " w: 0.9936947485450115\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 732393980\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1255130817945889\n", " w: 0.9920919646375657\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 737323284\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.6\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.13870121188940068\n", " w: 0.9903342737785114\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 752219915\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.38\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.17426284200778658\n", " w: -0.9846991732988147\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 757430553\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.16585223326766213\n", " w: -0.9861506156364397\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 762416124\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.15732875583369255\n", " w: -0.9875462837699418\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 767349243\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.32\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.14869598393710906\n", " w: -0.9888829578676007\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 777202844\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.13111872764660726\n", " w: -0.9913666724579432\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 782358884\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.12218326369570462\n", " w: -0.992507556682903\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 787335157\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11315653826752582\n", " w: -0.9935771725675414\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 792430162\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.10404397359063851\n", " w: -0.9945726979761059\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 803508520\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.0855847362108225\n", " w: -0.9963308952992093\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 813933134\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.09853761796664212\n", " w: -0.9951333266680702\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 819513559\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.08248053154489343\n", " w: -0.9965926760297167\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 824577569\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07625058147116927\n", " w: -0.997088686539622\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 830288171\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.0668555845727849\n", " w: -0.9977626625663195\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 835339546\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.057406724906011355\n", " w: -0.9983508741597643\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 840280532\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.047911224675012236\n", " w: -0.9988515978613342\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 845885992\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.03837651950358735\n", " w: -0.99926335004882\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 850907087\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.02881022669462327\n", " w: -0.9995848992645919\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 861142158\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.02\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.009614051439254635\n", " w: -0.9999537839394995\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 866601228\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 871670961\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.78\n", " y: 0.6799999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2723432423390162\n", " w: 0.9622001654293517\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 877124071\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.78\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.28550865663448327\n", " w: 0.9583761302259007\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 887021064\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.009614051439254511\n", " w: 0.9999537839394995\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 892080545\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.96\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.01922011145500669\n", " w: 0.9998152765964606\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 897006750\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.02881022669462315\n", " w: 0.9995848992645919\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 901942014\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.038376519503587225\n", " w: 0.99926335004882\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 911634922\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.88\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.057406724906011015\n", " w: 0.9983508741597643\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 917655467\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.42000000000000004\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.39077198357893606\n", " w: 0.9204875104257437\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 923096418\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.43999999999999995\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3826834323650898\n", " w: 0.9238795325112867\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 928205966\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.45999999999999996\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.37426975871643375\n", " w: 0.9273198734580977\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 933183193\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.48\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.36551778915238914\n", " w: 0.9308043542083103\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 938131809\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.5\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.356414322365197\n", " w: 0.9343280102902607\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 943104505\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.52\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3469462477349362\n", " w: 0.9378850149046248\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 948177099\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.54\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3371006863496171\n", " w: 0.9414686013153158\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 953910827\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.56\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3268651565841618\n", " w: 0.945070986440284\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 958983421\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.5800000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3162277660168379\n", " w: 0.9486832980505138\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 963898420\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.30517743100798345\n", " w: 0.9522955085494037\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 973921060\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.24\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3650819794101519\n", " w: 0.9309753747065308\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 978955030\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.26\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3588919631667364\n", " w: 0.933379107744718\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 983856439\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.28\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.3525335267385748\n", " w: 0.9357991838665295\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 989523410\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.29999999999999993\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.34600252730153036\n", " w: 0.9382335802458542\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 994601249\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.31999999999999995\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.33929488620269754\n", " w: 0.9406800626125221\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274781\n", " nsecs: 999475240\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.33999999999999997\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.33240661450780495\n", " w: 0.9431361739597626\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 4974842\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.36\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.325333841242291\n", " w: 0.9455992236368089\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 9953260\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.38\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.31807284442247913\n", " w: 0.9480662770297198\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 14833927\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 0.4\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.310620084944269\n", " w: 0.9505341460616842\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 25223970\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2937041245950093\n", " w: 0.9558963789009137\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 30126810\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.06622725767146533\n", " w: -0.9978045652036862\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 35314798\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.049813701880160245\n", " w: -0.998758526924799\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 40180683\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.03327793671031174\n", " w: -0.9994461360815321\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 49910545\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 54919004\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.016659727201332828\n", " w: 0.999861217114444\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 64617395\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.0498137018801599\n", " w: 0.998758526924799\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 74310064\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.9\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.0824805315448933\n", " w: 0.9965926760297167\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 79130172\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.88\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.09853761796664222\n", " w: 0.9951333266680702\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 84494590\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11436518320320817\n", " w: 0.9934387776158613\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 89444875\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1299327910859183\n", " w: 0.9915228034698058\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 94539403\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.7000000000000001\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.14521314468540483\n", " w: 0.9894003954974829\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 99544286\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2817991524325849\n", " w: 0.9594734168742127\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 114587545\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.7\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.24343380000650897\n", " w: 0.9699175145415155\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 119551897\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.72\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2297529205473612\n", " w: 0.9732489894677302\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 124788284\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.21562818954344573\n", " w: 0.9764755418719999\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 129829168\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.20106587226819733\n", " w: 0.9795777228015289\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 134856700\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18607593417695478\n", " w: 0.9825353666510807\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 140148878\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1706723299266206\n", " w: 0.9853278417853718\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 145434379\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.15487323641406808\n", " w: 0.9879343503708291\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 150578022\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.84\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.13870121188940068\n", " w: 0.9903342737785114\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 155785322\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.12218326369570451\n", " w: 0.992507556682903\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 160781383\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.88\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.10535080902060162\n", " w: 0.9944351195722648\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 166054725\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.9\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.08823951635043682\n", " w: 0.9960992860926269\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 171416759\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.07088902009067935\n", " w: 0.9974842088126424\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 176445245\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.05334250687861896\n", " w: 0.9985762749834909\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 181513309\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.96\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.035646179102850534\n", " w: 0.9993644730104065\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 186401605\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.01784860852350188\n", " w: 0.9998407008987855\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 191464185\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.0\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 1.2246467991473532e-16\n", " w: -1.0\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 196401596\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.02\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.017848608523502\n", " w: -0.9998407008987855\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 202030181\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.03564617910285066\n", " w: -0.9993644730104065\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 207169055\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.05334250687861886\n", " w: -0.9985762749834909\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 212070226\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.07088902009067946\n", " w: -0.9974842088126424\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 217251539\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.08823951635043695\n", " w: -0.9960992860926269\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 222208023\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.10535080902060195\n", " w: -0.9944351195722648\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 227196216\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.12218326369570462\n", " w: -0.992507556682903\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 237060546\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.154873236414068\n", " w: -0.9879343503708291\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 242187261\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.17067232992662093\n", " w: -0.9853278417853718\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 247247457\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.1860759341769549\n", " w: -0.9825353666510807\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 252970695\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20106587226819744\n", " w: -0.9795777228015289\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 257914304\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.26\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.21562818954344587\n", " w: -0.9764755418719999\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 263029098\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.22975292054736132\n", " w: -0.9732489894677301\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 268226146\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.3\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2434338000065093\n", " w: -0.9699175145415154\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 273382425\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.32\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2566679351570242\n", " w: -0.9664996487646695\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 278353691\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.34\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.26945545529666975\n", " w: -0.9630128543331415\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 284327268\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.3599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.281799152432585\n", " w: -0.9594734168742127\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 300302028\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.42\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.316227766016838\n", " w: -0.9486832980505138\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 305560827\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.44\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.32686515658416193\n", " w: -0.9450709864402839\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 310952186\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.46\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3371006863496172\n", " w: -0.9414686013153157\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 316304206\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.48\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3469462477349363\n", " w: -0.9378850149046247\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 326643943\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.52\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.36551778915238925\n", " w: -0.9308043542083103\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 332321166\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.54\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.37426975871643386\n", " w: -0.9273198734580977\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 337460041\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.86\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.06685558457278479\n", " w: 0.9977626625663195\n" ] }, { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 348346710\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.8200000000000001\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.08558473621082238\n", " w: 0.9963308952992093\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 353662014\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.8\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.09485133899780393\n", " w: 0.9954914482256106\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 359004020\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.78\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.10404397359063816\n", " w: 0.994572697976106\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 364920377\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.76\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.11315653826752592\n", " w: 0.9935771725675414\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 370232820\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.74\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.12218326369570451\n", " w: 0.992507556682903\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 375470161\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.72\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.13111872764660712\n", " w: 0.9913666724579432\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 380930185\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.54\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2870793750690928\n", " w: -0.9579067973503159\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 386319875\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.56\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.295126259528418\n", " w: -0.9554582622683028\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 391432046\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.58\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.30297224335996137\n", " w: -0.9529993807728483\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 396963119\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.6\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.31062008494426935\n", " w: -0.9505341460616841\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 402082204\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.62\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3180728444224793\n", " w: -0.9480662770297198\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 407238245\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.6400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.32533384124229153\n", " w: -0.9455992236368087\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 417863607\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.6800000000000002\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3392948862026979\n", " w: -0.940680062612522\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 422906398\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.7000000000000002\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.34600252730153047\n", " w: -0.9382335802458541\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 433832883\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.31924740083272213\n", " w: 0.9476714077471955\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 438734054\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.64\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.30697366218334243\n", " w: 0.9517180100879394\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 444232463\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.2941712918781097\n", " w: 0.9557527143747822\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 449811220\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.48\n", " y: 1.74\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.3588919631667365\n", " w: -0.933379107744718\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 464701652\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.6599999999999999\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.1573287558336922\n", " w: 0.9875462837699418\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 475472450\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.8\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.46181038080400033\n", " w: -0.8869786762835193\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 480367660\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.82\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4669252369718666\n", " w: -0.8842967958093969\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 486027002\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.8399999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4718579255320243\n", " w: -0.8816745987679437\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 491405010\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.8599999999999999\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4766166324010143\n", " w: -0.8791112476351991\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 496431589\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.88\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4812091581666131\n", " w: -0.8766058099833582\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 501619100\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.9\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4856429311786321\n", " w: -0.8741572761215377\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 511833667\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.74\n", " y: 1.94\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.4940621544428504\n", " w: -0.8694265854845302\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 517138719\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.62\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.17426284200778666\n", " w: 0.9846991732988147\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 522555828\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.26\n", " y: 0.6\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.18255737974256261\n", " w: 0.9831952009146148\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 532882928\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.28\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2524816667109519\n", " w: -0.9676016783650491\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 542912244\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.24\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.2218974341128425\n", " w: -0.9750700122217567\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 548634052\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.22\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.20577289371687732\n", " w: -0.978599773253286\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 553763151\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.9\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.09853761796664222\n", " w: 0.9951333266680702\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 558809041\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.92\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.07924445748219446\n", " w: 0.9968552131369693\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 564349412\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.94\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.05967898086042507\n", " w: 0.9982176211846098\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 574591636\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 0.98\n", " z: 0.0\n", " orientation: \n", " x: 0.0\n", " y: 0.0\n", " z: 0.019988012385059335\n", " w: 0.9998002197243681\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 580209493\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.2\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.18910752115495139\n", " w: -0.9819563867314218\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 585458517\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.18\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.17191944062739548\n", " w: -0.9851110119851282\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 590656518\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.16\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.15423335048016681\n", " w: -0.9880344496016634\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 596848487\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.1400000000000001\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.13608082209815345\n", " w: -0.990697738897738\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 602500677\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.12\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.11750042131729284\n", " w: -0.993072832671531\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 607562541\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.1\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.09853761796664212\n", " w: -0.9951333266680702\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 612735986\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.08\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.0792444574821948\n", " w: -0.9968552131369693\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 617785930\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.06\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.059678980860425196\n", " w: -0.9982176211846098\n", "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274782\n", " nsecs: 627533674\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 0.8\n", " y: 1.04\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.039904394895017646\n", " w: -0.9992035024298416\n" ] } ], "source": [ "from pycram.designators.location_designator import CostmapLocation\n", "from pycram.designators.object_designator import BelieveObject\n", "\n", "target = BelieveObject(names=[\"milk\"]).resolve()\n", "robot_desig = BelieveObject(names=[\"pr2\"]).resolve()\n", "\n", "location_description = CostmapLocation(target=target, visible_for=robot_desig)\n", "\n", "for pose in location_description:\n", " print(pose.pose)" ] }, { "cell_type": "markdown", "id": "9279fde8", "metadata": {}, "source": [ "## Accessing Locations\n", "Accessing describes a location from which the robot can open a drawer. The drawer is specified by a ObjetcPart designator which describes the handle of the drawer.\n", "\n", "At the moment this location designator only works in the apartment environment, so please remove the kitchen if you spawned it in a previous example. Furthermore, we need a robot so we also spawn the pr2 if it isn't spawned already." ] }, { "cell_type": "code", "execution_count": 9, "id": "223facbe", "metadata": {}, "outputs": [], "source": [ "kitchen.remove()" ] }, { "cell_type": "code", "execution_count": 10, "id": "e3b0dac5", "metadata": {}, "outputs": [ { "name": "stderr", "output_type": "stream", "text": [ "Unknown tag \"material\" in /robot[@name='apartment']/link[@name='coffe_machine']/collision[1]\n", "Unknown tag \"material\" in /robot[@name='apartment']/link[@name='coffe_machine']/collision[1]\n" ] } ], "source": [ "apartment = Object(\"apartment\", \"environment\", \"apartment.urdf\")" ] }, { "cell_type": "code", "execution_count": 10, "id": "85d459ed", "metadata": {}, "outputs": [ { "name": "stderr", "output_type": "stream", "text": [ "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='base_laser_link']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='wide_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='narrow_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='laser_tilt_link']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='base_laser_link']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='wide_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='narrow_stereo_optical_frame']\n", "Unknown attribute \"type\" in /robot[@name='pr2']/link[@name='laser_tilt_link']\n" ] } ], "source": [ "pr2 = Object(\"pr2\", \"robot\", \"pr2.urdf\")\n", "pr2.set_joint_state(\"torso_lift_joint\", 0.25)" ] }, { "cell_type": "code", "execution_count": 11, "id": "e8394d98", "metadata": {}, "outputs": [ { "name": "stdout", "output_type": "stream", "text": [ "header: \n", " seq: 0\n", " stamp: \n", " secs: 1690274807\n", " nsecs: 896183252\n", " frame_id: \"map\"\n", "pose: \n", " position: \n", " x: 1.8074915790557862\n", " y: 2.7473597526550293\n", " z: 0.0\n", " orientation: \n", " x: -0.0\n", " y: 0.0\n", " z: 0.5893608715092853\n", " w: -0.8078698924541103\n" ] } ], "source": [ "from pycram.designators.object_designator import *\n", "from pycram.designators.location_designator import *\n", "\n", "apartment_desig = BelieveObject(names=[\"apartment\"])\n", "handle_desig = ObjectPart(names=[\"handle_cab10_t\"], part_of=apartment_desig.resolve())\n", "robot_desig = BelieveObject(names=[\"pr2\"])\n", "\n", "access_location = AccessingLocation(handle_desig.resolve(), robot_desig.resolve()).resolve()\n", "print(access_location.pose)" ] } ], "metadata": { "kernelspec": { "display_name": "Python 3", "language": "python", "name": "python3" }, "language_info": { "codemirror_mode": { "name": "ipython", "version": 3 }, "file_extension": ".py", "mimetype": "text/x-python", "name": "python", "nbconvert_exporter": "python", "pygments_lexer": "ipython3", "version": "3.8.10" } }, "nbformat": 4, "nbformat_minor": 5 }