Fix ATLASSIM-5596

In function AFP_Geometry::getSIDTransform reading from beyond the vector range could occur. This didn't cause any problems because these readings weren't used further.

The function has been reorganized, so such unnecessary reading doesn't occur any more.

Closes ATLASSIM-5596