Relative position constraint

1. Implement RelativePositionConstraint using quaternion in both MATLAB and C++
2. Change the 'name' function in PositionConstraint. Now it is cleaner. The non-abstract class does not need to worry about which row of the constraint being null.