1. Finish implementing RailGraspWrenchConstraint in MATLAB
2. evalSparseStructure does not return number of rows or columns. These two quantities should be obtained through other functions