Added function body of MStepRcpp