better pruning of rrt
Added grasphose traj export
Coordinate fixes
Finger fixes for IK solving
Shell script for convenience