ItsRSUsSimulator_Functions.ttcn 27.5 KB
Newer Older
garciay's avatar
garciay committed
1
2
3
4
5
6
7
8
9
10
11
12
13
module ItsRSUsSimulator_Functions {
    
    // LibCommon
    import from LibCommon_BasicTypesAndValues all;
    import from LibCommon_DataStrings all;
    import from LibCommon_VerdictControl all;
    import from LibCommon_Sync all;
    import from LibCommon_Time all;
    
    // LibIts
    import from ITS_Container language "ASN.1:1997" all;
    import from CAM_PDU_Descriptions language "ASN.1:1997" all;
    import from DENM_PDU_Descriptions language "ASN.1:1997" all;
14
15
16
17
18
    import from MAPEM_PDU_Descriptions language "ASN.1:1997" all;
    import from SPATEM_PDU_Descriptions language "ASN.1:1997" all;
    import from IVIM_PDU_Descriptions language "ASN.1:1997" all;
    import from SREM_PDU_Descriptions language "ASN.1:1997" all;
    import from SSEM_PDU_Descriptions language "ASN.1:1997" all;
garciay's avatar
garciay committed
19
    import from DSRC language "ASN.1:1997" all;
garciay's avatar
garciay committed
20
21
22
23
24
25
26
27
    
    // LibItsCommon
    import from LibItsCommon_Functions all;
    
    // LibItsBtp
    import from LibItsBtp_TypesAndValues all;
    import from LibItsBtp_Templates all;
    
garciay's avatar
garciay committed
28
29
30
    // LibItsCam
    import from LibItsCam_Templates all;
    
garciay's avatar
garciay committed
31
32
33
    // LibItsDenm
    import from LibItsDenm_Templates all;
    
garciay's avatar
garciay committed
34
35
36
    // LibItsMapemSpatemm
    import from LibItsMapemSpatem_Templates all;
    
37
38
39
40
41
42
    // LibItsMapemSpatemm
    import from LibItsIvim_Templates all;
    
    // LibItsMapemSpatemm
    import from LibItsSremSsem_Templates all;
    
garciay's avatar
garciay committed
43
44
45
46
47
48
49
50
51
52
53
54
55
56
    // LibItsGeoNetworking
    import from LibItsGeoNetworking_TestSystem all;
    import from LibItsGeoNetworking_Functions all;
    import from LibItsGeoNetworking_Templates all;
    import from LibItsGeoNetworking_TypesAndValues all;
    import from LibItsGeoNetworking_Pixits all;
    
