Yaml parameter setup for grasp planning

This PR will eliminate the usage of [robot]_data.h, and aims to minimize code used to load and generate grasps. 

Tested robots will be REEM and Baxter.