CODIGO PARA UNA EEPROM

YO creo que el programa obdece al modelo cinematico del Robot
Será directo, inverso o de otro modo.

La matriz de translación justamente se arma de ese modo.

Mira este documento