    // AtsRSUsSimulator
    import from ItsRSUsSimulator_TypesAndValues all;
    import from ItsRSUsSimulator_TestSystem all;
    import from ItsRSUsSimulator_Templates all;
    import from ItsRSUsSimulator_Pics all;
    import from ItsRSUsSimulator_Pixits all;
    
57
    group rsuConfigurationFunctions {
garciay's avatar
garciay committed
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
        
        /**
         * @desc This configuration features:
         *       - one ITS node (IUT)
         *       - two ITS nodes (nodeA, nodeB)
         *       - Area1 which only includes NodeB and IUT
         *       - Area2 which only includes NodeB
         *         NodeB being close to the area center
         */
        function f_cf01Up() runs on ItsRSUsSimulator {
            
            // Local variables
            
            // Map
            map(self:acPort, system:acPort);
73
            map(self:cfPort, system:cfPort);
garciay's avatar
garciay committed
74
75
76
77
78
79
80
81
82
            map(self:geoNetworkingPort, system:geoNetworkingPort);
            
            // Connect
            f_connect4SelfOrClientSync();
            activate(a_cf01Down());
            
            // Initialise secured mode
            f_initialiseSecuredMode();
            
83
84
            //Initialze the Config module
            cfPort.send(CfInitialize:{});
garciay's avatar
garciay committed
85
86
            
            // Initialisations
87
88
            f_setup_rsu(vc_rsu_id);
             
garciay's avatar
garciay committed
89
90
91
92
        } // End of function f_cf01Up
        
        function f_cf01Down() runs on ItsRSUsSimulator {
            
93
94
            vc_rsuMessagesValueList := {};
            
garciay's avatar
garciay committed
95
96
97
98
            f_uninitialiseSecuredMode();
            
            // Unmap
            unmap(self:acPort, system:acPort);
99
            unmap(self:cfPort, system:cfPort);
garciay's avatar
garciay committed
100
101
102
103
104
105
106
            unmap(self:geoNetworkingPort, system:geoNetworkingPort);
            
            // Disconnect
            f_disconnect4SelfOrClientSync();
            
        } // End of function f_cf01Down
        
107
108
    } // End of group rsuConfigurationFunctions
    
garciay's avatar
garciay committed
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
    function f_initialiseVehicleSimulatorComponent(
                                                   in ItsRSUsSimulator p_component,
                                                   out template (omit) CAM p_cam
    ) runs on ItsRSUsSimulator { 
        p_cam := 
            m_camMsg_vehicle(
                f_getTsStationId(),
                f_getCurrentTime() mod 65536,                        // Shall be updated in function f_prepare_vehicle_cam
                m_rsuPosition(
                    PICS_USECASE6_VEHICLE_POSITIONS[0].latitude,     // Shall be updated in function f_prepare_vehicle_cam
                    PICS_USECASE6_VEHICLE_POSITIONS[0].longitude     // Shall be updated in function f_prepare_vehicle_cam
                )
        );
        map(p_component:geoNetworkingPort, system:geoNetworkingPort);
    } // End of function f_initialiseVehicleSimulatorComponent
    
