STF507 Week#11: Merge GNSS support from C2C branch

ttcn/GeoNetworking/LibItsGeoNetworking_Functions.ttcn

@@ -870,6 +870,14 @@ module LibItsGeoNetworking_Functions {
             };
         }
         
+        function @deterministic f_fillTimestamp(inout LongPosVector v_vector) 
+        return LongPosVector {
+            if (v_vector.timestamp == 0) {
+                v_vector.timestamp := f_computeGnTimestamp();
+            }
+            return v_vector;
+        }
+        
         /**
          * @desc    Get the position vector corresponding to a key
          * @param   p_positionKey   Reference key of the searched position vector
@@ -885,7 +893,7 @@ module LibItsGeoNetworking_Functions {
             
             for (i:=0; i<lengthof(vc_positionTable); i:=i+1) {
                 if (vc_positionTable[i].key == p_positionKey) {
-                    v_return := vc_positionTable[i].position;
+                    v_return := f_fillTimestamp(vc_positionTable[i].position);
                 }
             }
             
@@ -1592,13 +1600,13 @@ module LibItsGeoNetworking_Functions {
                     v_hashedId8ToBeUsed := 'FFFFFFFFFFFFFFFF'O; // Reset to unknown value, the IUT will use its own certificates
                 }
                 f_utInitializeIut(m_secGnInitialize(v_hashedId8ToBeUsed));
-                return;
             } // else, default behavior
+            else {
+                f_utInitializeIut(m_gnInitialize);
+            }
             
             f_acLoadScenario(p_scenario);
             f_acStartScenario();
-            
-            f_utInitializeIut(m_gnInitialize);
         }
         
         /**