Сделать программу для расчета координат

Нужно сделать программу, которая будет рассчитывать координаты точек при движении в заданной траектории.

Что хочу увидеть: 

Я задаю в 3д плоскости начальное положение точек (от 1 до 50);

Далее формирую из этих точек некую фигуру или их последовательность;

Далее вращаю полученную фигуру или последовательность в разных плоскостях;

Программа при этом формирует дискредитированные по времени координаты для каждой точки ( к примеру если точка имеет скорость 1 м/с, то для ее движения нужно сформировать 10-15 координат ее движения из пункта А в пункт Б);

Программа не дает пересечься точкам на определенном друг от друга расстоянии (например 1 метр от каждой точки в каждую сторону)