    function f_uninitialiseVehicleSimulatorComponent(
                                                     in ItsRSUsSimulator p_component
    ) runs on ItsRSUsSimulator { 
        p_component.done;
        unmap(p_component:geoNetworkingPort, system:geoNetworkingPort);
    } // End of function f_uninitialiseVehicleSimulatorComponent
    
132
133
134
135
136
137
    function f_setup_rsu(
                         in integer p_rsu_id
    ) runs on ItsRSUsSimulator { 
        
        // Local variables
        var template (value) DenmParmContainers v_denmParmContainers;
138
        var template (omit) octetstring v_beacon := omit;
139
140
141
142
143
144
145
146
147
        var template (omit) DENMs v_denms := omit;
        var template (omit) CAM v_cam := omit;
        var template (omit) MAPEM v_mapem := omit;
        var template (omit) SPATEMs v_spatems := omit;
        var template (omit) IVIM v_ivim := omit;
        var template (omit) SSEM v_ssem := omit;
        var integer v_counter;
        
        vc_longPosVectorRsu := PICS_RSU_PARAMS[p_rsu_id].longPosVector;
148
149
        // MAPEM, only if PX_ETSI_USE_CASE_ID is set to 3
        if ((vc_mapem == true) and (PX_ETSI_USE_CASE_ID == 3) and ispresent(PICS_MAPEM_PARMS_RSUs[p_rsu_id].intersections)) {
150
151
152
            // Build the list of the MAPEM events
            v_mapem := 
                m_mapemParm(
153
                    PICS_RSU_PARAMS[vc_rsu_id].stationID,
154
155
156
157
158
159
160
161
                    m_mapem(
                        f_getMsgIssueRevision(),
                        PICS_MAPEM_PARMS_RSUs[p_rsu_id].intersections,
                        PICS_MAPEM_PARMS_RSUs[p_rsu_id].roadSegments
            ));
            // Update revision fields
            v_mapem.map_.intersections[0].revision := f_incMsgIssueRevision();
            // TODO Add more?
162
163
        } else {
            vc_mapem := false;
164
        }
165
166
        // SPATEM, only if PX_ETSI_USE_CASE_ID is set to 3
        if ((vc_spatem == true) and (PX_ETSI_USE_CASE_ID == 3) and (lengthof(PICS_SPATEM_PARMS_RSUs[p_rsu_id]) != 0)) {
167
168
169
170
            // Reset counter
            vc_currentPhaseStartTime := 36001;
            vc_endPhaseStartTime := 0;
            vc_spatemStatesId := 0;
garciay's avatar
garciay committed
171
            // Build the list of the SPATEM events
172
173
174
175
176
177
178
179
180
181
182
183
184
185
            for (v_counter := 0; v_counter < lengthof(PICS_SPATEM_PARMS_RSUs[p_rsu_id]); v_counter := v_counter + 1) {
                v_spatems[v_counter] := 
                    m_spatemParm(
                        PICS_RSU_PARAMS[p_rsu_id].stationID,
                        m_spatem(
                            PICS_SPATEM_PARMS_RSUs[p_rsu_id][v_counter].intersections,
                            "SignalGroupID #" & int2str(PICS_SPATEM_PARMS_RSUs[p_rsu_id][v_counter].signalGroupID)
                ));
                for (var integer v_intersection := 0; v_intersection < lengthof(v_spatems[v_counter].spat.intersections); v_intersection := v_intersection + 1) {
                    vc_states[v_counter][v_intersection] := v_spatems[v_counter].spat.intersections[v_intersection].states;
                } // End of 'for' statement
                // TODO Build SPATEM with dynamic values
            } // End of 'for' statement
            // TODO Build SPATEM with dynamic values
186
187
        } else {
            vc_spatem := false;
188
        }
189
190
        // IVIM, only if PX_ETSI_USE_CASE_ID is set to 5
        if ((vc_ivim == true) and (PX_ETSI_USE_CASE_ID == 5) and ispresent(PICS_IVIM_PARMS_RSUs[p_rsu_id].provider)) {
garciay's avatar
garciay committed
191
            // Build the list of the IVIM events
192
193
194
195
196
197
198
199
200
            v_ivim := 
                m_ivimParm(
                    PICS_RSU_PARAMS[p_rsu_id].stationID,
                    m_ivimStructure(
                        m_iviManagementContainer(
                            PICS_IVIM_PARMS_RSUs[p_rsu_id].provider,
                            PICS_IVIM_PARMS_RSUs[p_rsu_id].iviIdentificationNumber,
                            0//IviStatus_new_
                        ),
garciay's avatar
garciay committed
201
                        PICS_IVIM_PARMS_RSUs[p_rsu_id].iviContainers
202
203
204
            ));
            // Update ivi status
            v_ivim.ivi.mandatory.validFrom := f_getCurrentTime();
205
206
        } else {
            vc_ivim := false;
207
        }
208
209
        // DENM, only if PX_ETSI_USE_CASE_ID is set to 1
        if ((vc_denm == true) and (PX_ETSI_USE_CASE_ID == 1)) {
210
211
212
213
214
215
216
217
218
219
220
            // Build the list of the DENM events for the specified RSU (PX_RSU_ID) and the given zone (PX_ETSI_ZONE_ID)
            for (v_counter := 0; v_counter < lengthof(PICS_DENM_EVENTS_RSU[p_rsu_id][PX_ETSI_ZONE_ID - 1]); v_counter := v_counter + 1) {
                var DenmEventsParmsPerZone v_denmEventsParmsPerZone := PICS_DENM_EVENTS_RSU[p_rsu_id][PX_ETSI_ZONE_ID - 1];
                
                v_denmParmContainers := m_denmParmContainers(
                    PICS_RSU_PARAMS[p_rsu_id].stationID,
                    f_incDenmSequenceNumber(),
                    PICS_DENM_REPETITION_INTERVAL,
                    v_denmEventsParmsPerZone[v_counter].eventPosition,
                    v_denmEventsParmsPerZone[v_counter].causeCodeType,
                    v_denmEventsParmsPerZone[v_counter].eventHistory,
221
222
223
224
                    v_denmEventsParmsPerZone[v_counter].traces,
                    -,
                    PICS_DENM_RELEVANCE_DISTANCE,
                    PICS_DENM_RELEVANCE_TRAFFIC_DIRECTION
225
226
                );
                v_denms[v_counter] := valueof(
227
228
                    m_denmPdu_rsu(
                        PICS_RSU_PARAMS[p_rsu_id].stationID,
229
230
231
232
233
234
235
236
237
                        m_denm(
                               v_denmParmContainers.managementContainer, 
                               v_denmParmContainers.situationContainer,
                               v_denmParmContainers.locationContainer
                )));
                if (ispresent(v_denmEventsParmsPerZone[v_counter].roadWorksContainerExtended)) {
                    v_denms[v_counter].denm.alacarte := m_alacarte(v_denmEventsParmsPerZone[v_counter].roadWorksContainerExtended);
                }
            } // End of 'for' statement
238
239
        } else {
            vc_denm := false;
240
241
        }
        // CAM
242
        if (vc_cam == true) {
243
            // Build the list of the CAM events
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
            if (PX_ETSI_USE_CASE_ID == 9) {
                v_cam := 
                    m_camParm(
                        PICS_RSU_PARAMS[p_rsu_id].stationID,
                        m_rsuPosition(
                            vc_longPosVectorRsu.latitude,
                            vc_longPosVectorRsu.longitude
                        ), 
                        PICS_RSU_PARAMS[p_rsu_id].pathHistory,
                        m_highFrequencyContainer_rsuContainerHighFrequency(
                            m_rSUContainerHighFrequency(
                                PICS_USECASE9_PCZ
                )));
            } else {
                v_cam := 
                    m_camParm(
                        PICS_RSU_PARAMS[p_rsu_id].stationID,
                        m_rsuPosition(
                            vc_longPosVectorRsu.latitude,
                            vc_longPosVectorRsu.longitude
                        ), 
                        PICS_RSU_PARAMS[p_rsu_id].pathHistory
                );
            }
268
        } 
269
        if (vc_beacon == true) {
270
271
272
            // Build the list of the BeACON events
            v_beacon := 'AAAAAAAA'O; // TODO Use a PICS
        } 
273
274
275
        // Build the messages value list for this RSU
        vc_rsuMessagesValueList[p_rsu_id] := 
            m_rsuProfile(
276
                v_beacon,
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
                v_cam, 
                v_denms,
                v_mapem,
                v_spatems,
                v_ivim,
                v_ssem
        );
        if (PICS_RSU_PARAMS[p_rsu_id].geoShape == e_geoCircle) {
            vc_geoArea := f_computeCircularArea(vc_longPosVectorRsu, PICS_RSU_PARAMS[p_rsu_id].geoParms.radius);
        } else {
            log("*** " & testcasename() & ": INCONC: Wrong PICS_RSU_GEOAREA_FORM event initialisation ***");
            setverdict(inconc);
            stop;
        }
        
    } // End of function f_setup_rsu
    
