ItsRSUsSimulator_Functions.ttcn 26.2 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
244
245
246
247
248
249
250
251
252
253
            // Build the list of the CAM events
            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
            );
        } 
254
        if (vc_beacon == true) {
255
256
257
            // Build the list of the BeACON events
            v_beacon := 'AAAAAAAA'O; // TODO Use a PICS
        } 
258
259
260
        // Build the messages value list for this RSU
        vc_rsuMessagesValueList[p_rsu_id] := 
            m_rsuProfile(
261
                v_beacon,
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
                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") {
286
287
288
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].beacon)) {
                tc_beacon.stop;
            }
289
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].cam)) {
290
291
                tc_cam.stop;
            }
292
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].denms)) {
293
294
                tc_denm.stop;
            }
295
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].mapem)) {
296
297
                tc_mapem.stop;
            }
298
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].spatems)) {
299
300
                tc_spatem.stop;
            }
301
            if (ispresent(vc_rsuMessagesValueList[vc_rsu_id].ivim)) {
302
303
304
305
306
307
308
309
310
311
                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
312
    
313
314
315
316
317
318
319
320
321
322
323
324
    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
325
    } // End of function f_prepare_beacon
326
    
garciay's avatar
garciay committed
327
328
329
330
    function f_prepare_cam(
                           out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
331
        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
332
333
334
335
336
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
337
                            vc_rsuMessagesValueList[vc_rsu_id].cam
garciay's avatar
garciay committed
338
339
340
341
342
                ))),
                PICS_CAM_BTP_DESTINATION_PORT,
                PICS_CAM_BTP_SOURCE_PORT
            )
        );
343
    } // End of function f_prepare_cam
garciay's avatar
garciay committed
344
345
346
347
348
    
    function f_prepare_denm(
                            out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
349
        // Update dynamic parms
350
        vc_rsuMessagesValueList[vc_rsu_id].denms[vc_denmEventCounter].denm.management.referenceTime  := f_getCurrentTime();
garciay's avatar
garciay committed
351
352
353
354
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
355
                        valueof(vc_rsuMessagesValueList[vc_rsu_id].denms[vc_denmEventCounter]
garciay's avatar
garciay committed
356
357
358
359
360
                ))),
                PICS_DENM_BTP_DESTINATION_PORT,
                PICS_DENM_BTP_SOURCE_PORT
            )
        ); 
361
        vc_denmEventCounter := (vc_denmEventCounter + 1) mod lengthof(vc_rsuMessagesValueList[vc_rsu_id].denms);
362
    } // End of function f_prepare_denm
garciay's avatar
garciay committed
363
364
365
366
367
    
    function f_prepare_mapem(
                             out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
        
garciay's avatar
garciay committed
368
369
370
371
372
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
373
                            vc_rsuMessagesValueList[vc_rsu_id].mapem
garciay's avatar
garciay committed
374
375
376
377
378
                ))),
                PICS_MAPEM_BTP_DESTINATION_PORT,
                PICS_MAPEM_BTP_SOURCE_PORT
            )
        );
379
    } // End of function f_prepare_mapem
garciay's avatar
garciay committed
380
    
381
382
383
384
385
386
387
388
    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
389
    function f_prepare_spatem(
390
                              in template (value) SPATEM p_spatem,
garciay's avatar
garciay committed
391
392
                              out template (value) Payload p_payload
    ) runs on ItsRSUsSimulator {
393
        var template (omit) SPATEM v_spatem := p_spatem; // Make a copy
394
        var TimeMark v_currentTimeMark := f_getCurrentTimeMark();
garciay's avatar
garciay committed
395
        
396
        if (vc_currentPhaseStartTime == 36001) {
garciay's avatar
garciay committed
397
398
            vc_currentPhaseStartTime := v_currentTimeMark;
            vc_endPhaseStartTime := f_computeEndPhaseStartTime(vc_currentPhaseStartTime, vc_repitition_duration[vc_spatemStatesId]);
399
400
401
        }
        if (v_currentTimeMark >= vc_endPhaseStartTime) {
            vc_spatemStatesId := (vc_spatemStatesId + 1) mod vc_spatemStatesNum; // Change state
garciay's avatar
garciay committed
402
403
            vc_currentPhaseStartTime := v_currentTimeMark;
            vc_endPhaseStartTime := f_computeEndPhaseStartTime(vc_currentPhaseStartTime, vc_repitition_duration[vc_spatemStatesId]);
404
405
406
407
408
        }
        log("vc_currentPhaseStartTime = ", vc_currentPhaseStartTime);
        log("vc_endPhaseStartTime = ", vc_endPhaseStartTime);
        log("v_currentTimeMark = ", v_currentTimeMark);
        log("vc_spatemStatesId = ", vc_spatemStatesId);
409
410
        // Rebuild SPATEM message
        for (var integer v_intersection := 0; v_intersection < lengthof(v_spatem.spat.intersections); v_intersection := v_intersection + 1) {
411
            var template (omit) MovementList v_states := vc_states[vc_signalGroupParmId][v_intersection];
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
            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
431
432
433
434
            // 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];
435
436
            v_spatem.spat.intersections[v_intersection].timeStamp := f_getCurrentTime() mod 65536;
            v_spatem.spat.intersections[v_intersection].moy := f_getMinuteOfTheYear();
437
438
439
440
441
442
443
444
445
        } // End of 'for' statement
        
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
                            v_spatem
                ))),
