Planning: used std::transform for coordinate transformation to increase algorithm efficiency and save space.