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