public void MoveRT(double r, double t) { if (!Connected) { return; } var x = r * Math.Sin(t); var y = r * Math.Cos(t); var z = (ArmIsDown ? 0.0 : 0.4) - ZShift; _arm.Move(x, y, z, _scaraMode); }