Added optional (by default disable) compilation of wholeBodyReach