Improved the 2D unit tests. It works in 2D. However I've found that the initial guess can be important in some cases. Again the branch should be merged with master once the 3D tests on peppers have been performed.