Refactor/cleanup gps data loading and use box vector also for multi mode