интерполяция кривой сплайна в переполнении стека

Есть ли у кого-нибудь предложения по созданию интерполяционной кривой сплайна. Я пытаюсь разработать игру в opengl и не могу заставить объекты следовать кривой. Функция должна идти что-то вроде …..

void interpolatePath(Vec3d startPos, Vec3d targetPos, float u, Vec3d &interpPos)

Объект начинается с позиции, пользователь щелкает, и объект перемещается в эту точку. У меня есть это сейчас, так что объект идет по прямой линии, но я хочу, чтобы он следовал кривой.

Код прямой линии в приведенной выше функции:

//interpPos.x = (u)*targetPos.x+(1-u)*startPos.x;
//interpPos.y = (u)*targetPos.y+(1-u)*startPos.y;
//interpPos.z = (u)*targetPos.z+(1-u)*startPos.z;

Будет ли работать кривая Безье? Как бы я это реализовал?

[Х, у] = (1-т) ^ 3P0 + 3 (1-т) ^ 2tP1 + 3 (1-т) т ^ 2р2 + T ^ 3P3

Спасибо