Restoring NavigationBenchmark on GPU
This branch contains several fixes to NavStatePool, NavigationState and NavigationBenchmarker, to as well as updates to testVectorSafety and NavigationBenchmark, re-enabling the latter to run on GPUs.
The testVectorSafety was used to validate vectorized navigation, which is currently producing some mismatches w.r.t. scalar navigation, to be investigated later.