theta4=-1*pi/2;
r34=[cos(theta4) -1*sin(theta4) 0;0 0 -1;sin(theta4) cos(theta4) 0];
a=r34*[2;0;0]
b=r34*[0;2;0]
c=r34*[0;0;2] 
