Added Method to get pivot element + unit tests
Implmented calculations, prev and next step should work, unit tests will follow