facebookresearch / NGDF

Neural Grasp Distance Fields for Robot Manipulation
MIT License
83 stars 9 forks source link

Error running first script of `scripts/eval/reach_and_grasp/perobj.sh` #10

Closed paucarre closed 1 year ago

paucarre commented 1 year ago

Running

bash scripts/eval/reach_and_grasp/perobj.sh

For the first script launch

echo "Evaluating NGDF..."
python -m OMG-Planner.omg_bullet.panda_scene \
    render=False\
    experiment=perobj_reach_grasp \
    eval=1obj_float_rotpos_nograv \
    variant=NGDF_grasp1k_smth0.01_obs0.1 \
    dataset=acronym_perobj \
    data_root=$DATA_ROOT \
    project_root=$PROJECT_ROOT

I get the following error

Processing link panda_virtual_ee_link
        Processing joint panda_virtual_ee_joint of link panda_virtual_ee_link
Error executing job with overrides: ['render=False', 'experiment=perobj_reach_grasp', 'eval=1obj_float_rotpos_nograv', 'variant=NGDF_grasp1k_smth0.01_obs0.1', 'dataset=acronym_perobj', 'data_root=/home/ros/NGDF/scripts/eval/reach_and_grasp/../../../data', 'project_root=/home/ros/NGDF/scripts/eval/reach_and_grasp/../../..']
Traceback (most recent call last):
  File "/home/ros/NGDF/OMG-Planner/omg_bullet/panda_scene.py", line 123, in main
    info = planning_scene.step(category=category, pc_dict=pc_dict, viz_env=env)
  File "/home/ros/NGDF/OMG-Planner/omg/core.py", line 566, in step
    self.traj, category=category, pc_dict=pc_dict, viz_env=viz_env
  File "/home/ros/NGDF/OMG-Planner/omg/planner.py", line 823, in plan
    pc_dict["points_world"], category=category
  File "/home/ros/NGDF/OMG-Planner/omg/../omg_bullet/methods/ngdf_pred.py", line 86, in get_shape_code
    latent = self.models[category].shape_model.extract_latent(shape_mi)
KeyError: 'Book'
thomasweng15 commented 1 year ago

Hi @paucarre , it seems like an extra file was present in the acronym_perobj dataset, can you delete acronym_perobj/meshes_bullet/Bottle_244894af3ba967ccd957eaf7f4edb205_0.012953570261294404 and try again? I have removed the file from the Google Drive as well.

paucarre commented 1 year ago

Hi @thomasweng15 I deleted that file but I still get the error: Error output :

pybullet build time: May 20 2022 19:44:17
/home/ros/miniconda3/envs/ngdf/lib/python3.8/site-packages/hydra/_internal/defaults_list.py:251: UserWarning: In 'panda_scene': Defaults list is missing `_self_`. See https://hydra.cc/docs/upgrades/1.0_to_1.1/default_composition_order for more information
  warnings.warn(msg, UserWarning)
ffmpeg version 4.2.7-0ubuntu0.1 Copyright (c) 2000-2022 the FFmpeg developers
  built with gcc 9 (Ubuntu 9.4.0-1ubuntu1~20.04.1)
  configuration: --prefix=/usr --extra-version=0ubuntu0.1 --toolchain=hardened --libdir=/usr/lib/x86_64-linux-gnu --incdir=/usr/include/x86_64-linux-gnu --arch=amd64 --enable-gpl --disable-stripping --enable-avresample --disable-filter=resample --enable-avisynth --enable-gnutls --enable-ladspa --enable-libaom --enable-libass --enable-libbluray --enable-libbs2b --enable-libcaca --enable-libcdio --enable-libcodec2 --enable-libflite --enable-libfontconfig --enable-libfreetype --enable-libfribidi --enable-libgme --enable-libgsm --enable-libjack --enable-libmp3lame --enable-libmysofa --enable-libopenjpeg --enable-libopenmpt --enable-libopus --enable-libpulse --enable-librsvg --enable-librubberband --enable-libshine --enable-libsnappy --enable-libsoxr --enable-libspeex --enable-libssh --enable-libtheora --enable-libtwolame --enable-libvidstab --enable-libvorbis --enable-libvpx --enable-libwavpack --enable-libwebp --enable-libx265 --enable-libxml2 --enable-libxvid --enable-libzmq --enable-libzvbi --enable-lv2 --enable-omx --enable-openal --enable-opencl --enable-opengl --enable-sdl2 --enable-libdc1394 --enable-libdrm --enable-libiec61883 --enable-nvenc --enable-chromaprint --enable-frei0r --enable-libx264 --enable-shared
  libavutil      56. 31.100 / 56. 31.100
  libavcodec     58. 54.100 / 58. 54.100
  libavformat    58. 29.100 / 58. 29.100
  libavdevice    58.  8.100 / 58.  8.100
  libavfilter     7. 57.100 /  7. 57.100
  libavresample   4.  0.  0 /  4.  0.  0
  libswscale      5.  5.100 /  5.  5.100
  libswresample   3.  5.100 /  3.  5.100
  libpostproc    55.  5.100 / 55.  5.100
Input #0, avi, from '/home/ros/NGDF/data/pybullet_eval/perobj_reach_grasp/NGDF_grasp1k_smth0.01_obs0.1_2023-01-06_102511/videos/Bowl_9a52843cc89cd208362be90aaa182ec6_0.0008104428339208306_0.avi':
  Metadata:
    encoder         : Lavf58.76.100
  Duration: N/A, start: 0.000000, bitrate: N/A
    Stream #0:0: Video: mjpeg (Baseline) (MJPG / 0x47504A4D), yuvj420p(pc, bt470bg/unknown/unknown), 640x480, 10 fps, 10 tbr, 10 tbn, 10 tbc
Stream mapping:
  Stream #0:0 -> #0:0 (mjpeg (native) -> gif (native))
Press [q] to stop, [?] for help
[swscaler @ 0x55aaaa75b2c0] deprecated pixel format used, make sure you did set range correctly
Output #0, gif, to '/home/ros/NGDF/data/pybullet_eval/perobj_reach_grasp/NGDF_grasp1k_smth0.01_obs0.1_2023-01-06_102511/gifs/Bowl_9a52843cc89cd208362be90aaa182ec6_0.0008104428339208306_0.gif':
  Metadata:
    encoder         : Lavf58.29.100
    Stream #0:0: Video: gif, pal8, 320x240, q=2-31, 200 kb/s, 10 fps, 100 tbn, 10 tbc
    Metadata:
      encoder         : Lavc58.54.100 gif