    function f_process_cf_event(
                                in CfEvent p_cfEvent
    ) runs on ItsRSUsSimulator return boolean {
        var template (value) CfResult v_result := true;
        
        // Terminate simulation
        if (p_cfEvent == "stop") {
301
302
303
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].beacon)) {
                tc_beacon.stop;
            }
304
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].cam)) {
305
306
                tc_cam.stop;
            }
307
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].denms)) {
308
309
                tc_denm.stop;
            }
310
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].mapem)) {
311
312
                tc_mapem.stop;
            }
313
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].spatems)) {
314
315
                tc_spatem.stop;
            }
316
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].ivim)) {
317
318
319
320
321
322
323
324
325
326
                tc_ivim.stop;
            }
        } else {
            v_result := false;
        }
        
        cfPort.send(v_result);
        
        return false;
    } // End of function f_process_cf_event
garciay's avatar
garciay committed
327
    
328
329
330
331
332
333
334
335
336
337
338
339
    function f_prepare_beacon(
                              out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
        p_payload := valueof(
            f_adaptPayload(
                vc_rsuMessagesValueList[vc_rsu_id].beacon,
                0,
                -,
                e_any
            )
        );
garciay's avatar
garciay committed
340
    } // End of function f_prepare_beacon
341
    
garciay's avatar
garciay committed
342
343
344
345
    function f_prepare_cam(
                           out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
346
        vc_rsuMessagesValueList[vc_rsu_id].cam.cam.generationDeltaTime := f_getCurrentTime() mod 65536; // See ETSI EN 302 637-2 V1.3.0 - Clause B.3 generationDelatTime
garciay's avatar
garciay committed
347
348
349
350
351
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
352
                            vc_rsuMessagesValueList[vc_rsu_id].cam
garciay's avatar
garciay committed
353
354
355
356
357
                ))),
                PICS_CAM_BTP_DESTINATION_PORT,
                PICS_CAM_BTP_SOURCE_PORT
            )
        );
