add the previous implementation of RelativePositionConstraint that uses homogeneous transformation