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