#!/bin/sh
+# urdf to dae
+rosrun xacro xacro -o $(rospack find wt_open_manipulator)/urdf/open_manipulator.urdf $(rospack find wt_open_manipulator)/urdf/open_manipulator.urdf.xacro
+rosrun collada_urdf urdf_to_collada $(rospack find wt_open_manipulator)/urdf/open_manipulator.urdf open_manipulator.dae
+
export HOME=/tmp
-python `openrave-config --python-dir`/openravepy/_openravepy_/ikfast.py --robot=open_manipulator.dae --iktype=translationzaxisangle4d --baselink=0 --eelink=5
+#python `openrave-config --python-dir`/openravepy/_openravepy_/ikfast.py --robot=open_manipulator.dae --iktype=translationzaxisangle4d --baselink=0 --eelink=5
+openrave0.9.py --database inversekinematics --robot=open_manipulator.xml --iktype=translationzaxisangle4d
# test
openrave.py --database inversekinematics --robot=open_manipulator.xml --usecached --iktests=100 --iktype=TranslationZAxisAngle4D