Лабораторная работа

Добрый день! Необходимо написать код, который будет получать из файла массив точек с тремя параметрами: расстоянием до точки, и двумя углами: поворота и угла наклона дальномера для измерения расстояния этих точек. Затем для каждой точки выполнять вычисления её координат ХУZ используя заданные параметры (длину и угол наклона) и записывать результат в массив. После необходимо сортировать точки по общности координат: сначала точки с одинаковой координатой Х, потом У и потом Z. Объединить каждую группу точек линией.