Codigo de cinematica directa para un brazo con 4GDL drive.google.com/file/d/18e3bFo6usPzYjwI9aSPJKXDiFg5KfLOC/view?usp=sharing