Compadre, voy en 5to de ingenieria civil mecánica, y una parte de nuestras ramas de estudio es el movimiento de sistemas mecánicos, y el del ejemplo que tu planteas no es nada del otro mundo, ¿todavía necesitas ayuda? porque a mi se me ocurren un par de formas de hacerlo Nota: También programo en C++ y MatLab, nada muy complicado pero si tengo metido en la cabeza la estructura lógica que debe llevar un script o rutina como la que tu mensionas. Saludos