358
    } // End of function f_prepare_cam
garciay's avatar
garciay committed
359
360
361
362
363
    
    function f_prepare_denm(
                            out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
364
        // Update dynamic parms
365
        vc_rsuMessagesValueList[vc_rsu_id].denms[vc_denmEventCounter].denm.management.referenceTime  := f_getCurrentTime();
garciay's avatar
garciay committed
366
367
368
369
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
370
                        valueof(vc_rsuMessagesValueList[vc_rsu_id].denms[vc_denmEventCounter]
garciay's avatar
garciay committed
371
372
373
374
375
                ))),
                PICS_DENM_BTP_DESTINATION_PORT,
                PICS_DENM_BTP_SOURCE_PORT
            )
        ); 
376
        vc_denmEventCounter := (vc_denmEventCounter + 1) mod lengthof(vc_rsuMessagesValueList[vc_rsu_id].denms);
377
    } // End of function f_prepare_denm
garciay's avatar
garciay committed
378
379
380
381
382
    
    function f_prepare_mapem(
                             out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
garciay's avatar
garciay committed
383
384
385
386
387
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
388
                            vc_rsuMessagesValueList[vc_rsu_id].mapem
garciay's avatar
garciay committed
389
390
391
392
393
                ))),
                PICS_MAPEM_BTP_DESTINATION_PORT,
                PICS_MAPEM_BTP_SOURCE_PORT
            )
        );
394
    } // End of function f_prepare_mapem
garciay's avatar
garciay committed
395
    
396
397
398
399
400
401
402
403
    function f_computeEndPhaseStartTime(
                               in TimeMark p_timeMark,
                               in UInt32 p_inc
    ) return TimeMark {
        var UInt32 v_endPhaseStartTime := p_timeMark + p_inc;
        return v_endPhaseStartTime mod 36000;
    }
    
