Se continua el desarrollo del robot hasta la funcion Lagrange.