Implemented Newton method pose calculation. More stable but less accurate.