alfa1=-45 xa1=3 xb1=4 z1=2 const1=1 xa2=4 z2=0.975 #= z1 - (xb1-xa1)*tan(15*pi/180) - d2 const2=1 xb3=3 z3=2 const3=1 z4=3 const4=1