garciay's avatar
garciay committed
404
    function f_prepare_spatem(
405
                              in template (value) SPATEM p_spatem,
garciay's avatar
garciay committed
406
407
                              out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
408
        var template (omit) SPATEM v_spatem := p_spatem; // Make a copy
409
        var TimeMark v_currentTimeMark := f_getCurrentTimeMark();
garciay's avatar
garciay committed
410
        
411
        if (vc_currentPhaseStartTime == 36001) {
garciay's avatar
garciay committed
412
413
            vc_currentPhaseStartTime := v_currentTimeMark;
            vc_endPhaseStartTime := f_computeEndPhaseStartTime(vc_currentPhaseStartTime, vc_repitition_duration[vc_spatemStatesId]);
414
415
416
        }
        if (v_currentTimeMark >= vc_endPhaseStartTime) {
            vc_spatemStatesId := (vc_spatemStatesId + 1) mod vc_spatemStatesNum; // Change state
garciay's avatar
garciay committed
417
418
            vc_currentPhaseStartTime := v_currentTimeMark;
            vc_endPhaseStartTime := f_computeEndPhaseStartTime(vc_currentPhaseStartTime, vc_repitition_duration[vc_spatemStatesId]);
419
420
421
422
423
        }
        log("vc_currentPhaseStartTime = ", vc_currentPhaseStartTime);
        log("vc_endPhaseStartTime = ", vc_endPhaseStartTime);
        log("v_currentTimeMark = ", v_currentTimeMark);
        log("vc_spatemStatesId = ", vc_spatemStatesId);
424
425
        // Rebuild SPATEM message
        for (var integer v_intersection := 0; v_intersection < lengthof(v_spatem.spat.intersections); v_intersection := v_intersection + 1) {
426
            var template (omit) MovementList v_states := vc_states[vc_signalGroupParmId][v_intersection];
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
            select (vc_spatemStatesId) {
                case (0) {
                    v_spatem.spat.intersections[v_intersection].states[0] := v_states[0];
                    v_spatem.spat.intersections[v_intersection].states[1] := v_states[1];
                    v_spatem.spat.intersections[v_intersection].states[2] := v_states[2];
                }
                case (1) {
                    v_spatem.spat.intersections[v_intersection].states[0] := v_states[1];
                    v_spatem.spat.intersections[v_intersection].states[1] := v_states[2];
                    v_spatem.spat.intersections[v_intersection].states[2] := v_states[0];
                }
                case (2) {
                    v_spatem.spat.intersections[v_intersection].states[0] := v_states[2];
                    v_spatem.spat.intersections[v_intersection].states[1] := v_states[0];
                    v_spatem.spat.intersections[v_intersection].states[2] := v_states[1];
                }
                case else {
                }
            } // End of 'select' statement
446
447
448
449
            // Update 'minEndTime' field
            v_spatem.spat.intersections[v_intersection].states[0].state_time_speed[0].timing.minEndTime := vc_currentPhaseStartTime;
            v_spatem.spat.intersections[v_intersection].states[1].state_time_speed[0].timing.minEndTime := vc_currentPhaseStartTime + vc_repitition_duration[(vc_spatemStatesId + 1) mod vc_spatemStatesNum];
            v_spatem.spat.intersections[v_intersection].states[2].state_time_speed[0].timing.minEndTime := vc_currentPhaseStartTime + vc_repitition_duration[(vc_spatemStatesId + 2) mod vc_spatemStatesNum];
450
451
            v_spatem.spat.intersections[v_intersection].timeStamp := f_getCurrentTime() mod 65536;
            v_spatem.spat.intersections[v_intersection].moy := f_getMinuteOfTheYear();
452
453
454
455
456
457
458
459
460
        } // End of 'for' statement
        
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
                            v_spatem
                ))),
461
462
                PICS_SPATEM_BTP_DESTINATION_PORT,
                PICS_SPATEM_BTP_SOURCE_PORT
463
464
            )
        );
garciay's avatar
garciay committed
465
        
466
    } // End of function f_prepare_spatem
garciay's avatar
garciay committed
467
468
    
    function f_prepare_ivim(
469
                            out template (value) Payload p_payload
garciay's avatar
garciay committed
470
471
    ) runs on ItsRSUsSimulator {
        
472
473
474
475
476
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
477
                            vc_rsuMessagesValueList[vc_rsu_id].ivim
478
479
480
481
482
                ))),
                PICS_IVIM_BTP_DESTINATION_PORT,
                PICS_IVIM_BTP_SOURCE_PORT
            )
        );
483
    } // End of function f_prepare_ivim
