MockEntityRepository: Return all mocked entities when calling GetEntities

The mocked entities test_vehicle_, test_pedestrian_, and test_static_object have been individual members, not managed by internal entities collection. These test instances are now added to this collection when creating an MockEntityRepository, which closes the loop between GetEntities and working with the returned instances. This allow to test and filter for individual entities when working with the mock.