CLSR   TITLE   'COMPLEX SQUARE ROOT FUNCTION (LONG)'                    00700018
IHCCLSQT       CSECT                                                    01400018
*                                                                       02100018
*      COMPLEX SQUARE ROOT FUNCTION (LONG)                              02800018
*              1. THE PRINCIPLE BRANCH OF THE SQUARE ROOT IS TAKEN,     03500018
*                   I.E., THE REAL PART OF THE ANSWER IS POSITIVE.      04200018
*              2. WRITE SQRT(X+IY) = U+IV, WHERE U IS REAL, AND V IS    04900018
*                   IMAGINARY. IF X=Y=0, U=V=0.                         05600018
*              3. IF X IS NON-NEGATIVE, U = SQRT((/X/+/X+IY/)/2) AND    06300018
*                   V = Y/(2*U).                                        07000018
*              4. IF X IS NEGATIVE, U = Y/(2*V) AND                     07700018
*                   V = SIGN(Y)*SQRT((/X/+/X+IY/)/2).                   08400018
       SPACE                                                            09100018
       EXTRN   DSQRT                                                    09800018
       ENTRY   CDSQRT                                                   10500018
       SPACE                                                            11200018
GRA    EQU     1               ARGUMENT POINTER                         11900018
GRB    EQU     3               TEMPORARY BASE REGISTER                  12600018
GRS    EQU     13              SAVE AREA POINTER                        13300018
GRR    EQU     14              RETURN REGISTER                          14000018
GRL    EQU     15              LINK REGISTER                            14700018
GR0    EQU     0               SCRATCH REGISTERS                        15400018
GR1    EQU     1                                                        16100018
GR2    EQU     2                                                        16800018
FR0    EQU     0               ANSWER REGISTERS                         17500018
FR2    EQU     2                                                        18200018
FR4    EQU     4               SCRATCH REGISTERS                        18900018
FR6    EQU     6                                                        19600018
ISNSQ1 EQU     X'304'          IDENTIFIER NUMBER FOR 1ST DSQRT CALL     20300018
ISNSQ2 EQU     X'306'          IDENTIFIER NUMBER FOR 2ND DSQRT CALL     21000018
       SPACE                                                            21700018
       USING   *,GRL                                                    22400018
CDSQRT BC      15,CLSQRT                                                23100018
       DC      AL1(6)                                                   23800018
       DC      CL7'CDSQRT'                                              24500018
       SPACE                                                            25200018
CLSQRT STM     GRR,GRB,12(GRS) SAVE REGISTERS                           25900018
       LR      GRB,GRL                                                  26600018
       USING   CDSQRT,GRB      GRB TEMPORARY BASE REGISTER              27300018
       DROP    GRL                                                      28000018
       LR      GRL,GRS                                                  28700018
       LA      GRS,AREA        GRS NOW POINTS TO CURRENT SAVE AREA      29400018
       ST      GRL,4(GRS)      GRL POINTS TO PREVIOUS SAVE AREA         30100018
       ST      GRS,8(GRL)                                               30800018
       L       GR2,0(GRA)      OBTAIN ARGUMENT                          31500018
       LD      FR6,0(GR2)        REAL PART. FR6 UNCHANGED BY DSQRT CALL 32200018
       LD      FR2,8(GR2)        IMAGINARY PART                         32900018
       LPER    FR6,FR6         FORCE SIGNS POSITIVE                     33600018
       LPER    FR2,FR2                                                  34300018
       LDR     FR4,FR6         SAVE /X/ IN FR4                          35000018
       CDR     FR6,FR2         A = MAX(/X/,/Y/), B = MIN(/X/,/Y/)       35700018
       BC      10,READY        IF NECESSARY SWITCH REGISTERS SO THAT    36400018
       LDR     FR6,FR2           IN ALL CASES FR6 CONTAINS A AND FR2    37100018
       LDR     FR2,FR4             CONTAINS B                           37800018
