rozdział 3 i zoptymalizowana kinematyka odwrotna

kinmatyka odwrotna nie sprawdzona, w rozdziale 3 dopisana czesc
kinematyki prostej