Problem seems to be fixed. Algorithmically, there was nothing wrong. The
error was with Iterator.
Adding support for radians conversion to the default xml file. Preparing
for full test run.