446
447
                PICS_SPATEM_BTP_DESTINATION_PORT,
                PICS_SPATEM_BTP_SOURCE_PORT
448
449
            )
        );
garciay's avatar
garciay committed
450
        
451
    } // End of function f_prepare_spatem
garciay's avatar
garciay committed
452
453
    
    function f_prepare_ivim(
454
                            out template (value) Payload p_payload
garciay's avatar
garciay committed
455
456
    ) runs on ItsRSUsSimulator {
        
457
458
459
460
461
        p_payload := valueof(
            f_adaptPayload(
                bit2oct(
                    encvalue(
                        valueof(
462
                            vc_rsuMessagesValueList[vc_rsu_id].ivim
463
464
465
466
467
                ))),
                PICS_IVIM_BTP_DESTINATION_PORT,
                PICS_IVIM_BTP_SOURCE_PORT
            )
        );
468
    } // End of function f_prepare_ivim
garciay's avatar
garciay committed
469
470
471
472
    
    function f_adaptPayload(
                            in template (value) octetstring p_finalPayload,
                            in template (value) BtpPortId  p_destPort,
473
474
                            in template (value) BtpPortId  p_srcPort := 0,
                            in NextHeader p_nextHeader := PX_GN_UPPER_LAYER
garciay's avatar
garciay committed
475
476
477
    ) return template (value) Payload {
        var template (value) Payload v_payload;
        
478
        if(p_nextHeader == e_any) {
garciay's avatar
garciay committed
479
480
481
482
            v_payload := { decodedPayload := omit, rawPayload := p_finalPayload};
            return v_payload;
        }
        
483
        if(p_nextHeader == e_ipv6) {
garciay's avatar
garciay committed
484
485
486
487
488
            log("*** " & testcasename() & ": INCONC: Layer IPv6 not supported ***");
            setverdict(inconc);
            stop;
        }
        
489
        if(p_nextHeader == e_btpA) {
garciay's avatar
garciay committed
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
            v_payload := { 
                decodedPayload := { 
                    btpPacket := m_btpAWithPorts(
                        p_destPort,
                        p_srcPort,
                        { 
                            decodedPayload := omit, 
                            rawPayload := p_finalPayload 
                        }
                    )
                },
                rawPayload := ''O
            };
            return v_payload;
        }
        
506
        if(p_nextHeader == e_btpB) {
garciay's avatar
garciay committed
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
            v_payload := { 
                decodedPayload := { 
                    btpPacket := m_btpBWithPorts(
                        p_destPort,
                        p_srcPort,
                        { 
                            decodedPayload := omit, 
                            rawPayload := p_finalPayload 
                        }
                    )
                }, 
                rawPayload := ''O
            };
            return v_payload;
        }
        
        return v_payload;
524
    } // End of function f_adaptPayload
garciay's avatar
garciay committed
525
    
garciay's avatar
garciay committed
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
    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
555
    function f_send(
556
557
                    in template (value) Payload p_payload,
                    in UInt32 p_its_aid
garciay's avatar
garciay committed
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
    ) runs on ItsRSUsSimulator {
        var GeoNetworkingPdu v_geoNetworkingPdu;
        
        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
        ));
573
        f_sendGeoNetMessage(valueof(m_geoNwReq_linkLayerBroadcast(v_geoNetworkingPdu, p_its_aid)));
574
    } // End of function f_send
garciay's avatar
garciay committed
575
576
577
578
    
    function f_processSrem(
                           in GeoNetworkingPdu p_geoNetworkingPdu
    ) runs on ItsRSUsSimulator {
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
        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
594
595
596
                                        m_ssem(
                                            v_signalRequestMessage
                            )))),
597
598
599
600
                            PICS_SSEM_BTP_DESTINATION_PORT,
                            PICS_SSEM_BTP_SOURCE_PORT
                        )
                    );
601
602
                    // Send SSEM 
                    f_send(v_payload, PICS_SSEM_ITS_AID);
603
604
605
                } // else, ignore message
            } // else, ignore message
        } // else, ignore message
606
    } // End of function f_processSrem
garciay's avatar
garciay committed
607
608
609
610
611
612
    
    function f_incLocalSeqNumber() runs on ItsRSUsSimulator return UInt16 {
        vc_localSeqNumber := (vc_localSeqNumber + 1) mod 65536;
        return vc_localSeqNumber;
    }
    
garciay's avatar
garciay committed
613
614
615
616
617
618
619
620
621
622
623
624
625
626
    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
627
    function f_getDenmSequenceNumber() runs on ItsRSUsSimulator return SequenceNumber {
garciay's avatar
garciay committed
628
        return vc_sequenceNumber;
garciay's avatar
garciay committed
629
630
631
    }
    
} // End of module ItsRSUsSimulator_Functions