- modifications to send point along the normal to the mitsubishi endeffector and plan for barrett fingers seperately