constrOptim but not working