[mjpeg @ 0x55aaaa714000] overread 8
[mjpeg @ 0x55aaaa714000] EOI missing, emulating
[Parsed_palettegen_3 @ 0x55aaaa755700] 255(+1) colors generated out of 2980 colors; ratio=0.085570
[Parsed_palettegen_3 @ 0x55aaaa755700] Dupped color: FF979699
[Parsed_palettegen_3 @ 0x55aaaa755700] Dupped color: FF9C9A9C
[Parsed_palettegen_3 @ 0x55aaaa755700] Dupped color: FFA6A4A6
[Parsed_palettegen_3 @ 0x55aaaa755700] Dupped color: FFEFEDEF
[Parsed_palettegen_3 @ 0x55aaaa755700] Dupped color: FFF2F0F2
frame=   48 fps=0.0 q=-0.0 Lsize=     254kB time=00:00:04.71 bitrate= 441.3kbits/s speed=28.5x    
video:254kB audio:0kB subtitle:0kB other streams:0kB global headers:0kB muxing overhead: 0.007698%
Unknown tag "contact" in /robot[@name='panda']/link[@name='panda_leftfinger']
Unknown tag "contact" in /robot[@name='panda']/link[@name='panda_rightfinger']
Unknown tag "contact" in /robot[@name='panda']/link[@name='panda_leftfinger']
Unknown tag "contact" in /robot[@name='panda']/link[@name='panda_rightfinger']
Error executing job with overrides: ['render=False', 'experiment=perobj_reach_grasp', 'eval=1obj_float_rotpos_nograv', 'variant=NGDF_grasp1k_smth0.01_obs0.1', 'dataset=acronym_perobj', 'data_root=/home/ros/NGDF/scripts/eval/reach_and_grasp/../../../data', 'project_root=/home/ros/NGDF/scripts/eval/reach_and_grasp/../../..']
Traceback (most recent call last):
  File "/home/ros/NGDF/OMG-Planner/omg_bullet/panda_scene.py", line 123, in main
    info = planning_scene.step(category=category, pc_dict=pc_dict, viz_env=env)
  File "/home/ros/NGDF/OMG-Planner/omg/core.py", line 565, in step
    plan = self.planner.plan(
  File "/home/ros/NGDF/OMG-Planner/omg/planner.py", line 822, in plan
    shape_code, mean_pc = self.grasp_predictor.get_shape_code(
  File "/home/ros/NGDF/OMG-Planner/omg/../omg_bullet/methods/ngdf_pred.py", line 86, in get_shape_code
    latent = self.models[category].shape_model.extract_latent(shape_mi)
KeyError: 'Book'

Set the environment variable HYDRA_FULL_ERROR=1 for a complete stack trace.

Standard Output:

Evaluating NGDF...
Setting up env...
env init time: 0.145
LOADING panda/panda_gripper.urdf
Processing link panda_link1
    Processing joint panda_joint1 of link panda_link1
Processing link panda_link2
    Processing joint panda_joint2 of link panda_link2
Processing link panda_link3
    Processing joint panda_joint3 of link panda_link3
Processing link panda_link4
    Processing joint panda_joint4 of link panda_link4
Processing link panda_link5
    Processing joint panda_joint5 of link panda_link5
Processing link panda_link6
    Processing joint panda_joint6 of link panda_link6
Processing link panda_link7
    Processing joint panda_joint7 of link panda_link7
Processing link panda_virtual_ee_link
    Processing joint panda_virtual_ee_joint of link panda_virtual_ee_link
Processing link panda_link1
    Processing joint panda_joint1 of link panda_link1
Processing link panda_link2
    Processing joint panda_joint2 of link panda_link2
Processing link panda_link3
    Processing joint panda_joint3 of link panda_link3
Processing link panda_link4
    Processing joint panda_joint4 of link panda_link4
Processing link panda_link5
    Processing joint panda_joint5 of link panda_link5
Processing link panda_link6
    Processing joint panda_joint6 of link panda_link6
Processing link panda_link7
    Processing joint panda_joint7 of link panda_link7
Processing link panda_link8
    Processing joint panda_joint8 of link panda_link8
Processing link panda_hand
    Processing joint panda_hand_joint of link panda_hand
Processing link panda_leftfinger
    Processing joint panda_finger_joint1 of link panda_leftfinger
Processing link panda_rightfinger
    Processing joint panda_finger_joint2 of link panda_rightfinger
Processing link panda_virtual_ee_link
    Processing joint panda_virtual_ee_joint of link panda_virtual_ee_link
plan step 0 wt obs cost 0.0000000000, wt smth cost 0.0167916, wt goal cost 181.3561171, collision pts: 0
plan step 1 wt obs cost 0.0000000000, wt smth cost 0.0230790, wt goal cost 141.5649353, collision pts: 0
plan step 2 wt obs cost 0.0364555299, wt smth cost 0.0332272, wt goal cost 98.0758479, collision pts: 0
plan step 3 wt obs cost 0.1867006409, wt smth cost 0.0458549, wt goal cost 71.8058129, collision pts: 0
plan step 4 wt obs cost 0.5274977780, wt smth cost 0.0596783, wt goal cost 72.1170863, collision pts: 0
plan step 5 wt obs cost 0.9963740474, wt smth cost 0.0686258, wt goal cost 82.3116326, collision pts: 0
plan step 6 wt obs cost 1.4429566393, wt smth cost 0.0733380, wt goal cost 86.7065869, collision pts: 0
plan step 7 wt obs cost 1.7963144199, wt smth cost 0.0751869, wt goal cost 85.2777454, collision pts: 7
plan step 8 wt obs cost 1.9648396850, wt smth cost 0.0760559, wt goal cost 80.7872152, collision pts: 27
plan step 9 wt obs cost 1.8199946597, wt smth cost 0.0779983, wt goal cost 73.8437776, collision pts: 55
plan step 10 wt obs cost 1.7106943032, wt smth cost 0.0771403, wt goal cost 70.9743324, collision pts: 62
plan step 11 wt obs cost 1.6061762587, wt smth cost 0.0746955, wt goal cost 81.3992145, collision pts: 62
plan step 12 wt obs cost 1.6011088606, wt smth cost 0.0728358, wt goal cost 70.8079312, collision pts: 54
plan step 13 wt obs cost 1.4023291313, wt smth cost 0.0738484, wt goal cost 56.4883434, collision pts: 58
plan step 14 wt obs cost 1.2003637746, wt smth cost 0.0789855, wt goal cost 49.1448400, collision pts: 63
plan step 15 wt obs cost 0.9534868933, wt smth cost 0.0872565, wt goal cost 50.0452898, collision pts: 48
plan step 16 wt obs cost 0.8097400033, wt smth cost 0.0972396, wt goal cost 52.4992268, collision pts: 18
plan step 17 wt obs cost 0.7510214144, wt smth cost 0.1079890, wt goal cost 55.3985880, collision pts: 19
plan step 18 wt obs cost 0.7245033774, wt smth cost 0.1187386, wt goal cost 59.6707436, collision pts: 23
plan step 19 wt obs cost 0.7434058012, wt smth cost 0.1271180, wt goal cost 61.9435056, collision pts: 28
plan step 20 wt obs cost 0.8273156355, wt smth cost 0.1330609, wt goal cost 61.3942425, collision pts: 27
plan step 21 wt obs cost 0.9164358003, wt smth cost 0.1368387, wt goal cost 59.3350871, collision pts: 30
plan step 22 wt obs cost 1.0726023077, wt smth cost 0.1384359, wt goal cost 55.3889399, collision pts: 20
plan step 23 wt obs cost 1.1855387721, wt smth cost 0.1388261, wt goal cost 51.2576976, collision pts: 18
plan step 24 wt obs cost 1.3658109625, wt smth cost 0.1387369, wt goal cost 50.8121488, collision pts: 22
plan step 25 wt obs cost 1.5545159172, wt smth cost 0.1380062, wt goal cost 52.7801601, collision pts: 44
plan step 26 wt obs cost 1.6853794740, wt smth cost 0.1357723, wt goal cost 54.2037972, collision pts: 42
plan step 27 wt obs cost 1.7556903008, wt smth cost 0.1320258, wt goal cost 54.5887466, collision pts: 37
plan step 28 wt obs cost 1.8287571929, wt smth cost 0.1271277, wt goal cost 54.7022867, collision pts: 38
plan step 29 wt obs cost 1.7200173787, wt smth cost 0.1209461, wt goal cost 53.3855391, collision pts: 35
plan step 30 wt obs cost 1.5973229860, wt smth cost 0.1144659, wt goal cost 52.2427529, collision pts: 34
plan step 31 wt obs cost 1.6207508829, wt smth cost 0.1092192, wt goal cost 49.7852312, collision pts: 40
plan step 32 wt obs cost 1.6090731509, wt smth cost 0.1054265, wt goal cost 47.4318302, collision pts: 50
plan step 33 wt obs cost 1.5390208436, wt smth cost 0.1032301, wt goal cost 45.2046895, collision pts: 52
plan step 34 wt obs cost 1.4392087881, wt smth cost 0.1028756, wt goal cost 41.3856714, collision pts: 49
plan step 35 wt obs cost 1.1886595486, wt smth cost 0.1030929, wt goal cost 29.7569927, collision pts: 45
plan step 36 wt obs cost 0.8906532528, wt smth cost 0.1054099, wt goal cost 28.6534926, collision pts: 30
plan step 37 wt obs cost 1.0774918004, wt smth cost 0.1172651, wt goal cost 30.1221777, collision pts: 19
plan step 38 wt obs cost 0.9478299036, wt smth cost 0.1294071, wt goal cost 14.3860914, collision pts: 25
plan step 39 wt obs cost 0.7792809753, wt smth cost 0.1438748, wt goal cost 14.1647116, collision pts: 36
plan step 40 wt obs cost 0.7624828753, wt smth cost 0.1639582, wt goal cost 20.8247403, collision pts: 33
plan step 41 wt obs cost 1.0259437458, wt smth cost 0.1920611, wt goal cost 39.4868846, collision pts: 36
plan step 42 wt obs cost 0.9995897173, wt smth cost 0.2169787, wt goal cost 40.0909482, collision pts: 28
plan step 43 wt obs cost 0.8089078386, wt smth cost 0.2388335, wt goal cost 15.7451794, collision pts: 21
plan step 44 wt obs cost 0.6006462308, wt smth cost 0.2612217, wt goal cost 27.5174863, collision pts: 13
plan step 45 wt obs cost 0.7111289072, wt smth cost 0.2936831, wt goal cost 9.3892759, collision pts: 17
plan step 46 wt obs cost 0.8303520531, wt smth cost 0.3275222, wt goal cost 19.8142032, collision pts: 19
plan step 47 wt obs cost 0.8503330400, wt smth cost 0.3591074, wt goal cost 21.4181228, collision pts: 18
plan step 48 wt obs cost 0.7857602751, wt smth cost 0.3883695, wt goal cost 6.2532022, collision pts: 18
plan step 49 wt obs cost 0.7197027980, wt smth cost 0.4176137, wt goal cost 4.3165013, collision pts: 17
plan step 50 wt obs cost 0.6434024724, wt smth cost 0.4455547, wt goal cost 5.7947759, collision pts: 11
plan step 51 wt obs cost 0.6275271463, wt smth cost 0.4740271, wt goal cost 7.1676078, collision pts: 9
plan step 52 wt obs cost 0.6735284005, wt smth cost 0.5038212, wt goal cost 4.0229610, collision pts: 8
plan step 53 wt obs cost 0.7479755519, wt smth cost 0.5322412, wt goal cost 3.3373391, collision pts: 13
plan step 54 wt obs cost 0.8211477664, wt smth cost 0.5584405, wt goal cost 3.3595765, collision pts: 17
plan step 55 wt obs cost 0.8470640469, wt smth cost 0.5826048, wt goal cost 3.0777687, collision pts: 17
plan step 56 wt obs cost 0.8577589063, wt smth cost 0.6045101, wt goal cost 2.5776634, collision pts: 17
plan step 57 wt obs cost 0.8544027034, wt smth cost 0.6241429, wt goal cost 2.0589574, collision pts: 17
plan step 58 wt obs cost 0.8250352419, wt smth cost 0.6415382, wt goal cost 1.7709229, collision pts: 18
plan step 59 wt obs cost 0.8101293588, wt smth cost 0.6566645, wt goal cost 1.5233025, collision pts: 18
plan step 60 wt obs cost 0.7885397160, wt smth cost 0.6696323, wt goal cost 1.3068850, collision pts: 18
plan step 61 wt obs cost 0.7425179568, wt smth cost 0.6805477, wt goal cost 1.1404496, collision pts: 18
plan step 62 wt obs cost 0.7137367845, wt smth cost 0.6895464, wt goal cost 1.0286811, collision pts: 17
plan step 63 wt obs cost 0.7010264643, wt smth cost 0.6967973, wt goal cost 1.1350832, collision pts: 15
plan step 64 wt obs cost 0.6864518799, wt smth cost 0.7025982, wt goal cost 1.2631874, collision pts: 15
plan step 65 wt obs cost 0.6811395559, wt smth cost 0.7072197, wt goal cost 1.2875299, collision pts: 15
plan step 66 wt obs cost 0.6828820492, wt smth cost 0.7106252, wt goal cost 1.1645548, collision pts: 15
plan step 67 wt obs cost 0.6971747207, wt smth cost 0.7128856, wt goal cost 0.9614159, collision pts: 15
plan step 68 wt obs cost 0.7147960019, wt smth cost 0.7139997, wt goal cost 0.7730522, collision pts: 16
plan step 69 wt obs cost 0.7555197808, wt smth cost 0.7139312, wt goal cost 0.7363866, collision pts: 16
plan step 70 wt obs cost 0.7884486618, wt smth cost 0.7127579, wt goal cost 0.7335011, collision pts: 18
plan step 71 wt obs cost 0.8158957941, wt smth cost 0.7105901, wt goal cost 0.7371515, collision pts: 19
plan step 72 wt obs cost 0.8192809246, wt smth cost 0.7075580, wt goal cost 0.7441551, collision pts: 14
plan step 73 wt obs cost 0.8231545197, wt smth cost 0.7036697, wt goal cost 0.7524665, collision pts: 15
plan step 74 wt obs cost 0.8337812478, wt smth cost 0.6990494, wt goal cost 0.7572479, collision pts: 15
plan step 75 wt obs cost 0.8320349071, wt smth cost 0.6938023, wt goal cost 0.7603427, collision pts: 15
plan step 76 wt obs cost 0.8296571408, wt smth cost 0.6880320, wt goal cost 0.7592857, collision pts: 15
plan step 77 wt obs cost 0.8112432995, wt smth cost 0.6818310, wt goal cost 0.7544590, collision pts: 14
plan step 78 wt obs cost 0.7978887483, wt smth cost 0.6752826, wt goal cost 0.7487316, collision pts: 14
plan step 79 wt obs cost 0.7835046943, wt smth cost 0.6685533, wt goal cost 0.7659690, collision pts: 14
plan step 80 wt obs cost 0.7650679037, wt smth cost 0.6616962, wt goal cost 0.7865333, collision pts: 14
plan step 81 wt obs cost 0.7531941457, wt smth cost 0.6547720, wt goal cost 0.8252903, collision pts: 13
plan step 82 wt obs cost 0.7479525347, wt smth cost 0.6478554, wt goal cost 0.8721245, collision pts: 13
plan step 83 wt obs cost 0.7354612961, wt smth cost 0.6410022, wt goal cost 0.9121047, collision pts: 12
plan step 84 wt obs cost 0.7275184051, wt smth cost 0.6342680, wt goal cost 0.9549353, collision pts: 11
plan step 85 wt obs cost 0.7314604232, wt smth cost 0.6277748, wt goal cost 0.9603708, collision pts: 11
plan step 86 wt obs cost 0.7412509165, wt smth cost 0.6215242, wt goal cost 0.9467753, collision pts: 13
plan step 87 wt obs cost 0.7532488106, wt smth cost 0.6153974, wt goal cost 0.9317915, collision pts: 13
plan step 88 wt obs cost 0.7639139225, wt smth cost 0.6093954, wt goal cost 0.9126746, collision pts: 13
plan step 89 wt obs cost 0.7771718269, wt smth cost 0.6035278, wt goal cost 0.9096026, collision pts: 14
plan step 90 wt obs cost 0.7904167120, wt smth cost 0.5977935, wt goal cost 0.9190985, collision pts: 14
plan step 91 wt obs cost 0.7955553710, wt smth cost 0.5921966, wt goal cost 3.4133489, collision pts: 14
plan step 92 wt obs cost 0.8033327770, wt smth cost 0.5871819, wt goal cost 3.2535843, collision pts: 14
plan step 93 wt obs cost 0.8185250106, wt smth cost 0.5827876, wt goal cost 2.9855626, collision pts: 15
plan step 94 wt obs cost 0.8483906706, wt smth cost 0.5788658, wt goal cost 1.3619646, collision pts: 12
plan step 95 wt obs cost 0.8635301860, wt smth cost 0.5751260, wt goal cost 1.5960239, collision pts: 12
plan step 96 wt obs cost 0.8341150656, wt smth cost 0.5716235, wt goal cost 1.5953922, collision pts: 12
plan step 97 wt obs cost 0.7996151932, wt smth cost 0.5683203, wt goal cost 1.3890134, collision pts: 11
plan step 98 wt obs cost 0.7664508878, wt smth cost 0.5652316, wt goal cost 1.1736104, collision pts: 10
plan step 99 wt obs cost 0.7367532261, wt smth cost 0.5622839, wt goal cost 1.1174903, collision pts: 10
plan step 100 wt obs cost 0.7122231859, wt smth cost 0.5595235, wt goal cost 1.1038220, collision pts: 10
plan step 101 wt obs cost 0.7031066200, wt smth cost 0.5569071, wt goal cost 3.9802015, collision pts: 10
plan step 102 wt obs cost 0.7218850860, wt smth cost 0.5552150, wt goal cost 3.6994168, collision pts: 11
plan step 103 wt obs cost 0.7607306355, wt smth cost 0.5541100, wt goal cost 3.1642122, collision pts: 13
plan step 104 wt obs cost 0.7924810661, wt smth cost 0.5531975, wt goal cost 1.0954424, collision pts: 14
plan step 105 wt obs cost 0.8348910255, wt smth cost 0.5521912, wt goal cost 1.3699141, collision pts: 15
plan step 106 wt obs cost 0.8614210660, wt smth cost 0.5511630, wt goal cost 1.5446636, collision pts: 15
plan step 107 wt obs cost 0.8624926919, wt smth cost 0.5501999, wt goal cost 1.5077463, collision pts: 15
plan step 108 wt obs cost 0.8475360969, wt smth cost 0.5492727, wt goal cost 1.3085357, collision pts: 15
plan step 109 wt obs cost 0.8147382199, wt smth cost 0.5482718, wt goal cost 1.0828193, collision pts: 14
plan step 110 wt obs cost 0.7973492852, wt smth cost 0.5471477, wt goal cost 0.9605246, collision pts: 14
plan step 111 wt obs cost 0.7712793355, wt smth cost 0.5458547, wt goal cost 0.8797895, collision pts: 12
plan step 112 wt obs cost 0.7458595786, wt smth cost 0.5443817, wt goal cost 4.0155048, collision pts: 11
plan step 113 wt obs cost 0.7104423471, wt smth cost 0.5430334, wt goal cost 0.9081776, collision pts: 10
plan step 114 wt obs cost 0.6840970525, wt smth cost 0.5416432, wt goal cost 1.0053153, collision pts: 10
plan step 115 wt obs cost 0.6826901598, wt smth cost 0.5402741, wt goal cost 1.0417581, collision pts: 10
plan step 116 wt obs cost 0.6939022846, wt smth cost 0.5389416, wt goal cost 1.0131621, collision pts: 10
plan step 117 wt obs cost 0.7201682112, wt smth cost 0.5376197, wt goal cost 0.9542781, collision pts: 10
plan step 118 wt obs cost 0.7400248552, wt smth cost 0.5361838, wt goal cost 0.9352326, collision pts: 10
plan step 119 wt obs cost 0.7558375978, wt smth cost 0.5346283, wt goal cost 0.9297101, collision pts: 12
plan step 120 wt obs cost 0.7712340642, wt smth cost 0.5329325, wt goal cost 0.9440387, collision pts: 12
plan step 121 wt obs cost 0.7781405551, wt smth cost 0.5311333, wt goal cost 3.3003533, collision pts: 12
plan step 122 wt obs cost 0.7878368405, wt smth cost 0.5296211, wt goal cost 1.0129156, collision pts: 14
plan step 123 wt obs cost 0.7963843293, wt smth cost 0.5279857, wt goal cost 1.0722091, collision pts: 14
plan step 124 wt obs cost 0.7936999758, wt smth cost 0.5263141, wt goal cost 1.1217854, collision pts: 14
plan step 125 wt obs cost 0.7860329816, wt smth cost 0.5246321, wt goal cost 1.1455537, collision pts: 14
plan step 126 wt obs cost 0.7801281829, wt smth cost 0.5229431, wt goal cost 1.1444330, collision pts: 14
plan step 127 wt obs cost 0.7683350617, wt smth cost 0.5212504, wt goal cost 2.9290646, collision pts: 12
plan step 128 wt obs cost 0.2006751032, wt smth cost 0.5358135, wt goal cost 52.2093787, collision pts: 0
plan step 129 wt obs cost 0.0302569887, wt smth cost 0.5571502, wt goal cost 79.0200975, collision pts: 0
plan step 130 wt obs cost 0.0126430412, wt smth cost 0.5825386, wt goal cost 100.1625936, collision pts: 0
plan step 131 wt obs cost 0.0024327650, wt smth cost 0.6101045, wt goal cost 117.7966926, collision pts: 0
plan step 132 wt obs cost 0.0000000000, wt smth cost 0.6384468, wt goal cost 131.0444575, collision pts: 0
plan step 133 wt obs cost 0.0000000000, wt smth cost 0.6666195, wt goal cost 139.5306407, collision pts: 0
plan step 134 wt obs cost 0.0000000000, wt smth cost 0.6940715, wt goal cost 144.0126020, collision pts: 0
plan step 135 wt obs cost 0.0000000000, wt smth cost 0.7204608, wt goal cost 144.8067290, collision pts: 0
plan step 136 wt obs cost 0.0000000000, wt smth cost 0.7456352, wt goal cost 142.5263725, collision pts: 0
plan step 137 wt obs cost 0.0022361043, wt smth cost 0.7694813, wt goal cost 137.6066317, collision pts: 0
plan step 138 wt obs cost 0.0111086332, wt smth cost 0.7920601, wt goal cost 129.9014503, collision pts: 0
plan step 139 wt obs cost 0.0187726690, wt smth cost 0.8133682, wt goal cost 120.3447753, collision pts: 0
plan step 140 wt obs cost 0.0458224453, wt smth cost 0.8334451, wt goal cost 109.3576511, collision pts: 0
plan step 141 wt obs cost 0.0768638834, wt smth cost 0.8525066, wt goal cost 97.0537220, collision pts: 0
plan step 142 wt obs cost 0.1201523842, wt smth cost 0.8707649, wt goal cost 83.2366964, collision pts: 0
plan step 143 wt obs cost 0.2129891019, wt smth cost 0.8883317, wt goal cost 68.3339265, collision pts: 8
plan step 144 wt obs cost 0.3865316872, wt smth cost 0.9055394, wt goal cost 49.7666936, collision pts: 12
plan step 145 wt obs cost 0.7281321092, wt smth cost 0.9227189, wt goal cost 11.2201719, collision pts: 11
plan step 146 wt obs cost 1.1205337397, wt smth cost 0.9380960, wt goal cost 31.6318180, collision pts: 5
plan step 147 wt obs cost 1.3183363798, wt smth cost 0.9485232, wt goal cost 41.1821174, collision pts: 1
plan step 148 wt obs cost 1.4673376027, wt smth cost 0.9573031, wt goal cost 44.8236438, collision pts: 8
plan step 149 wt obs cost 1.5308960901, wt smth cost 0.9643039, wt goal cost 46.4856398, collision pts: 11
plan step 150 wt obs cost 1.5772108371, wt smth cost 0.9698971, wt goal cost 47.2946832, collision pts: 13
plan step 151 wt obs cost 1.5741699393, wt smth cost 0.9739393, wt goal cost 48.2153557, collision pts: 12
plan step 152 wt obs cost 1.5512403103, wt smth cost 0.9762207, wt goal cost 48.3905536, collision pts: 7
plan step 153 wt obs cost 1.5283667186, wt smth cost 0.9768937, wt goal cost 47.8011230, collision pts: 6
plan step 154 wt obs cost 1.4919856605, wt smth cost 0.9761576, wt goal cost 46.4601917, collision pts: 9
plan step 155 wt obs cost 1.4188109120, wt smth cost 0.9744583, wt goal cost 45.3086126, collision pts: 7
plan step 156 wt obs cost 1.3285622415, wt smth cost 0.9720652, wt goal cost 43.6405406, collision pts: 3
plan step 157 wt obs cost 1.1791813007, wt smth cost 0.9690925, wt goal cost 41.3804098, collision pts: 0
plan step 158 wt obs cost 1.0695332642, wt smth cost 0.9651715, wt goal cost 35.8370501, collision pts: 0
plan step 159 wt obs cost 0.8272374125, wt smth cost 0.9589264, wt goal cost 20.8988733, collision pts: 6
plan step 160 wt obs cost 0.5572020183, wt smth cost 0.9508641, wt goal cost 20.0437872, collision pts: 10
plan step 161 wt obs cost 0.5044398084, wt smth cost 0.9436204, wt goal cost 33.3177016, collision pts: 16
plan step 162 wt obs cost 0.6889473471, wt smth cost 0.9397247, wt goal cost 13.4317182, collision pts: 20
plan step 163 wt obs cost 0.8697106472, wt smth cost 0.9360708, wt goal cost 18.5777587, collision pts: 20
plan step 164 wt obs cost 1.0289951156, wt smth cost 0.9303297, wt goal cost 24.6194222, collision pts: 17
plan step 165 wt obs cost 0.9849744365, wt smth cost 0.9215001, wt goal cost 22.3904723, collision pts: 16
plan step 166 wt obs cost 0.8388229803, wt smth cost 0.9099727, wt goal cost 14.6938455, collision pts: 13
plan step 167 wt obs cost 0.6795219096, wt smth cost 0.8974666, wt goal cost 9.3186653, collision pts: 11
plan step 168 wt obs cost 0.5382475183, wt smth cost 0.8850327, wt goal cost 9.4372072, collision pts: 9
plan step 169 wt obs cost 0.4550137140, wt smth cost 0.8738001, wt goal cost 13.5894913, collision pts: 9
plan step 170 wt obs cost 0.4605949046, wt smth cost 0.8643431, wt goal cost 10.0251725, collision pts: 8
plan step 171 wt obs cost 0.5467220931, wt smth cost 0.8563114, wt goal cost 5.7026752, collision pts: 6
plan step 172 wt obs cost 0.6265122591, wt smth cost 0.8486259, wt goal cost 5.2226807, collision pts: 6
plan step 173 wt obs cost 0.7178750726, wt smth cost 0.8409657, wt goal cost 5.7629318, collision pts: 6
plan step 174 wt obs cost 0.7763460621, wt smth cost 0.8332236, wt goal cost 6.2772815, collision pts: 6
plan step 175 wt obs cost 0.7748362521, wt smth cost 0.8251911, wt goal cost 6.0716437, collision pts: 6
plan step 176 wt obs cost 0.7390504323, wt smth cost 0.8169017, wt goal cost 5.0941874, collision pts: 5
plan step 177 wt obs cost 0.6839322566, wt smth cost 0.8085745, wt goal cost 3.9226211, collision pts: 5
plan step 178 wt obs cost 0.6224364482, wt smth cost 0.8004615, wt goal cost 3.0077956, collision pts: 4
plan step 179 wt obs cost 0.5630642265, wt smth cost 0.7928348, wt goal cost 2.4613072, collision pts: 4
plan step 180 wt obs cost 0.5072435344, wt smth cost 0.7857503, wt goal cost 2.3924703, collision pts: 3
plan step 181 wt obs cost 0.4447025599, wt smth cost 0.7792485, wt goal cost 2.7265955, collision pts: 3
plan step 182 wt obs cost 0.4083409973, wt smth cost 0.7734579, wt goal cost 3.1398561, collision pts: 3
plan step 183 wt obs cost 0.4040634445, wt smth cost 0.7685254, wt goal cost 3.1211441, collision pts: 4
plan step 184 wt obs cost 0.4175159744, wt smth cost 0.7643487, wt goal cost 2.6793275, collision pts: 4
plan step 185 wt obs cost 0.4568379420, wt smth cost 0.7608415, wt goal cost 2.1641419, collision pts: 5
plan step 186 wt obs cost 0.5022084687, wt smth cost 0.7577557, wt goal cost 1.8406608, collision pts: 5
plan step 187 wt obs cost 0.5330849989, wt smth cost 0.7549142, wt goal cost 1.6990538, collision pts: 5
plan step 188 wt obs cost 0.5663641971, wt smth cost 0.7522231, wt goal cost 1.7911249, collision pts: 5
plan step 189 wt obs cost 0.5768473203, wt smth cost 0.7495595, wt goal cost 1.9043889, collision pts: 6
plan step 190 wt obs cost 0.5890915699, wt smth cost 0.7468972, wt goal cost 1.9407500, collision pts: 6
plan step 191 wt obs cost 0.5872448047, wt smth cost 0.7442118, wt goal cost 1.8876736, collision pts: 6
plan step 192 wt obs cost 0.5791866487, wt smth cost 0.7415586, wt goal cost 1.8114540, collision pts: 7
plan step 193 wt obs cost 0.5624727930, wt smth cost 0.7389353, wt goal cost 1.6963463, collision pts: 7
plan step 194 wt obs cost 0.5443515451, wt smth cost 0.7363147, wt goal cost 1.5712438, collision pts: 7
plan step 195 wt obs cost 0.5206162207, wt smth cost 0.7337125, wt goal cost 1.4488693, collision pts: 7
plan step 196 wt obs cost 0.4855238091, wt smth cost 0.7311455, wt goal cost 1.4621385, collision pts: 7
plan step 197 wt obs cost 0.4382795752, wt smth cost 0.7287157, wt goal cost 1.5231054, collision pts: 7
plan step 198 wt obs cost 0.4298277763, wt smth cost 0.7264289, wt goal cost 1.5900460, collision pts: 6
plan step 199 wt obs cost 0.4269016947, wt smth cost 0.7243024, wt goal cost 1.6291046, collision pts: 5
plan step 200 wt obs cost 0.4234278074, wt smth cost 0.7223211, wt goal cost 1.6368691, collision pts: 5
plan step 201 wt obs cost 0.4216819453, wt smth cost 0.7204703, wt goal cost 1.6158446, collision pts: 5
plan step 202 wt obs cost 0.4221789765, wt smth cost 0.7187354, wt goal cost 1.5703294, collision pts: 5
plan step 203 wt obs cost 0.4270664015, wt smth cost 0.7171023, wt goal cost 1.5058029, collision pts: 5
plan step 204 wt obs cost 0.4491973231, wt smth cost 0.7155714, wt goal cost 1.4290317, collision pts: 5
plan step 205 wt obs cost 0.4520964143, wt smth cost 0.7141279, wt goal cost 1.3478013, collision pts: 5
plan step 206 wt obs cost 0.4551395966, wt smth cost 0.7127311, wt goal cost 1.2852637, collision pts: 5
plan step 207 wt obs cost 0.4623138182, wt smth cost 0.7113447, wt goal cost 1.2401824, collision pts: 4
plan step 208 wt obs cost 0.4773798934, wt smth cost 0.7099857, wt goal cost 1.2233211, collision pts: 3
plan step 209 wt obs cost 0.4896823934, wt smth cost 0.7086034, wt goal cost 1.2367947, collision pts: 3
plan step 210 wt obs cost 0.4894434924, wt smth cost 0.7071628, wt goal cost 1.2381322, collision pts: 2
plan step 211 wt obs cost 0.4841873064, wt smth cost 0.7056721, wt goal cost 1.2147297, collision pts: 2
plan step 212 wt obs cost 0.4813917415, wt smth cost 0.7041643, wt goal cost 1.1924677, collision pts: 1
plan step 213 wt obs cost 0.4779387790, wt smth cost 0.7026424, wt goal cost 1.1652642, collision pts: 1
plan step 214 wt obs cost 0.4742422808, wt smth cost 0.7011094, wt goal cost 1.1385298, collision pts: 1
plan step 215 wt obs cost 0.4681637363, wt smth cost 0.6996157, wt goal cost 1.1454356, collision pts: 0
plan step 216 wt obs cost 0.4519733348, wt smth cost 0.6981698, wt goal cost 1.1503835, collision pts: 0
plan step 217 wt obs cost 0.4374139448, wt smth cost 0.6967677, wt goal cost 1.1509545, collision pts: 0
plan step 218 wt obs cost 0.4318035505, wt smth cost 0.6954057, wt goal cost 1.1476531, collision pts: 0
plan step 219 wt obs cost 0.4293174568, wt smth cost 0.6940816, wt goal cost 1.1407723, collision pts: 0
plan step 220 wt obs cost 0.4283208394, wt smth cost 0.6927919, wt goal cost 1.1307711, collision pts: 0
plan step 221 wt obs cost 0.4285587203, wt smth cost 0.6915333, wt goal cost 1.1181201, collision pts: 0
plan step 222 wt obs cost 0.4309450381, wt smth cost 0.6903026, wt goal cost 1.1032726, collision pts: 0
plan step 223 wt obs cost 0.4361158680, wt smth cost 0.6890969, wt goal cost 1.0866559, collision pts: 0
plan step 224 wt obs cost 0.4435091851, wt smth cost 0.6879133, wt goal cost 1.0686654, collision pts: 0
plan step 225 wt obs cost 0.4459552300, wt smth cost 0.6867479, wt goal cost 1.0510900, collision pts: 0
plan step 226 wt obs cost 0.4493148746, wt smth cost 0.6855906, wt goal cost 1.0584582, collision pts: 0
plan step 227 wt obs cost 0.4493440263, wt smth cost 0.6843716, wt goal cost 1.0556205, collision pts: 0
plan step 228 wt obs cost 0.4461719152, wt smth cost 0.6830978, wt goal cost 1.0410853, collision pts: 0
plan step 229 wt obs cost 0.4427891963, wt smth cost 0.6818031, wt goal cost 1.0462543, collision pts: 0
plan step 230 wt obs cost 0.4358279616, wt smth cost 0.6805302, wt goal cost 1.0546327, collision pts: 0
plan step 231 wt obs cost 0.4310057694, wt smth cost 0.6792862, wt goal cost 1.0604435, collision pts: 0
plan step 232 wt obs cost 0.4288229063, wt smth cost 0.6780685, wt goal cost 1.0625256, collision pts: 0
plan step 233 wt obs cost 0.4280722140, wt smth cost 0.6768746, wt goal cost 1.0611847, collision pts: 0
plan step 234 wt obs cost 0.4281995513, wt smth cost 0.6757022, wt goal cost 1.0567542, collision pts: 0
plan step 235 wt obs cost 0.4290554136, wt smth cost 0.6745490, wt goal cost 1.0496362, collision pts: 0
plan step 236 wt obs cost 0.4307776732, wt smth cost 0.6734130, wt goal cost 1.0424273, collision pts: 0
plan step 237 wt obs cost 0.4327045313, wt smth cost 0.6722849, wt goal cost 1.0371869, collision pts: 0
plan step 238 wt obs cost 0.4348100792, wt smth cost 0.6711640, wt goal cost 1.0320388, collision pts: 0
plan step 239 wt obs cost 0.4370681469, wt smth cost 0.6700495, wt goal cost 1.0269847, collision pts: 0
plan step 240 wt obs cost 0.4394672211, wt smth cost 0.6689410, wt goal cost 1.0220282, collision pts: 0
plan step 241 wt obs cost 0.4419842667, wt smth cost 0.6678378, wt goal cost 1.0171742, collision pts: 0
plan step 242 wt obs cost 0.4440225911, wt smth cost 0.6667385, wt goal cost 1.0124592, collision pts: 0
plan step 243 wt obs cost 0.4444537086, wt smth cost 0.6656428, wt goal cost 1.0086794, collision pts: 0
plan step 244 wt obs cost 0.4435541065, wt smth cost 0.6645259, wt goal cost 1.0083188, collision pts: 0
plan step 245 wt obs cost 0.4407636362, wt smth cost 0.6634275, wt goal cost 1.0080345, collision pts: 0
plan step 246 wt obs cost 0.4380779238, wt smth cost 0.6623463, wt goal cost 1.0077256, collision pts: 0
plan step 247 wt obs cost 0.4357939699, wt smth cost 0.6612819, wt goal cost 1.0073550, collision pts: 0
plan step 248 wt obs cost 0.4337960696, wt smth cost 0.6602330, wt goal cost 1.0069198, collision pts: 0
plan step 249 wt obs cost 0.4320320686, wt smth cost 0.6591986, wt goal cost 1.0064204, collision pts: 0
plan step 250 wt obs cost 0.4300044107, wt smth cost 0.6581775, wt goal cost 1.0058597, collision pts: 0
plan step 251 wt obs cost 0.4255354235, wt smth cost 0.6571689, wt goal cost 1.0052430, collision pts: 0
plan step 252 wt obs cost 0.4210561111, wt smth cost 0.6561721, wt goal cost 1.0046064, collision pts: 0
plan step 253 wt obs cost 0.4155215115, wt smth cost 0.6551863, wt goal cost 1.0039400, collision pts: 0
plan step 254 wt obs cost 0.4118489188, wt smth cost 0.6542113, wt goal cost 1.0036042, collision pts: 0
plan step 255 wt obs cost 0.4101684245, wt smth cost 0.6532656, wt goal cost 1.0030611, collision pts: 0
plan step 256 wt obs cost 0.4096650080, wt smth cost 0.6523468, wt goal cost 1.0008913, collision pts: 0
plan step 257 wt obs cost 0.4100877469, wt smth cost 0.6514524, wt goal cost 0.9975951, collision pts: 0
plan step 258 wt obs cost 0.4113642118, wt smth cost 0.6505802, wt goal cost 0.9937322, collision pts: 0
plan step 259 wt obs cost 0.4126072339, wt smth cost 0.6497302, wt goal cost 0.9914783, collision pts: 0
plan step 260 wt obs cost 0.4136646197, wt smth cost 0.6489003, wt goal cost 0.9894975, collision pts: 0
plan step 261 wt obs cost 0.4144532589, wt smth cost 0.6480886, wt goal cost 0.9877638, collision pts: 0
plan step 262 wt obs cost 0.4149440922, wt smth cost 0.6472935, wt goal cost 0.9862511, collision pts: 0
plan step 263 wt obs cost 0.4151501603, wt smth cost 0.6465135, wt goal cost 0.9849336, collision pts: 0
plan step 264 wt obs cost 0.4151158487, wt smth cost 0.6457473, wt goal cost 0.9837874, collision pts: 0
plan step 265 wt obs cost 0.4149023233, wt smth cost 0.6449938, wt goal cost 0.9828126, collision pts: 0
plan step 266 wt obs cost 0.4145756458, wt smth cost 0.6442519, wt goal cost 0.9819605, collision pts: 0
plan step 267 wt obs cost 0.4142026708, wt smth cost 0.6435208, wt goal cost 0.9812079, collision pts: 0
plan step 268 wt obs cost 0.4138430984, wt smth cost 0.6427997, wt goal cost 0.9806104, collision pts: 0
plan step 269 wt obs cost 0.4136594737, wt smth cost 0.6420873, wt goal cost 0.9798589, collision pts: 0
plan step 270 wt obs cost 0.4136224026, wt smth cost 0.6413830, wt goal cost 0.9788797, collision pts: 0
plan step 271 wt obs cost 0.4125652054, wt smth cost 0.6406686, wt goal cost 0.9807365, collision pts: 0
plan step 272 wt obs cost 0.4119871730, wt smth cost 0.6399635, wt goal cost 0.9820658, collision pts: 0
plan step 273 wt obs cost 0.4115837482, wt smth cost 0.6392670, wt goal cost 0.9828855, collision pts: 0
plan step 274 wt obs cost 0.4112882227, wt smth cost 0.6385785, wt goal cost 0.9832301, collision pts: 0
plan step 275 wt obs cost 0.4110583815, wt smth cost 0.6378977, wt goal cost 0.9831352, collision pts: 0
plan step 276 wt obs cost 0.4108683483, wt smth cost 0.6372239, wt goal cost 0.9826024, collision pts: 0
plan step 277 wt obs cost 0.4107029103, wt smth cost 0.6365561, wt goal cost 0.9816922, collision pts: 0
plan step 278 wt obs cost 0.4105597132, wt smth cost 0.6358941, wt goal cost 0.9805394, collision pts: 0
plan step 279 wt obs cost 0.4102322286, wt smth cost 0.6352383, wt goal cost 0.9796423, collision pts: 0
plan step 280 wt obs cost 0.4058564477, wt smth cost 0.6345846, wt goal cost 0.9775557, collision pts: 0
plan step 281 wt obs cost 0.4026033598, wt smth cost 0.6339334, wt goal cost 0.9763917, collision pts: 0
plan step 282 wt obs cost 0.3992605675, wt smth cost 0.6332686, wt goal cost 0.9755566, collision pts: 0
plan step 283 wt obs cost 0.3944902282, wt smth cost 0.6325921, wt goal cost 0.9790469, collision pts: 0
plan step 284 wt obs cost 0.3908713340, wt smth cost 0.6319388, wt goal cost 0.9813465, collision pts: 0
plan step 285 wt obs cost 0.3892238472, wt smth cost 0.6313066, wt goal cost 0.9808330, collision pts: 0
plan step 286 wt obs cost 0.3888388781, wt smth cost 0.6306936, wt goal cost 0.9777825, collision pts: 0
plan step 287 wt obs cost 0.3894116376, wt smth cost 0.6300980, wt goal cost 0.9736801, collision pts: 0
plan step 288 wt obs cost 0.3900110280, wt smth cost 0.6295010, wt goal cost 0.9702411, collision pts: 0
plan step 289 wt obs cost 0.3887224556, wt smth cost 0.6288873, wt goal cost 0.9696744, collision pts: 0
plan step 290 wt obs cost 0.3878088810, wt smth cost 0.6282745, wt goal cost 0.9687105, collision pts: 0
plan step 291 wt obs cost 0.3871500576, wt smth cost 0.6276628, wt goal cost 0.9678041, collision pts: 0
plan step 292 wt obs cost 0.3860092662, wt smth cost 0.6270369, wt goal cost 0.9687181, collision pts: 0
plan step 293 wt obs cost 0.3856784237, wt smth cost 0.6264141, wt goal cost 0.9694357, collision pts: 0
plan step 294 wt obs cost 0.3824494647, wt smth cost 0.6257945, wt goal cost 0.9702802, collision pts: 0
plan step 295 wt obs cost 0.3774473692, wt smth cost 0.6251949, wt goal cost 0.9690595, collision pts: 0
plan step 296 wt obs cost 0.3749367728, wt smth cost 0.6246138, wt goal cost 0.9657280, collision pts: 0
plan step 297 wt obs cost 0.3742711394, wt smth cost 0.6240491, wt goal cost 0.9635212, collision pts: 0
plan step 298 wt obs cost 0.3724706203, wt smth cost 0.6234677, wt goal cost 0.9624090, collision pts: 0
plan step 299 wt obs cost 0.3705138125, wt smth cost 0.6228719, wt goal cost 0.9621568, collision pts: 0
plan step 300 wt obs cost 0.3695292097, wt smth cost 0.6222787, wt goal cost 0.9639549, collision pts: 0
plan step 301 wt obs cost 0.3693841413, wt smth cost 0.6217051, wt goal cost 0.9635066, collision pts: 0
plan step 302 wt obs cost 0.3696362270, wt smth cost 0.6211308, wt goal cost 0.9613328, collision pts: 0
plan step 303 wt obs cost 0.3702347733, wt smth cost 0.6205560, wt goal cost 0.9614807, collision pts: 0
plan step 304 wt obs cost 0.3688457368, wt smth cost 0.6199294, wt goal cost 0.9583684, collision pts: 0
plan step 305 wt obs cost 0.3682773484, wt smth cost 0.6193083, wt goal cost 0.9572589, collision pts: 0
plan step 306 wt obs cost 0.3681505210, wt smth cost 0.6186926, wt goal cost 0.9566307, collision pts: 0
plan step 307 wt obs cost 0.3675887181, wt smth cost 0.6180284, wt goal cost 0.9589891, collision pts: 0
plan step 308 wt obs cost 0.3672535756, wt smth cost 0.6173938, wt goal cost 0.9611781, collision pts: 0
plan step 309 wt obs cost 0.3671198031, wt smth cost 0.6167865, wt goal cost 0.9606712, collision pts: 0
plan step 310 wt obs cost 0.3671685364, wt smth cost 0.6162041, wt goal cost 0.9577146, collision pts: 0
plan step 311 wt obs cost 0.3673807862, wt smth cost 0.6156444, wt goal cost 0.9568797, collision pts: 0
plan step 312 wt obs cost 0.3676757927, wt smth cost 0.6150892, wt goal cost 0.9554159, collision pts: 0
plan step 313 wt obs cost 0.3680455691, wt smth cost 0.6145386, wt goal cost 0.9531941, collision pts: 0
plan step 314 wt obs cost 0.3684813682, wt smth cost 0.6139924, wt goal cost 0.9504979, collision pts: 0
plan step 315 wt obs cost 0.3664453263, wt smth cost 0.6134474, wt goal cost 0.9521414, collision pts: 0
plan step 316 wt obs cost 0.3626709820, wt smth cost 0.6128669, wt goal cost 0.9517713, collision pts: 0
plan step 317 wt obs cost 0.3587501147, wt smth cost 0.6122737, wt goal cost 0.9563266, collision pts: 0
plan step 318 wt obs cost 0.3569946888, wt smth cost 0.6117068, wt goal cost 0.9577958, collision pts: 0
plan step 319 wt obs cost 0.3563972313, wt smth cost 0.6111642, wt goal cost 0.9563874, collision pts: 0
plan step 320 wt obs cost 0.3564634789, wt smth cost 0.6106439, wt goal cost 0.9523905, collision pts: 0
plan step 321 wt obs cost 0.3571079782, wt smth cost 0.6101440, wt goal cost 0.9470711, collision pts: 0
plan step 322 wt obs cost 0.3572883332, wt smth cost 0.6096285, wt goal cost 0.9474877, collision pts: 0
plan step 323 wt obs cost 0.3560727161, wt smth cost 0.6090628, wt goal cost 0.9464972, collision pts: 0
plan step 324 wt obs cost 0.3558511232, wt smth cost 0.6084984, wt goal cost 0.9474555, collision pts: 0
plan step 325 wt obs cost 0.3558616633, wt smth cost 0.6079354, wt goal cost 0.9461941, collision pts: 0
plan step 326 wt obs cost 0.3559865537, wt smth cost 0.6073738, wt goal cost 0.9437651, collision pts: 0
plan step 327 wt obs cost 0.3561744486, wt smth cost 0.6067972, wt goal cost 0.9422136, collision pts: 0
plan step 328 wt obs cost 0.3564133799, wt smth cost 0.6062073, wt goal cost 0.9427020, collision pts: 0
plan step 329 wt obs cost 0.3565778828, wt smth cost 0.6056398, wt goal cost 0.9409761, collision pts: 0
plan step 330 wt obs cost 0.3572767279, wt smth cost 0.6050923, wt goal cost 0.9412907, collision pts: 0
plan step 331 wt obs cost 0.3572458962, wt smth cost 0.6045066, wt goal cost 0.9400519, collision pts: 0
plan step 332 wt obs cost 0.3566596292, wt smth cost 0.6038868, wt goal cost 0.9381800, collision pts: 0
plan step 333 wt obs cost 0.3564572957, wt smth cost 0.6032927, wt goal cost 0.9375547, collision pts: 0
plan step 334 wt obs cost 0.3563453071, wt smth cost 0.6027220, wt goal cost 0.9376153, collision pts: 0
plan step 335 wt obs cost 0.3563617379, wt smth cost 0.6021565, wt goal cost 0.9370747, collision pts: 0
plan step 336 wt obs cost 0.3564955394, wt smth cost 0.6015960, wt goal cost 0.9355970, collision pts: 0
plan step 337 wt obs cost 0.3559665928, wt smth cost 0.6010401, wt goal cost 0.9351155, collision pts: 0
plan step 338 wt obs cost 0.3557792932, wt smth cost 0.6005036, wt goal cost 0.9341195, collision pts: 0
plan step 339 wt obs cost 0.3567339015, wt smth cost 0.5999843, wt goal cost 0.9345695, collision pts: 0
plan step 340 wt obs cost 0.3564134608, wt smth cost 0.5994259, wt goal cost 0.9336410, collision pts: 0
plan step 341 wt obs cost 0.3549869118, wt smth cost 0.5988325, wt goal cost 0.9332256, collision pts: 0
plan step 342 wt obs cost 0.3546800191, wt smth cost 0.5982453, wt goal cost 0.9332740, collision pts: 0
plan step 343 wt obs cost 0.3553826076, wt smth cost 0.5976638, wt goal cost 0.9312100, collision pts: 0
plan step 344 wt obs cost 0.3564663983, wt smth cost 0.5970877, wt goal cost 0.9309768, collision pts: 0
plan step 345 wt obs cost 0.3564965201, wt smth cost 0.5965011, wt goal cost 0.9304194, collision pts: 0
plan step 346 wt obs cost 0.3566049365, wt smth cost 0.5959052, wt goal cost 0.9290148, collision pts: 0
plan step 347 wt obs cost 0.3557295800, wt smth cost 0.5953182, wt goal cost 0.9276588, collision pts: 0
plan step 348 wt obs cost 0.3556293836, wt smth cost 0.5947545, wt goal cost 0.9268136, collision pts: 0
plan step 349 wt obs cost 0.3566342574, wt smth cost 0.5942118, wt goal cost 0.9259568, collision pts: 0
plan step 350 wt obs cost 0.3563565045, wt smth cost 0.5936338, wt goal cost 0.9249687, collision pts: 0
plan step 351 wt obs cost 0.3549627408, wt smth cost 0.5930242, wt goal cost 0.9261905, collision pts: 0
plan step 352 wt obs cost 0.3547645340, wt smth cost 0.5924404, wt goal cost 0.9261538, collision pts: 0
plan step 353 wt obs cost 0.3556587422, wt smth cost 0.5918801, wt goal cost 0.9237642, collision pts: 0
plan step 354 wt obs cost 0.3556067297, wt smth cost 0.5913259, wt goal cost 0.9230669, collision pts: 0
plan step 355 wt obs cost 0.3547146867, wt smth cost 0.5907773, wt goal cost 0.9237471, collision pts: 0
plan step 356 wt obs cost 0.3549682114, wt smth cost 0.5902490, wt goal cost 0.9220663, collision pts: 0
plan step 357 wt obs cost 0.3561460729, wt smth cost 0.5897217, wt goal cost 0.9188102, collision pts: 0
plan step 358 wt obs cost 0.3560448184, wt smth cost 0.5891588, wt goal cost 0.9183496, collision pts: 0
plan step 359 wt obs cost 0.3550221831, wt smth cost 0.5885857, wt goal cost 0.9196116, collision pts: 0
plan step 360 wt obs cost 0.3550459020, wt smth cost 0.5880185, wt goal cost 0.9187850, collision pts: 0
plan step 361 wt obs cost 0.3559887610, wt smth cost 0.5874565, wt goal cost 0.9160748, collision pts: 0
plan step 362 wt obs cost 0.3556872402, wt smth cost 0.5868628, wt goal cost 0.9160306, collision pts: 0
plan step 363 wt obs cost 0.3563931107, wt smth cost 0.5862772, wt goal cost 0.9158927, collision pts: 0
plan step 364 wt obs cost 0.3561309008, wt smth cost 0.5857016, wt goal cost 0.9151859, collision pts: 0
plan step 365 wt obs cost 0.3550594504, wt smth cost 0.5851351, wt goal cost 0.9154153, collision pts: 0
plan step 366 wt obs cost 0.3551483073, wt smth cost 0.5845913, wt goal cost 0.9142443, collision pts: 0
plan step 367 wt obs cost 0.3562359878, wt smth cost 0.5840680, wt goal cost 0.9126165, collision pts: 0
plan step 368 wt obs cost 0.3560608588, wt smth cost 0.5835098, wt goal cost 0.9113194, collision pts: 0
plan step 369 wt obs cost 0.3547707345, wt smth cost 0.5829205, wt goal cost 0.9129371, collision pts: 0
plan step 370 wt obs cost 0.3546002952, wt smth cost 0.5823567, wt goal cost 0.9139042, collision pts: 0
plan step 371 wt obs cost 0.3566273906, wt smth cost 0.5818416, wt goal cost 0.9113645, collision pts: 0
plan step 372 wt obs cost 0.3576232918, wt smth cost 0.5813306, wt goal cost 0.9110857, collision pts: 0
plan step 373 wt obs cost 0.3553163336, wt smth cost 0.5807705, wt goal cost 0.9102128, collision pts: 0
plan step 374 wt obs cost 0.3537141649, wt smth cost 0.5802421, wt goal cost 0.9134176, collision pts: 0
plan step 375 wt obs cost 0.3542801312, wt smth cost 0.5797595, wt goal cost 0.9088610, collision pts: 0
plan step 376 wt obs cost 0.3557601158, wt smth cost 0.5792750, wt goal cost 0.9106506, collision pts: 0
plan step 377 wt obs cost 0.3559724111, wt smth cost 0.5787529, wt goal cost 0.9109316, collision pts: 0
plan step 378 wt obs cost 0.3549413287, wt smth cost 0.5781969, wt goal cost 0.9091243, collision pts: 0
plan step 379 wt obs cost 0.3530947292, wt smth cost 0.5776106, wt goal cost 0.9119800, collision pts: 0
plan step 380 wt obs cost 0.3531780270, wt smth cost 0.5770759, wt goal cost 0.9115846, collision pts: 0
plan step 381 wt obs cost 0.3550537981, wt smth cost 0.5765877, wt goal cost 0.9048801, collision pts: 0
plan step 382 wt obs cost 0.3568534258, wt smth cost 0.5760853, wt goal cost 0.9039983, collision pts: 0
plan step 383 wt obs cost 0.3572778343, wt smth cost 0.5755500, wt goal cost 0.9040799, collision pts: 0
plan step 384 wt obs cost 0.3547657294, wt smth cost 0.5749887, wt goal cost 0.9052883, collision pts: 0
plan step 385 wt obs cost 0.3545804845, wt smth cost 0.5744783, wt goal cost 0.9059141, collision pts: 0
plan step 386 wt obs cost 0.3563608906, wt smth cost 0.5740138, wt goal cost 0.9022458, collision pts: 0
plan step 387 wt obs cost 0.3559328535, wt smth cost 0.5735344, wt goal cost 0.9012390, collision pts: 0
plan step 388 wt obs cost 0.3553590770, wt smth cost 0.5730579, wt goal cost 0.9014700, collision pts: 0
plan step 389 wt obs cost 0.3546619673, wt smth cost 0.5725841, wt goal cost 0.9016662, collision pts: 0
plan step 390 wt obs cost 0.3538774260, wt smth cost 0.5721129, wt goal cost 0.9044493, collision pts: 0
plan step 391 wt obs cost 0.3549266138, wt smth cost 0.5716841, wt goal cost 0.9006186, collision pts: 0
plan step 392 wt obs cost 0.3557260280, wt smth cost 0.5712537, wt goal cost 0.8995501, collision pts: 0
plan step 393 wt obs cost 0.3561882952, wt smth cost 0.5708060, wt goal cost 0.8986330, collision pts: 0
plan step 394 wt obs cost 0.3546809685, wt smth cost 0.5703270, wt goal cost 0.8993006, collision pts: 0
plan step 395 wt obs cost 0.3533608641, wt smth cost 0.5698516, wt goal cost 0.9035424, collision pts: 0
plan step 396 wt obs cost 0.3538339193, wt smth cost 0.5694195, wt goal cost 0.9002343, collision pts: 0
plan step 397 wt obs cost 0.3561577641, wt smth cost 0.5690262, wt goal cost 0.8974989, collision pts: 0
plan step 398 wt obs cost 0.3583466184, wt smth cost 0.5686126, wt goal cost 0.8972398, collision pts: 0
plan step 399 wt obs cost 0.3582807978, wt smth cost 0.5681653, wt goal cost 0.8961316, collision pts: 0
plan step 400 wt obs cost 0.3568608552, wt smth cost 0.5676821, wt goal cost 0.8963199, collision pts: 0
plan step 401 wt obs cost 0.3554525352, wt smth cost 0.5671880, wt goal cost 0.8966811, collision pts: 0
plan step 402 wt obs cost 0.3541720839, wt smth cost 0.5666999, wt goal cost 0.8978791, collision pts: 0
plan step 403 wt obs cost 0.3530579873, wt smth cost 0.5662242, wt goal cost 0.9024156, collision pts: 0
plan step 404 wt obs cost 0.3534038240, wt smth cost 0.5657985, wt goal cost 0.8998592, collision pts: 0
plan step 405 wt obs cost 0.3553803400, wt smth cost 0.5654180, wt goal cost 0.8963431, collision pts: 0
plan step 406 wt obs cost 0.3573909153, wt smth cost 0.5650246, wt goal cost 0.8958380, collision pts: 0
plan step 407 wt obs cost 0.3575180023, wt smth cost 0.5646057, wt goal cost 0.8961189, collision pts: 0
plan step 408 wt obs cost 0.3560028233, wt smth cost 0.5641641, wt goal cost 0.8971059, collision pts: 0
plan step 409 wt obs cost 0.3547532809, wt smth cost 0.5637165, wt goal cost 0.8988390, collision pts: 0
plan step 410 wt obs cost 0.3537320608, wt smth cost 0.5632637, wt goal cost 0.9004501, collision pts: 0
plan step 411 wt obs cost 0.3541050768, wt smth cost 0.5628598, wt goal cost 0.9003752, collision pts: 0
plan step 412 wt obs cost 0.3544010207, wt smth cost 0.5624730, wt goal cost 0.9003809, collision pts: 0
plan step 413 wt obs cost 0.3545729108, wt smth cost 0.5620874, wt goal cost 0.9000443, collision pts: 0
plan step 414 wt obs cost 0.3546438946, wt smth cost 0.5617032, wt goal cost 0.8994506, collision pts: 0
plan step 415 wt obs cost 0.3546454996, wt smth cost 0.5613204, wt goal cost 0.8987356, collision pts: 0
plan step 416 wt obs cost 0.3546771208, wt smth cost 0.5609545, wt goal cost 0.8977375, collision pts: 0
plan step 417 wt obs cost 0.3541269679, wt smth cost 0.5606037, wt goal cost 0.8982701, collision pts: 0
plan step 418 wt obs cost 0.3518462723, wt smth cost 0.5602538, wt goal cost 0.8979647, collision pts: 0
plan step 419 wt obs cost 0.3489652851, wt smth cost 0.5599052, wt goal cost 0.9036930, collision pts: 0
plan step 420 wt obs cost 0.3494311145, wt smth cost 0.5596069, wt goal cost 0.9023968, collision pts: 0
plan step 421 wt obs cost 0.3529785816, wt smth cost 0.5593539, wt goal cost 0.8976771, collision pts: 0
plan step 422 wt obs cost 0.3561049982, wt smth cost 0.5591062, wt goal cost 0.8997937, collision pts: 0
plan step 423 wt obs cost 0.3568090637, wt smth cost 0.5588355, wt goal cost 0.8997398, collision pts: 0
plan step 424 wt obs cost 0.3565711125, wt smth cost 0.5585443, wt goal cost 0.8973549, collision pts: 0
plan step 425 wt obs cost 0.3559870230, wt smth cost 0.5582353, wt goal cost 0.9000690, collision pts: 0
plan step 426 wt obs cost 0.3507286088, wt smth cost 0.5579386, wt goal cost 0.9029410, collision pts: 0
plan step 427 wt obs cost 0.3463216628, wt smth cost 0.5576534, wt goal cost 0.9051766, collision pts: 0
plan step 428 wt obs cost 0.3432510329, wt smth cost 0.5573787, wt goal cost 0.9088022, collision pts: 0
plan step 429 wt obs cost 0.3451666156, wt smth cost 0.5571495, wt goal cost 0.9055135, collision pts: 0
plan step 430 wt obs cost 0.3467074783, wt smth cost 0.5569259, wt goal cost 0.9037884, collision pts: 0
plan step 431 wt obs cost 0.3473410139, wt smth cost 0.5567073, wt goal cost 0.9018711, collision pts: 0
plan step 432 wt obs cost 0.3478793675, wt smth cost 0.5564935, wt goal cost 0.8997776, collision pts: 0
plan step 433 wt obs cost 0.3482248420, wt smth cost 0.5562691, wt goal cost 0.8977136, collision pts: 0
plan step 434 wt obs cost 0.3483789280, wt smth cost 0.5560356, wt goal cost 0.8954699, collision pts: 0
plan step 435 wt obs cost 0.3483263597, wt smth cost 0.5557940, wt goal cost 0.8954628, collision pts: 0
plan step 436 wt obs cost 0.3466703661, wt smth cost 0.5555331, wt goal cost 0.8950786, collision pts: 0
plan step 437 wt obs cost 0.3438210927, wt smth cost 0.5552554, wt goal cost 0.8940821, collision pts: 0
plan step 438 wt obs cost 0.3414061382, wt smth cost 0.5549904, wt goal cost 0.8951957, collision pts: 0
plan step 439 wt obs cost 0.3393904690, wt smth cost 0.5547373, wt goal cost 0.8957123, collision pts: 0
plan step 440 wt obs cost 0.3377783572, wt smth cost 0.5544955, wt goal cost 0.8956844, collision pts: 0
plan step 441 wt obs cost 0.3310276521, wt smth cost 0.5542644, wt goal cost 0.8966931, collision pts: 0
plan step 442 wt obs cost 0.3328177354, wt smth cost 0.5540781, wt goal cost 0.8921909, collision pts: 0
plan step 443 wt obs cost 0.3301920259, wt smth cost 0.5538854, wt goal cost 0.8921624, collision pts: 0
plan step 444 wt obs cost 0.3230982014, wt smth cost 0.5536874, wt goal cost 0.8921729, collision pts: 0
plan step 445 wt obs cost 0.3182941433, wt smth cost 0.5534976, wt goal cost 0.8950651, collision pts: 0
plan step 446 wt obs cost 0.3203981060, wt smth cost 0.5533502, wt goal cost 0.8903652, collision pts: 0
plan step 447 wt obs cost 0.3227711218, wt smth cost 0.5532066, wt goal cost 0.8908776, collision pts: 0
plan step 448 wt obs cost 0.3217923285, wt smth cost 0.5530546, wt goal cost 0.8901372, collision pts: 0
plan step 449 wt obs cost 0.3188369857, wt smth cost 0.5528806, wt goal cost 0.8891053, collision pts: 0
plan step 450 wt obs cost 0.3167817750, wt smth cost 0.5526992, wt goal cost 0.8900210, collision pts: 0
plan step 451 wt obs cost 0.3150695493, wt smth cost 0.5525115, wt goal cost 0.8903092, collision pts: 0
plan step 452 wt obs cost 0.3135200170, wt smth cost 0.5523185, wt goal cost 0.8924850, collision pts: 0
plan step 453 wt obs cost 0.3155443552, wt smth cost 0.5521703, wt goal cost 0.8873428, collision pts: 0
plan step 454 wt obs cost 0.3174157092, wt smth cost 0.5520135, wt goal cost 0.8851820, collision pts: 0
plan step 455 wt obs cost 0.3153652510, wt smth cost 0.5518370, wt goal cost 0.8842976, collision pts: 0
plan step 456 wt obs cost 0.3098476213, wt smth cost 0.5516433, wt goal cost 0.8846397, collision pts: 0
plan step 457 wt obs cost 0.3061067658, wt smth cost 0.5514614, wt goal cost 0.8852397, collision pts: 0
plan step 458 wt obs cost 0.3037509384, wt smth cost 0.5512903, wt goal cost 0.8852628, collision pts: 0
plan step 459 wt obs cost 0.3025147626, wt smth cost 0.5511293, wt goal cost 0.8852757, collision pts: 0
plan step 460 wt obs cost 0.3044491565, wt smth cost 0.5510114, wt goal cost 0.8816463, collision pts: 0
plan step 461 wt obs cost 0.3065569158, wt smth cost 0.5508987, wt goal cost 0.8793813, collision pts: 0
plan step 462 wt obs cost 0.3078110108, wt smth cost 0.5507639, wt goal cost 0.8785702, collision pts: 0
plan step 463 wt obs cost 0.3102634235, wt smth cost 0.5506094, wt goal cost 0.8784458, collision pts: 0
plan step 464 wt obs cost 0.3129636699, wt smth cost 0.5504638, wt goal cost 0.8789597, collision pts: 0
plan step 465 wt obs cost 0.3156707362, wt smth cost 0.5503258, wt goal cost 0.8789693, collision pts: 0
plan step 466 wt obs cost 0.3183585384, wt smth cost 0.5501944, wt goal cost 0.8785364, collision pts: 0
plan step 467 wt obs cost 0.3210432930, wt smth cost 0.5500688, wt goal cost 0.8777196, collision pts: 0
plan step 468 wt obs cost 0.3237366419, wt smth cost 0.5499480, wt goal cost 0.8766182, collision pts: 0
plan step 469 wt obs cost 0.3262938756, wt smth cost 0.5498166, wt goal cost 0.8752776, collision pts: 0
plan step 470 wt obs cost 0.3287720467, wt smth cost 0.5496754, wt goal cost 0.8736989, collision pts: 0
plan step 471 wt obs cost 0.3277092039, wt smth cost 0.5495250, wt goal cost 0.8719851, collision pts: 0
plan step 472 wt obs cost 0.3270772556, wt smth cost 0.5493813, wt goal cost 0.8701441, collision pts: 0
plan step 473 wt obs cost 0.3276030439, wt smth cost 0.5492433, wt goal cost 0.8698779, collision pts: 0
plan step 474 wt obs cost 0.3288107686, wt smth cost 0.5490983, wt goal cost 0.8694657, collision pts: 0
plan step 475 wt obs cost 0.3329854088, wt smth cost 0.5489916, wt goal cost 0.8682300, collision pts: 0
plan step 476 wt obs cost 0.3370256435, wt smth cost 0.5488744, wt goal cost 0.8665941, collision pts: 0
plan step 477 wt obs cost 0.3410027334, wt smth cost 0.5487443, wt goal cost 0.8665756, collision pts: 0
plan step 478 wt obs cost 0.3448583438, wt smth cost 0.5486024, wt goal cost 0.8663187, collision pts: 0
plan step 479 wt obs cost 0.3486017075, wt smth cost 0.5484496, wt goal cost 0.8659540, collision pts: 0
plan step 480 wt obs cost 0.3523665382, wt smth cost 0.5483012, wt goal cost 0.8654381, collision pts: 0
plan step 481 wt obs cost 0.3561587211, wt smth cost 0.5481565, wt goal cost 0.8647837, collision pts: 0
plan step 482 wt obs cost 0.3599850801, wt smth cost 0.5480148, wt goal cost 0.8640204, collision pts: 0
plan step 483 wt obs cost 0.3638507575, wt smth cost 0.5478754, wt goal cost 0.8631752, collision pts: 0
plan step 484 wt obs cost 0.3677625266, wt smth cost 0.5477377, wt goal cost 0.8622730, collision pts: 0
plan step 485 wt obs cost 0.3717268212, wt smth cost 0.5476011, wt goal cost 0.8613367, collision pts: 0
plan step 486 wt obs cost 0.3757481571, wt smth cost 0.5474651, wt goal cost 0.8603870, collision pts: 0
plan step 487 wt obs cost 0.3798333269, wt smth cost 0.5473293, wt goal cost 0.8595176, collision pts: 0
plan step 488 wt obs cost 0.3838535330, wt smth cost 0.5471786, wt goal cost 0.8586607, collision pts: 0
plan step 489 wt obs cost 0.3878252269, wt smth cost 0.5470141, wt goal cost 0.8578161, collision pts: 0
plan step 490 wt obs cost 0.3917680217, wt smth cost 0.5468369, wt goal cost 0.8571021, collision pts: 0
plan step 491 wt obs cost 0.3958233747, wt smth cost 0.5466624, wt goal cost 0.8564590, collision pts: 0
plan step 492 wt obs cost 0.3999837825, wt smth cost 0.5464900, wt goal cost 0.8558736, collision pts: 0
plan step 493 wt obs cost 0.4042489784, wt smth cost 0.5463191, wt goal cost 0.8553560, collision pts: 0
plan step 494 wt obs cost 0.4086254479, wt smth cost 0.5461492, wt goal cost 0.8549148, collision pts: 0
plan step 495 wt obs cost 0.4131138839, wt smth cost 0.5459797, wt goal cost 0.8545577, collision pts: 0
plan step 496 wt obs cost 0.4177205477, wt smth cost 0.5458103, wt goal cost 0.8542910, collision pts: 0
plan step 497 wt obs cost 0.4224444320, wt smth cost 0.5456405, wt goal cost 0.8541199, collision pts: 0
plan step 498 wt obs cost 0.4270361622, wt smth cost 0.5454700, wt goal cost 0.8540490, collision pts: 0
plan step 499 wt obs cost 0.4316352367, wt smth cost 0.5452986, wt goal cost 0.8540815, collision pts: 0
wt obs cost 0.4363131388, wt smth cost 0.5451258, wt goal cost 0.8540815, collision pts: 0
planning time: 38.678 PLAN Length: 30
executing...
Setting up env...
env init time: 0.159
LOADING panda/panda_gripper.urdf
Processing link panda_link1
    Processing joint panda_joint1 of link panda_link1
Processing link panda_link2
    Processing joint panda_joint2 of link panda_link2
Processing link panda_link3
    Processing joint panda_joint3 of link panda_link3
Processing link panda_link4
    Processing joint panda_joint4 of link panda_link4
Processing link panda_link5
    Processing joint panda_joint5 of link panda_link5
Processing link panda_link6
    Processing joint panda_joint6 of link panda_link6
Processing link panda_link7
    Processing joint panda_joint7 of link panda_link7
Processing link panda_virtual_ee_link
    Processing joint panda_virtual_ee_joint of link panda_virtual_ee_link
Processing link panda_link1
    Processing joint panda_joint1 of link panda_link1
Processing link panda_link2
    Processing joint panda_joint2 of link panda_link2
Processing link panda_link3
    Processing joint panda_joint3 of link panda_link3
Processing link panda_link4
    Processing joint panda_joint4 of link panda_link4
Processing link panda_link5
    Processing joint panda_joint5 of link panda_link5
Processing link panda_link6
    Processing joint panda_joint6 of link panda_link6
Processing link panda_link7
    Processing joint panda_joint7 of link panda_link7
Processing link panda_link8
    Processing joint panda_joint8 of link panda_link8
Processing link panda_hand
    Processing joint panda_hand_joint of link panda_hand
Processing link panda_leftfinger
    Processing joint panda_finger_joint1 of link panda_leftfinger
Processing link panda_rightfinger
    Processing joint panda_finger_joint2 of link panda_rightfinger
Processing link panda_virtual_ee_link
    Processing joint panda_virtual_ee_joint of link panda_virtual_ee_link
thomasweng15 commented 1 year ago

Can you check if you've pulled the latest code and/or redownload the dataset? I was able to run the script with the latest commit (40d17b7d4dd512c3fcd1d3e0ce0d7bb3b2f6724d) as well as an earlier commit (782864150219bfc664cc867f8bd65c75ffeab2e4), with a previously downloaded acronym_perobj dataset and a newly downloaded one.

paucarre commented 1 year ago

Unofrtunately I still get the same error. Just in case this helps, I can't see any change in the scripts/eval/reach_and_grasp/perobj.sh script in any of these two commits. I can see changes in scripts/eval/grasp_level_set/perobj.sh but not in scripts/eval/reach_and_grasp/perobj.sh.

Unrelated to this issue, but getting ready for more contributions, I was wondering if you'd have time to look at CR5 robot PR

thomasweng15 commented 1 year ago

Hi Pau, the fix for me was just to delete the file locally and on the Google Drive, there were no code changes involved. I tested the the most recent code and an older commit just in case. I confirmed that I ran the reach_and_grasp and not the grasp_level_set script.

Yes, I'll take a look at the CR5 robot PR, thank you!

paucarre commented 1 year ago

I finally fixed it by removing the file Book_b1611143b4da5c783143cfc9128d0843_0.023835858278933857 . I guess that is removed from the Google Drive, I for some reason had it.