r=true r2=true r3=true atan2=-1.5707963267948966 negPiDiv2=-1.5707963267948966