Adding a test for independent particles. The calculation of the constrained is also more numerically stable now.