fix(NPCVehicleCognitionStep): add isCloseEachOther check

[dmoszynski]

PR makes performance improvements after changes made in #243

It introduces an additional check of the distance of NPCs from each other to avoid unnecessary checks - and only check between those NPCs that are at the same intersection.

• Jira ticket: to Investigate the causes of negative effects from #243 performance-wise
• Fix description
• Performance tests