Trustzone FIQ latency measurement When security extension is enabled

Hello Guys,

Please refer below attached image. as shown in this image i want to measure the different latencies in my Trustzone based application.

Here is the list of measurements which i want to perform.   

1) FIQ latency when RTOS runs and FIQ occurs ( Refer path (1) in below figure)

2) FIQ latency when GPOS( non - trust OS ) runs and FIQ occurs  ( Refer path (2) in below figure)

3) IRQ latency when GPOS ( non - trust OS ) runs ans IRQ occurs ( Refer path(3) ) in below figure )

4) Switching latency between secure and non secure state.  ( path 4-5 in image )

Measuring 3rd and 4th measurement looks possible but for 1st and 2nd measurement i am not able to figure out how to find if FIQ occurred in GPOS or RTOS execution. 

is there any way in arm ( through any register) that i can find out if FIQ occurred while GPOS was executing or it occurred while RTOS was executing,

any suggestion or pointers are very much appreciated.

Regards,

Ashwin