garciay's avatar
garciay committed
484
485
486
487
    
    function f_adaptPayload(
                            in template (value) octetstring p_finalPayload,
                            in template (value) BtpPortId  p_destPort,
488
489
                            in template (value) BtpPortId  p_srcPort := 0,
                            in NextHeader p_nextHeader := PX_GN_UPPER_LAYER
garciay's avatar
garciay committed
490
491
492
    ) return template (value) Payload {
        var template (value) Payload v_payload;
        
493
        if(p_nextHeader == e_any) {
garciay's avatar
garciay committed
494
495
496
497
            v_payload := { decodedPayload := omit, rawPayload := p_finalPayload};
            return v_payload;
        }
        
498
        if(p_nextHeader == e_ipv6) {
garciay's avatar
garciay committed
499
500
501
502
503
            log("*** " & testcasename() & ": INCONC: Layer IPv6 not supported ***");
            setverdict(inconc);
            stop;
        }
        
504
        if(p_nextHeader == e_btpA) {
garciay's avatar
garciay committed
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
            v_payload := { 
                decodedPayload := { 
                    btpPacket := m_btpAWithPorts(
                        p_destPort,
                        p_srcPort,
                        { 
                            decodedPayload := omit, 
                            rawPayload := p_finalPayload 
                        }
                    )
                },
                rawPayload := ''O
            };
            return v_payload;
        }
        
521
        if(p_nextHeader == e_btpB) {
garciay's avatar
garciay committed
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
            v_payload := { 
                decodedPayload := { 
                    btpPacket := m_btpBWithPorts(
                        p_destPort,
                        p_srcPort,
                        { 
                            decodedPayload := omit, 
                            rawPayload := p_finalPayload 
                        }
                    )
                }, 
                rawPayload := ''O
            };
            return v_payload;
        }
        
        return v_payload;
539
    } // End of function f_adaptPayload
garciay's avatar
garciay committed
540
    
garciay's avatar
garciay committed
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
    function f_send_vehicle_cam(
                                in template (value) CAM p_cam,
                                in integer p_idx
    ) runs on ItsRSUsSimulator {
        // Local variables
        var template (value) Payload v_payload;
        
        p_cam.cam.generationDeltaTime := f_getCurrentTime() mod 65536; // See ETSI EN 302 637-2 V1.3.0 - Clause B.3 generationDelatTime
        p_cam.cam.camParameters.basicContainer.referencePosition := PICS_USECASE6_VEHICLE_POSITIONS[p_idx];
        v_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
                            p_cam
                ))),
                PICS_CAM_BTP_DESTINATION_PORT,
                PICS_CAM_BTP_SOURCE_PORT
            )
        );
        vc_longPosVectorRsu := PICS_UC6_VEHICLE_POSITION;
        vc_longPosVectorRsu.latitude := PICS_USECASE6_VEHICLE_POSITIONS[p_idx].latitude;
        vc_longPosVectorRsu.longitude := PICS_USECASE6_VEHICLE_POSITIONS[p_idx].longitude;
        vc_geoArea := PICS_UC6_VEHICLE_GEOAREA;
        vc_geoArea.area.geoAreaPosLatitude := PICS_USECASE6_VEHICLE_POSITIONS[p_idx].latitude;
        vc_geoArea.area.geoAreaPosLongitude := PICS_USECASE6_VEHICLE_POSITIONS[p_idx].longitude;
        f_send(v_payload, PICS_CAM_ITS_AID);
    } // End of function f_send_vehicle_cam
    
