KM=KMchain(KM,chain)
KM : | Kinematic model {SG,'Name',HT-Matrix} | |
chain : | string 'A.A-A.B-' |
KM : | Kinematic model with adjusted Frames KM{:,3} |
load AIM_robot
KMA={SG0,'A',eye(4);SG1,'B',eye(4);SG2,'C',eye(4);SG3,'D',eye(4);SG4,'E',eye(4)}
KMchain (KMA,'A.A-A.B-B.A-B.B-C.A-C.B-D.A-D.B-E.A-E.B-',180)