new grasp pose generator is much better. also cleaned up testing code