% GoHalfSitting.m
%%%%%%%%%%% Move to non singular pose %%%%%%%%%%%%
uLINK(RLEG_J2).q = -5.0*ToRad;
uLINK(RLEG_J3).q = 10.0*ToRad;
uLINK(RLEG_J4).q = -5.0*ToRad;

uLINK(LLEG_J2).q = -5.0*ToRad;
uLINK(LLEG_J3).q = 10.0*ToRad;
uLINK(LLEG_J4).q = -5.0*ToRad;

uLINK(BODY).p = [0.0, 0.0, 0.7]';
uLINK(BODY).R = eye(3);

s-kajita
github-repos/MATLAB/s-kajita-IntroductionToHumanoidRobotics/IntroductionToHumanoidRobotics-55c46ce6902c97897596fda581f93555c426736c/GoHalfSitting.m
IntroductionToHumanoidRobotics
github-repos/MATLAB/s-kajita-IntroductionToHumanoidRobotics
55c46ce6902c97897596fda581f93555c426736c