Fix the multivariate pstpm2 code, including initial values and handling of bounds