READY  LDR     FR0,FR6         IF CHARACTERISTICS ARE DIFFERENT BY      38500018
       SWR     FR0,FR2           14 OR MORE, OR B=0, JUMP.              39200018
       CDR     FR0,FR6             THIS IS DONE TO  AVOID ANY           39900018
       L       GRL,ADSQRT                                               40600018
       BC      8,PURE                INTERMEDIATE UNDERFLOW             41300018
       DDR     FR2,FR6         D = B/A                                  42000018
       HDR     FR2,FR2         TAKE SQRT OF 0.25+D*D/4                  42700018
       MDR     FR2,FR2           THIS IS A MORE ACCURATE PROCEDURE      43400018
       AW      FR2,QUART           THAN SQRT OF 1+D*D                   44100018
       STD     FR2,BUFF                                                 44800018
       LA      GRA,ABUFF       CALL DSQRT SUBROUTINE                    45500018
       BALR    GRR,GRL         F = SQRT(0.25+D*D/4)                     46200018
       BC      0,ISNSQ1          /X+IY/ IS 2*A*F                        46900018
       LD      FR2,0(GR2)                                               47600018
       LPER    FR2,FR2         /X/                                      48300018
       CE      FR2,LLIM                                                 49000018
       BC      4,XSMALL        IF A IS VERY SMALL, AVOID PREMATURE      49700018
       HDR     FR2,FR2           UNDERFLOW BY SPECIAL HANDLING          50400018
       MDR     FR0,FR6         (/X/)/2 IN FR2, A*F IN FR0               51100018
       CE      FR0,HLIM        IF A IS NEAR OVERFLOW THRESHOLD,         51800018
       BC      10,ABIG           ALSO GIVE SPECIAL TREATMENT            52500018
JOIN1  LD      FR6,ONE                                                  53200018
JOIN2  ADR     FR0,FR2         (/X/)/2+A*F, (/X/)+2*A*F,                53900018
       STD     FR0,BUFF          OR (/X/)/4+A*F/2 NOW READY             54600018
       LA      GRA,ABUFF                                                55300018
       BALR    GRR,GRL         CALL DSQRT AGAIN                         56000018
       BC      0,ISNSQ2                                                 56700018
       LD      FR2,8(GR2)      Y                                        57400018
       LE      FR4,0(GR2)      X                                        58100018
       L       GRS,AREA+4      RESTORE GENERAL REGISTERS IN PREPARATION 58800018
       LM      GRR,GRB,12(GRS)   FOR POSSIBLE DIVISION UNDERFLOW        59500018
       USING   CDSQRT,GRL                                               60200018
       DROP    GRB                                                      60900018
       MDR     FR0,FR6         SQRT((/X/+/X+IY/)/2) READY IN FR0        61600018
       BC      8,EXIT          IF FR0 IS 0, THEN X=Y=0                  62300018
       DDR     FR2,FR0                                                  63000018
       HDR     FR2,FR2                                                  63700018
       LTER    FR4,FR4                                                  64400018
       BC      10,EXIT         IF X GRT OR = 0, ANSWER IS READY         65100018
       LDR     FR4,FR0         IF X LST 0, GIVE V SAME SIGN AS Y        65800018
       LPDR    FR0,FR2                                                  66500018
       LTER    FR2,FR2                                                  67200018
       BC      10,*+6                                                   67900018
       LNER    FR4,FR4                                                  68600018
       LDR     FR2,FR4                                                  69300018
       SPACE                                                            70000018
EXIT   MVI     12(GRS),X'FF'                                            70700018
       BCR     15,GRR          RETURN                                   71400018
       SPACE                                                            72100018
       USING   CDSQRT,GRB                                               72800018
       DROP    GRL                                                      73500018
XSMALL ADR     FR6,FR6         CASE WHEN X IS VERY SMALL, OR SMALL      74200018
       MDR     FR0,FR6           RELATIVE TO Y. /X/ IN FR2, 2*A*F IN    74900018
JOIN3  LD      FR6,R2OV2           FR0, 1/SQRT2 IN FR6                  75600018
       BC      15,JOIN2                                                 76300018
       SPACE                                                            77000018
ABIG   HDR     FR0,FR0         CASE WHEN A IS VERY NEAR OVERFLOW        77700018
       HDR     FR2,FR2           THRESHHOLD. (/X/)/4 IN FR2, A*F/2      78400018
       LD      FR6,R2OV2           IN FR0                               79100018
       ADR     FR6,FR6         SQRT2 IN FR6                             79800018
       BC      15,JOIN2                                                 80500018
       SPACE                                                            81200018
PURE   CDR     FR0,FR4         CASE WHEN B IS NEGLIGIBLE RELATIVE TO A  81900018
       BC      8,JOIN1           A=X, PURE REAL, A=(/X/+/X+IY/)/2       82600018
       BC      15,JOIN3          A=Y, PURE IMAG, A=/X/+/X+IY/           83300018
       SPACE                                                            84000018
       DS      0F                                                       84700018
ABUFF  DC      X'80'                                                    85400018
       DC      AL3(BUFF)                                                86100018
ADSQRT DC      A(DSQRT)                                                 86800018
AREA     DS    7F                                                       87500018
HLIM   DC      X'7F800000'                                              88200018
BUFF   DS      D                                                        88900018
QUART  DC      X'4040000000000001'     0.25 WITH ROUNDING FUDGE         89600018
ONE    DC      X'4110000000000000'                                      90300018
R2OV2  DC      X'40B504F333F9DE65'     1/SQRT2                          91000018
LLIM   DC      X'00200000'                                              91700018
       END                                                              92400018