garciay's avatar
garciay committed
570
    function f_send(
571
572
                    in template (value) Payload p_payload,
                    in UInt32 p_its_aid
garciay's avatar
garciay committed
573
574
575
    ) runs on ItsRSUsSimulator {
        var GeoNetworkingPdu v_geoNetworkingPdu;
        
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
        if (p_its_aid == 36) { // CAM 
            v_geoNetworkingPdu := valueof(m_geoNwPdu( // FIXME Use PIXIT parameter to get a fully configurable template
                m_geoNwTsbPacket_payload( // TODO modifes 'template (value) GnNonSecuredPacket m_geoNwBroadcastPacket' to set the field
                    f_incLocalSeqNumber(),
                    vc_longPosVectorRsu,
                    -,
                    -,
                    valueof(p_payload)
                ),
                m_defaultLifetime,
                c_defaultHopLimit
            ));
        } else {
            v_geoNetworkingPdu := valueof(m_geoNwPdu( // FIXME Use PIXIT parameter to get a fully configurable template
                m_geoNwBroadcastPacket_payload( // TODO modifes 'template (value) GnNonSecuredPacket m_geoNwBroadcastPacket' to set the field
                    vc_longPosVectorRsu,
                    f_incLocalSeqNumber(),
                    f_geoArea2GeoBroadcastArea(vc_geoArea),
                    -,
                    -,
                    valueof(p_payload)
                ),
                m_defaultLifetime,
                c_defaultHopLimit
            ));
        }
602
        f_sendGeoNetMessage(valueof(m_geoNwReq_linkLayerBroadcast(v_geoNetworkingPdu, p_its_aid)));
603
    } // End of function f_send
garciay's avatar
garciay committed
604
605
606
607
    
    function f_processSrem(
                           in GeoNetworkingPdu p_geoNetworkingPdu
    ) runs on ItsRSUsSimulator {
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
        log("SREM=", p_geoNetworkingPdu);
        if (ispresent(p_geoNetworkingPdu.gnPacket.packet.payload.decodedPayload)) {
            if (ispresent(p_geoNetworkingPdu.gnPacket.packet.payload.decodedPayload.btpPacket.payload.decodedPayload)) {
                if (ischosen(p_geoNetworkingPdu.gnPacket.packet.payload.decodedPayload.btpPacket.payload.decodedPayload.sremPacket)) {
                    var SignalRequestMessage v_signalRequestMessage := p_geoNetworkingPdu.gnPacket.packet.payload.decodedPayload.btpPacket.payload.decodedPayload.sremPacket.srm;
                    var template (value) Payload v_payload;
                    
                    log(v_signalRequestMessage);
                    // Build response
                    // TODO v_ssem.ssm.status
                    v_payload := valueof(
                        f_adaptPayload(
                            bit2oct(
                                encvalue(
                                    valueof(
garciay's avatar
garciay committed
623
624
625
                                        m_ssem(
                                            v_signalRequestMessage
                            )))),
626
627
628
629
                            PICS_SSEM_BTP_DESTINATION_PORT,
                            PICS_SSEM_BTP_SOURCE_PORT
                        )
                    );
630
631
                    // Send SSEM 
                    f_send(v_payload, PICS_SSEM_ITS_AID);
632
633
634
                } // else, ignore message
            } // else, ignore message
        } // else, ignore message
635
    } // End of function f_processSrem
garciay's avatar
garciay committed
636
637
638
639
640
641
    
    function f_incLocalSeqNumber() runs on ItsRSUsSimulator return UInt16 {
        vc_localSeqNumber := (vc_localSeqNumber + 1) mod 65536;
        return vc_localSeqNumber;
    }
    
garciay's avatar
garciay committed
642
643
644
645
646
647
648
649
650
651
652
653
654
655
    function f_incMsgIssueRevision() runs on ItsRSUsSimulator return MsgCount {
        vc_msgIssueRevision := (vc_msgIssueRevision + 1) mod 128; // See MsgCount declaration
        return vc_msgIssueRevision;
    }
    
    function f_getMsgIssueRevision() runs on ItsRSUsSimulator return MsgCount {
        return vc_msgIssueRevision;
    }
    
    function f_incDenmSequenceNumber() runs on ItsRSUsSimulator return SequenceNumber {
        vc_sequenceNumber := (vc_sequenceNumber + 1) mod 65536; // See SequenceNumber declaration
        return vc_sequenceNumber;
    }
    
garciay's avatar
garciay committed
656
    function f_getDenmSequenceNumber() runs on ItsRSUsSimulator return SequenceNumber {
garciay's avatar
garciay committed
657
        return vc_sequenceNumber;
garciay's avatar
garciay committed
658
659
660
    }
    
} // End of module ItsRSUsSimulator_Functions