s1, c1, s2, c2, r, z, l, 
r-c1+l*(-c1*c2+s1*s2)
z-s1-l*(c1*s2+c2*s1)
c1^2+s1^2-1
c2^2+s2^2-1
