one robot. nonlinear iteration. all working