home *** CD-ROM | disk | FTP | other *** search
/ Magazyn Amiga 5 / MA_Cover_5.iso / ppc / mesa / src / matrix.s < prev    next >
Encoding:
Text File  |  1998-01-31  |  58.6 KB  |  3,379 lines
  1.  
  2. ; Storm C Compiler
  3. ; TEMP:Mesa_2_5/src/matrix.c
  4.     mc68030
  5.     mc68881
  6.     XREF    _gl_error
  7.     XREF    _gl_problem
  8.     XREF    _gl_ResizeBuffersMESA
  9.     XREF    _memcpy
  10.     XREF    _printf
  11.     XREF    _sqrt__r
  12.     XREF    _cos__r
  13.     XREF    _sin__r
  14.     XREF    _std__in
  15.     XREF    _std__out
  16.     XREF    _std__err
  17.     XREF    _CC
  18.  
  19.     SECTION "_Identity:1",DATA
  20.  
  21. _Identity
  22.     dc.l    $3F800000,0,0,0,0,$3F800000,0,0,0,0,$3F800000
  23.     dc.l    0,0,0,0,$3F800000
  24.  
  25.     SECTION "_print_matrix:0",CODE
  26.  
  27.     rts
  28.  
  29. ;static void print_matrix( const GLfloat m[16] )
  30. _print_matrix
  31.     movem.l    d2/a2,-(a7)
  32.     move.l    $C(a7),a2
  33. L93
  34. ;   for (i=0;
  35.     moveq    #0,d2
  36.     bra.b    L95
  37. L94
  38. ;      printf("%f %f %f %f\n", m[i], m[4+i], m[8+i], m[12+i] );
  39.     lea    $30(a2),a0
  40.     lea    0(a0,d2.l*4),a0
  41.     fmove.s    (a0),fp0
  42.     fmove.d    fp0,-(a7)
  43.     lea    $20(a2),a0
  44.     lea    0(a0,d2.l*4),a0
  45.     fmove.s    (a0),fp0
  46.     fmove.d    fp0,-(a7)
  47.     lea    $10(a2),a0
  48.     lea    0(a0,d2.l*4),a0
  49.     fmove.s    (a0),fp0
  50.     fmove.d    fp0,-(a7)
  51.     lea    0(a2,d2.l*4),a0
  52.     fmove.s    (a0),fp0
  53.     fmove.d    fp0,-(a7)
  54.     move.l    #L92,-(a7)
  55.     jsr    _printf
  56.     add.w    #$24,a7
  57.     addq.l    #1,d2
  58. L95
  59.     cmp.l    #4,d2
  60.     blt.b    L94
  61. L96
  62.     movem.l    (a7)+,d2/a2
  63.     rts
  64.  
  65. L92
  66.     dc.b    '%f %f %f %f',$A,0
  67.  
  68.     SECTION "_matmul:0",CODE
  69.  
  70.  
  71. ;static void matmul( GLfloat *product, const GLfloat *a, const GLfloa
  72. _matmul
  73.     movem.l    a2/a3,-(a7)
  74.     fmovem.x fp2/fp3/fp4/fp5/fp6,-(a7)
  75.     move.l    $50(a7),a0
  76.     move.l    $48(a7),a2
  77.     move.l    $4C(a7),a3
  78. L97
  79. ;   for (i = 0;
  80.     moveq    #0,d0
  81.     bra    L99
  82. L98
  83. ;      GLfloat ai0=A(i,0)
  84.     lea    0(a3,d0.l*4),a1
  85.     fmove.s    (a1),fp4
  86. ;      GLfloat ai0=A(i,0),  ai1=A(i,1)
  87.     lea    $10(a3),a1
  88.     lea    0(a1,d0.l*4),a1
  89.     fmove.s    (a1),fp3
  90. ;      GLfloat ai0=A(i,0),  a
  91.     lea    $20(a3),a1
  92.     lea    0(a1,d0.l*4),a1
  93.     fmove.s    (a1),fp2
  94. ;    GLfloat ai0=A
  95.     lea    $30(a3),a1
  96.     lea    0(a1,d0.l*4),a1
  97.     fmove.s    (a1),fp1
  98. ;      P(i,0) = ai0 * B(0,0) + ai1 * B(1,0) + ai2 * B(2,0)
  99.     fmove.s    (a0),fp0
  100.     fmul.x    fp4,fp0
  101.     lea    4(a0),a1
  102.     fmove.s    (a1),fp5
  103.     fmul.x    fp3,fp5
  104.     fadd.x    fp5,fp0
  105.     lea    $8(a0),a1
  106.     fmove.s    (a1),fp5
  107.     fmul.x    fp2,fp5
  108.     fadd.x    fp5,fp0
  109.     lea    $C(a0),a1
  110.     fmove.s    (a1),fp5
  111.     fmul.x    fp1,fp5
  112.     fadd.x    fp5,fp0
  113.     lea    0(a2,d0.l*4),a1
  114.     fmove.s    fp0,(a1)
  115. ;      P(i,1) = ai0 * B(0,1) + ai1 * B(1,1) + ai2 * B(2,1)
  116.     lea    $10(a0),a1
  117.     fmove.s    (a1),fp0
  118.     fmul.x    fp4,fp0
  119.     lea    $14(a0),a1
  120.     fmove.s    (a1),fp5
  121.     fmul.x    fp3,fp5
  122.     fadd.x    fp5,fp0
  123.     lea    $18(a0),a1
  124.     fmove.s    (a1),fp5
  125.     fmul.x    fp2,fp5
  126.     fadd.x    fp5,fp0
  127.     lea    $1C(a0),a1
  128.     fmove.s    (a1),fp5
  129.     fmul.x    fp1,fp5
  130.     fadd.x    fp5,fp0
  131.     lea    $10(a2),a1
  132.     lea    0(a1,d0.l*4),a1
  133.     fmove.s    fp0,(a1)
  134. ;      P(i,2) = ai0 * B(0,2) + ai1 * B(1,2) + ai2 * B(2,2)
  135.     lea    $20(a0),a1
  136.     fmove.s    (a1),fp0
  137.     fmul.x    fp4,fp0
  138.     lea    $24(a0),a1
  139.     fmove.s    (a1),fp5
  140.     fmul.x    fp3,fp5
  141.     fadd.x    fp5,fp0
  142.     lea    $28(a0),a1
  143.     fmove.s    (a1),fp5
  144.     fmul.x    fp2,fp5
  145.     fadd.x    fp5,fp0
  146.     lea    $2C(a0),a1
  147.     fmove.s    (a1),fp5
  148.     fmul.x    fp1,fp5
  149.     fadd.x    fp5,fp0
  150.     lea    $20(a2),a1
  151.     lea    0(a1,d0.l*4),a1
  152.     fmove.s    fp0,(a1)
  153. ;      P(i,3) = ai0 * B(0,3) + ai1 * B(1,3) + ai2 * B(2,3)
  154.     lea    $30(a0),a1
  155.     fmove.s    (a1),fp0
  156.     fmul.x    fp4,fp0
  157.     lea    $34(a0),a1
  158.     fmove.s    (a1),fp4
  159.     fmul.x    fp3,fp4
  160.     fadd.x    fp4,fp0
  161.     lea    $38(a0),a1
  162.     fmove.s    (a1),fp3
  163.     fmul.x    fp2,fp3
  164.     fadd.x    fp3,fp0
  165.     lea    $3C(a0),a1
  166.     fmove.s    (a1),fp2
  167.     fmul.x    fp1,fp2
  168.     fadd.x    fp2,fp0
  169.     lea    $30(a2),a1
  170.     lea    0(a1,d0.l*4),a1
  171.     fmove.s    fp0,(a1)
  172.     addq.l    #1,d0
  173. L99
  174.     cmp.l    #4,d0
  175.     blt    L98
  176. L100
  177.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  178.     movem.l    (a7)+,a2/a3
  179.     rts
  180.  
  181.     SECTION "_invert_matrix_general:0",CODE
  182.  
  183.  
  184. ;static void invert_matrix_general( const GLfloat *m, GLfloat *out )
  185. _invert_matrix_general
  186. L102    EQU    -$7C
  187.     link    a5,#L102
  188.     move.l    a2,-(a7)
  189.     fmovem.x fp2,-(a7)
  190.     movem.l    $8(a5),a0/a1
  191. L101
  192. ;   const GLfloat * A = m;
  193. ;   GLfloat *       C = out;
  194. ;   one_over_det = 1.0f / ( ( A[M00] * A[M11] ) - ( A[M10] * A[M01
  195.     fmove.s    (a0),fp0
  196.     lea    $14(a0),a2
  197.     fmove.s    (a2),fp1
  198.     fmul.x    fp1,fp0
  199.     lea    4(a0),a2
  200.     fmove.s    (a2),fp1
  201.     lea    $10(a0),a2
  202.     fmove.s    (a2),fp2
  203.     fmul.x    fp2,fp1
  204.     fsub.x    fp1,fp0
  205.     fmove.s    #$.3F800000,fp1
  206.     fdiv.x    fp0,fp1
  207.     fmove.x    fp1,fp0
  208. ;   r1[0][0] = one_over_det * A[M11];
  209.     lea    $14(a0),a2
  210.     fmove.s    (a2),fp1
  211.     fmul.x    fp0,fp1
  212.     lea    -$10(a5),a2
  213.     fmove.s    fp1,(a2)
  214. ;   r1[0][1] = one_over_det * -A[M01];
  215.     lea    $10(a0),a2
  216.     fmove.s    (a2),fp1
  217.     fneg.s    fp1
  218.     fmul.x    fp0,fp1
  219.     lea    -$10(a5),a2
  220.     addq.w    #4,a2
  221.     fmove.s    fp1,(a2)
  222. ;   r1[1][0] = one_over_det * -A[M10];
  223.     lea    4(a0),a2
  224.     fmove.s    (a2),fp1
  225.     fneg.s    fp1
  226.     fmul.x    fp0,fp1
  227.     lea    -$10(a5),a2
  228.     addq.w    #$8,a2
  229.     fmove.s    fp1,(a2)
  230. ;   r1[1][1] = one_over_det * A[M00];
  231.     fmove.s    (a0),fp1
  232.     fmul.x    fp0,fp1
  233.     lea    -$10(a5),a2
  234.     addq.w    #$8,a2
  235.     addq.w    #4,a2
  236.     fmove.s    fp1,(a2)
  237. ;   r2[0][0] = A[M20] * r1[0][0] + A[M21] * r1[1][0];
  238.     lea    $8(a0),a2
  239.     fmove.s    (a2),fp0
  240.     lea    -$10(a5),a2
  241.     fmove.s    (a2),fp1
  242.     fmul.x    fp1,fp0
  243.     lea    $18(a0),a2
  244.     fmove.s    (a2),fp1
  245.     lea    -$10(a5),a2
  246.     addq.w    #$8,a2
  247.     fmove.s    (a2),fp2
  248.     fmul.x    fp2,fp1
  249.     fadd.x    fp1,fp0
  250.     lea    -$20(a5),a2
  251.     fmove.s    fp0,(a2)
  252. ;   r2[0][1] = A[M20] * r1[0][1] + A[M21] * r1[1][1];
  253.     lea    $8(a0),a2
  254.     fmove.s    (a2),fp0
  255.     lea    -$10(a5),a2
  256.     addq.w    #4,a2
  257.     fmove.s    (a2),fp1
  258.     fmul.x    fp1,fp0
  259.     lea    $18(a0),a2
  260.     fmove.s    (a2),fp1
  261.     lea    -$10(a5),a2
  262.     addq.w    #$8,a2
  263.     addq.w    #4,a2
  264.     fmove.s    (a2),fp2
  265.     fmul.x    fp2,fp1
  266.     fadd.x    fp1,fp0
  267.     lea    -$20(a5),a2
  268.     addq.w    #4,a2
  269.     fmove.s    fp0,(a2)
  270. ;   r2[1][0] = A[M30] * r1[0][0] + A[M31] * r1[1][0];
  271.     lea    $C(a0),a2
  272.     fmove.s    (a2),fp0
  273.     lea    -$10(a5),a2
  274.     fmove.s    (a2),fp1
  275.     fmul.x    fp1,fp0
  276.     lea    $1C(a0),a2
  277.     fmove.s    (a2),fp1
  278.     lea    -$10(a5),a2
  279.     addq.w    #$8,a2
  280.     fmove.s    (a2),fp2
  281.     fmul.x    fp2,fp1
  282.     fadd.x    fp1,fp0
  283.     lea    -$20(a5),a2
  284.     addq.w    #$8,a2
  285.     fmove.s    fp0,(a2)
  286. ;   r2[1][1] = A[M30] * r1[0][1] + A[M31] * r1[1][1];
  287.     lea    $C(a0),a2
  288.     fmove.s    (a2),fp0
  289.     lea    -$10(a5),a2
  290.     addq.w    #4,a2
  291.     fmove.s    (a2),fp1
  292.     fmul.x    fp1,fp0
  293.     lea    $1C(a0),a2
  294.     fmove.s    (a2),fp1
  295.     lea    -$10(a5),a2
  296.     addq.w    #$8,a2
  297.     addq.w    #4,a2
  298.     fmove.s    (a2),fp2
  299.     fmul.x    fp2,fp1
  300.     fadd.x    fp1,fp0
  301.     lea    -$20(a5),a2
  302.     addq.w    #$8,a2
  303.     addq.w    #4,a2
  304.     fmove.s    fp0,(a2)
  305. ;   r3[0][0] = r1[0][0] * A[M02] + r1[0][1] * A[M12];
  306.     lea    -$10(a5),a2
  307.     fmove.s    (a2),fp0
  308.     lea    $20(a0),a2
  309.     fmove.s    (a2),fp1
  310.     fmul.x    fp1,fp0
  311.     lea    -$10(a5),a2
  312.     addq.w    #4,a2
  313.     fmove.s    (a2),fp1
  314.     lea    $24(a0),a2
  315.     fmove.s    (a2),fp2
  316.     fmul.x    fp2,fp1
  317.     fadd.x    fp1,fp0
  318.     lea    -$30(a5),a2
  319.     fmove.s    fp0,(a2)
  320. ;   r3[0][1] = r1[0][0] * A[M03] + r1[0][1] * A[M13];
  321.     lea    -$10(a5),a2
  322.     fmove.s    (a2),fp0
  323.     lea    $30(a0),a2
  324.     fmove.s    (a2),fp1
  325.     fmul.x    fp1,fp0
  326.     lea    -$10(a5),a2
  327.     addq.w    #4,a2
  328.     fmove.s    (a2),fp1
  329.     lea    $34(a0),a2
  330.     fmove.s    (a2),fp2
  331.     fmul.x    fp2,fp1
  332.     fadd.x    fp1,fp0
  333.     lea    -$30(a5),a2
  334.     addq.w    #4,a2
  335.     fmove.s    fp0,(a2)
  336. ;   r3[1][0] = r1[1][0] * A[M02] + r1[1][1] * A[M12];
  337.     lea    -$10(a5),a2
  338.     addq.w    #$8,a2
  339.     fmove.s    (a2),fp0
  340.     lea    $20(a0),a2
  341.     fmove.s    (a2),fp1
  342.     fmul.x    fp1,fp0
  343.     lea    -$10(a5),a2
  344.     addq.w    #$8,a2
  345.     addq.w    #4,a2
  346.     fmove.s    (a2),fp1
  347.     lea    $24(a0),a2
  348.     fmove.s    (a2),fp2
  349.     fmul.x    fp2,fp1
  350.     fadd.x    fp1,fp0
  351.     lea    -$30(a5),a2
  352.     addq.w    #$8,a2
  353.     fmove.s    fp0,(a2)
  354. ;   r3[1][1] = r1[1][0] * A[M03] + r1[1][1] * A[M13];
  355.     lea    -$10(a5),a2
  356.     addq.w    #$8,a2
  357.     fmove.s    (a2),fp0
  358.     lea    $30(a0),a2
  359.     fmove.s    (a2),fp1
  360.     fmul.x    fp1,fp0
  361.     lea    -$10(a5),a2
  362.     addq.w    #$8,a2
  363.     addq.w    #4,a2
  364.     fmove.s    (a2),fp1
  365.     lea    $34(a0),a2
  366.     fmove.s    (a2),fp2
  367.     fmul.x    fp2,fp1
  368.     fadd.x    fp1,fp0
  369.     lea    -$30(a5),a2
  370.     addq.w    #$8,a2
  371.     addq.w    #4,a2
  372.     fmove.s    fp0,(a2)
  373. ;   r4[0][0] = A[M20] * r3[0][0] + A[M21] * r3[1][0];
  374.     lea    $8(a0),a2
  375.     fmove.s    (a2),fp0
  376.     lea    -$30(a5),a2
  377.     fmove.s    (a2),fp1
  378.     fmul.x    fp1,fp0
  379.     lea    $18(a0),a2
  380.     fmove.s    (a2),fp1
  381.     lea    -$30(a5),a2
  382.     addq.w    #$8,a2
  383.     fmove.s    (a2),fp2
  384.     fmul.x    fp2,fp1
  385.     fadd.x    fp1,fp0
  386.     lea    -$40(a5),a2
  387.     fmove.s    fp0,(a2)
  388. ;   r4[0][1] = A[M20] * r3[0][1] + A[M21] * r3[1][1];
  389.     lea    $8(a0),a2
  390.     fmove.s    (a2),fp0
  391.     lea    -$30(a5),a2
  392.     addq.w    #4,a2
  393.     fmove.s    (a2),fp1
  394.     fmul.x    fp1,fp0
  395.     lea    $18(a0),a2
  396.     fmove.s    (a2),fp1
  397.     lea    -$30(a5),a2
  398.     addq.w    #$8,a2
  399.     addq.w    #4,a2
  400.     fmove.s    (a2),fp2
  401.     fmul.x    fp2,fp1
  402.     fadd.x    fp1,fp0
  403.     lea    -$40(a5),a2
  404.     addq.w    #4,a2
  405.     fmove.s    fp0,(a2)
  406. ;   r4[1][0] = A[M30] * r3[0][0] + A[M31] * r3[1][0];
  407.     lea    $C(a0),a2
  408.     fmove.s    (a2),fp0
  409.     lea    -$30(a5),a2
  410.     fmove.s    (a2),fp1
  411.     fmul.x    fp1,fp0
  412.     lea    $1C(a0),a2
  413.     fmove.s    (a2),fp1
  414.     lea    -$30(a5),a2
  415.     addq.w    #$8,a2
  416.     fmove.s    (a2),fp2
  417.     fmul.x    fp2,fp1
  418.     fadd.x    fp1,fp0
  419.     lea    -$40(a5),a2
  420.     addq.w    #$8,a2
  421.     fmove.s    fp0,(a2)
  422. ;   r4[1][1] = A[M30] * r3[0][1] + A[M31] * r3[1][1];
  423.     lea    $C(a0),a2
  424.     fmove.s    (a2),fp0
  425.     lea    -$30(a5),a2
  426.     addq.w    #4,a2
  427.     fmove.s    (a2),fp1
  428.     fmul.x    fp1,fp0
  429.     lea    $1C(a0),a2
  430.     fmove.s    (a2),fp1
  431.     lea    -$30(a5),a2
  432.     addq.w    #$8,a2
  433.     addq.w    #4,a2
  434.     fmove.s    (a2),fp2
  435.     fmul.x    fp2,fp1
  436.     fadd.x    fp1,fp0
  437.     lea    -$40(a5),a2
  438.     addq.w    #$8,a2
  439.     addq.w    #4,a2
  440.     fmove.s    fp0,(a2)
  441. ;   r5[0][0] = r4[0][0] - A[M22];
  442.     lea    -$40(a5),a2
  443.     fmove.s    (a2),fp0
  444.     lea    $28(a0),a2
  445.     fmove.s    (a2),fp1
  446.     fsub.x    fp1,fp0
  447.     lea    -$50(a5),a2
  448.     fmove.s    fp0,(a2)
  449. ;   r5[0][1] = r4[0][1] - A[M23];
  450.     lea    -$40(a5),a2
  451.     addq.w    #4,a2
  452.     fmove.s    (a2),fp0
  453.     lea    $38(a0),a2
  454.     fmove.s    (a2),fp1
  455.     fsub.x    fp1,fp0
  456.     lea    -$50(a5),a2
  457.     addq.w    #4,a2
  458.     fmove.s    fp0,(a2)
  459. ;   r5[1][0] = r4[1][0] - A[M32];
  460.     lea    -$40(a5),a2
  461.     addq.w    #$8,a2
  462.     fmove.s    (a2),fp0
  463.     lea    $2C(a0),a2
  464.     fmove.s    (a2),fp1
  465.     fsub.x    fp1,fp0
  466.     lea    -$50(a5),a2
  467.     addq.w    #$8,a2
  468.     fmove.s    fp0,(a2)
  469. ;   r5[1][1] = r4[1][1] - A[M33];
  470.     lea    -$40(a5),a2
  471.     addq.w    #$8,a2
  472.     addq.w    #4,a2
  473.     fmove.s    (a2),fp0
  474.     add.w    #$3C,a0
  475.     fmove.s    (a0),fp1
  476.     fsub.x    fp1,fp0
  477.     lea    -$50(a5),a0
  478.     addq.w    #$8,a0
  479.     addq.w    #4,a0
  480.     fmove.s    fp0,(a0)
  481. ;   one_over_det = 1.0f / ( ( r5[0][0] * r5[1][1] ) - ( r5[1][0] *
  482.     lea    -$50(a5),a0
  483.     fmove.s    (a0),fp0
  484.     lea    -$50(a5),a0
  485.     addq.w    #$8,a0
  486.     addq.w    #4,a0
  487.     fmove.s    (a0),fp1
  488.     fmul.x    fp1,fp0
  489.     lea    -$50(a5),a0
  490.     addq.w    #$8,a0
  491.     fmove.s    (a0),fp1
  492.     lea    -$50(a5),a0
  493.     addq.w    #4,a0
  494.     fmove.s    (a0),fp2
  495.     fmul.x    fp2,fp1
  496.     fsub.x    fp1,fp0
  497.     fmove.s    #$.3F800000,fp1
  498.     fdiv.x    fp0,fp1
  499.     fmove.x    fp1,fp0
  500. ;   r6[0][0] = one_over_det * r5[1][1];
  501.     lea    -$50(a5),a0
  502.     addq.w    #$8,a0
  503.     addq.w    #4,a0
  504.     fmove.s    (a0),fp1
  505.     fmul.x    fp0,fp1
  506.     lea    -$60(a5),a0
  507.     fmove.s    fp1,(a0)
  508. ;   r6[0][1] = one_over_det * -r5[0][1];
  509.     lea    -$50(a5),a0
  510.     addq.w    #4,a0
  511.     fmove.s    (a0),fp1
  512.     fneg.s    fp1
  513.     fmul.x    fp0,fp1
  514.     lea    -$60(a5),a0
  515.     addq.w    #4,a0
  516.     fmove.s    fp1,(a0)
  517. ;   r6[1][0] = one_over_det * -r5[1][0];
  518.     lea    -$50(a5),a0
  519.     addq.w    #$8,a0
  520.     fmove.s    (a0),fp1
  521.     fneg.s    fp1
  522.     fmul.x    fp0,fp1
  523.     lea    -$60(a5),a0
  524.     addq.w    #$8,a0
  525.     fmove.s    fp1,(a0)
  526. ;   r6[1][1] = one_over_det * r5[0][0];
  527.     lea    -$50(a5),a0
  528.     fmove.s    (a0),fp1
  529.     fmul.x    fp0,fp1
  530.     lea    -$60(a5),a0
  531.     addq.w    #$8,a0
  532.     addq.w    #4,a0
  533.     fmove.s    fp1,(a0)
  534. ;   C[M02] = r3[0][0] * r6[0][0] + r3[0][1] * r6[1][0];
  535.     lea    -$30(a5),a0
  536.     fmove.s    (a0),fp0
  537.     lea    -$60(a5),a0
  538.     fmove.s    (a0),fp1
  539.     fmul.x    fp1,fp0
  540.     lea    -$30(a5),a0
  541.     addq.w    #4,a0
  542.     fmove.s    (a0),fp1
  543.     lea    -$60(a5),a0
  544.     addq.w    #$8,a0
  545.     fmove.s    (a0),fp2
  546.     fmul.x    fp2,fp1
  547.     fadd.x    fp1,fp0
  548.     lea    $20(a1),a0
  549.     fmove.s    fp0,(a0)
  550. ;   C[M03] = r3[0][0] * r6[0][1] + r3[0][1] * r6[1][1];
  551.     lea    -$30(a5),a0
  552.     fmove.s    (a0),fp0
  553.     lea    -$60(a5),a0
  554.     addq.w    #4,a0
  555.     fmove.s    (a0),fp1
  556.     fmul.x    fp1,fp0
  557.     lea    -$30(a5),a0
  558.     addq.w    #4,a0
  559.     fmove.s    (a0),fp1
  560.     lea    -$60(a5),a0
  561.     addq.w    #$8,a0
  562.     addq.w    #4,a0
  563.     fmove.s    (a0),fp2
  564.     fmul.x    fp2,fp1
  565.     fadd.x    fp1,fp0
  566.     lea    $30(a1),a0
  567.     fmove.s    fp0,(a0)
  568. ;   C[M12] = r3[1][0] * r6[0][0] + r3[1][1] * r6[1][0];
  569.     lea    -$30(a5),a0
  570.     addq.w    #$8,a0
  571.     fmove.s    (a0),fp0
  572.     lea    -$60(a5),a0
  573.     fmove.s    (a0),fp1
  574.     fmul.x    fp1,fp0
  575.     lea    -$30(a5),a0
  576.     addq.w    #$8,a0
  577.     addq.w    #4,a0
  578.     fmove.s    (a0),fp1
  579.     lea    -$60(a5),a0
  580.     addq.w    #$8,a0
  581.     fmove.s    (a0),fp2
  582.     fmul.x    fp2,fp1
  583.     fadd.x    fp1,fp0
  584.     lea    $24(a1),a0
  585.     fmove.s    fp0,(a0)
  586. ;   C[M13] = r3[1][0] * r6[0][1] + r3[1][1] * r6[1][1];
  587.     lea    -$30(a5),a0
  588.     addq.w    #$8,a0
  589.     fmove.s    (a0),fp0
  590.     lea    -$60(a5),a0
  591.     addq.w    #4,a0
  592.     fmove.s    (a0),fp1
  593.     fmul.x    fp1,fp0
  594.     lea    -$30(a5),a0
  595.     addq.w    #$8,a0
  596.     addq.w    #4,a0
  597.     fmove.s    (a0),fp1
  598.     lea    -$60(a5),a0
  599.     addq.w    #$8,a0
  600.     addq.w    #4,a0
  601.     fmove.s    (a0),fp2
  602.     fmul.x    fp2,fp1
  603.     fadd.x    fp1,fp0
  604.     lea    $34(a1),a0
  605.     fmove.s    fp0,(a0)
  606. ;   C[M20] = r6[0][0] * r2[0][0] + r6[0][1] * r2[1][0];
  607.     lea    -$60(a5),a0
  608.     fmove.s    (a0),fp0
  609.     lea    -$20(a5),a0
  610.     fmove.s    (a0),fp1
  611.     fmul.x    fp1,fp0
  612.     lea    -$60(a5),a0
  613.     addq.w    #4,a0
  614.     fmove.s    (a0),fp1
  615.     lea    -$20(a5),a0
  616.     addq.w    #$8,a0
  617.     fmove.s    (a0),fp2
  618.     fmul.x    fp2,fp1
  619.     fadd.x    fp1,fp0
  620.     lea    $8(a1),a0
  621.     fmove.s    fp0,(a0)
  622. ;   C[M21] = r6[0][0] * r2[0][1] + r6[0][1] * r2[1][1];
  623.     lea    -$60(a5),a0
  624.     fmove.s    (a0),fp0
  625.     lea    -$20(a5),a0
  626.     addq.w    #4,a0
  627.     fmove.s    (a0),fp1
  628.     fmul.x    fp1,fp0
  629.     lea    -$60(a5),a0
  630.     addq.w    #4,a0
  631.     fmove.s    (a0),fp1
  632.     lea    -$20(a5),a0
  633.     addq.w    #$8,a0
  634.     addq.w    #4,a0
  635.     fmove.s    (a0),fp2
  636.     fmul.x    fp2,fp1
  637.     fadd.x    fp1,fp0
  638.     lea    $18(a1),a0
  639.     fmove.s    fp0,(a0)
  640. ;   C[M30] = r6[1][0] * r2[0][0] + r6[1][1] * r2[1][0];
  641.     lea    -$60(a5),a0
  642.     addq.w    #$8,a0
  643.     fmove.s    (a0),fp0
  644.     lea    -$20(a5),a0
  645.     fmove.s    (a0),fp1
  646.     fmul.x    fp1,fp0
  647.     lea    -$60(a5),a0
  648.     addq.w    #$8,a0
  649.     addq.w    #4,a0
  650.     fmove.s    (a0),fp1
  651.     lea    -$20(a5),a0
  652.     addq.w    #$8,a0
  653.     fmove.s    (a0),fp2
  654.     fmul.x    fp2,fp1
  655.     fadd.x    fp1,fp0
  656.     lea    $C(a1),a0
  657.     fmove.s    fp0,(a0)
  658. ;   C[M31] = r6[1][0] * r2[0][1] + r6[1][1] * r2[1][1];
  659.     lea    -$60(a5),a0
  660.     addq.w    #$8,a0
  661.     fmove.s    (a0),fp0
  662.     lea    -$20(a5),a0
  663.     addq.w    #4,a0
  664.     fmove.s    (a0),fp1
  665.     fmul.x    fp1,fp0
  666.     lea    -$60(a5),a0
  667.     addq.w    #$8,a0
  668.     addq.w    #4,a0
  669.     fmove.s    (a0),fp1
  670.     lea    -$20(a5),a0
  671.     addq.w    #$8,a0
  672.     addq.w    #4,a0
  673.     fmove.s    (a0),fp2
  674.     fmul.x    fp2,fp1
  675.     fadd.x    fp1,fp0
  676.     lea    $1C(a1),a0
  677.     fmove.s    fp0,(a0)
  678. ;   r7[0][0] = r3[0][0] * C[M20] + r3[0][1] * C[M30];
  679.     lea    -$30(a5),a0
  680.     fmove.s    (a0),fp0
  681.     lea    $8(a1),a0
  682.     fmove.s    (a0),fp1
  683.     fmul.x    fp1,fp0
  684.     lea    -$30(a5),a0
  685.     addq.w    #4,a0
  686.     fmove.s    (a0),fp1
  687.     lea    $C(a1),a0
  688.     fmove.s    (a0),fp2
  689.     fmul.x    fp2,fp1
  690.     fadd.x    fp1,fp0
  691.     lea    -$70(a5),a0
  692.     fmove.s    fp0,(a0)
  693. ;   r7[0][1] = r3[0][0] * C[M21] + r3[0][1] * C[M31];
  694.     lea    -$30(a5),a0
  695.     fmove.s    (a0),fp0
  696.     lea    $18(a1),a0
  697.     fmove.s    (a0),fp1
  698.     fmul.x    fp1,fp0
  699.     lea    -$30(a5),a0
  700.     addq.w    #4,a0
  701.     fmove.s    (a0),fp1
  702.     lea    $1C(a1),a0
  703.     fmove.s    (a0),fp2
  704.     fmul.x    fp2,fp1
  705.     fadd.x    fp1,fp0
  706.     lea    -$70(a5),a0
  707.     addq.w    #4,a0
  708.     fmove.s    fp0,(a0)
  709. ;   r7[1][0] = r3[1][0] * C[M20] + r3[1][1] * C[M30];
  710.     lea    -$30(a5),a0
  711.     addq.w    #$8,a0
  712.     fmove.s    (a0),fp0
  713.     lea    $8(a1),a0
  714.     fmove.s    (a0),fp1
  715.     fmul.x    fp1,fp0
  716.     lea    -$30(a5),a0
  717.     addq.w    #$8,a0
  718.     addq.w    #4,a0
  719.     fmove.s    (a0),fp1
  720.     lea    $C(a1),a0
  721.     fmove.s    (a0),fp2
  722.     fmul.x    fp2,fp1
  723.     fadd.x    fp1,fp0
  724.     lea    -$70(a5),a0
  725.     addq.w    #$8,a0
  726.     fmove.s    fp0,(a0)
  727. ;   r7[1][1] = r3[1][0] * C[M21] + r3[1][1] * C[M31];
  728.     lea    -$30(a5),a0
  729.     addq.w    #$8,a0
  730.     fmove.s    (a0),fp0
  731.     lea    $18(a1),a0
  732.     fmove.s    (a0),fp1
  733.     fmul.x    fp1,fp0
  734.     lea    -$30(a5),a0
  735.     addq.w    #$8,a0
  736.     addq.w    #4,a0
  737.     fmove.s    (a0),fp1
  738.     lea    $1C(a1),a0
  739.     fmove.s    (a0),fp2
  740.     fmul.x    fp2,fp1
  741.     fadd.x    fp1,fp0
  742.     lea    -$70(a5),a0
  743.     addq.w    #$8,a0
  744.     addq.w    #4,a0
  745.     fmove.s    fp0,(a0)
  746. ;   C[M00] = r1[0][0] - r7[0][0];
  747.     lea    -$10(a5),a0
  748.     fmove.s    (a0),fp0
  749.     lea    -$70(a5),a0
  750.     fmove.s    (a0),fp1
  751.     fsub.x    fp1,fp0
  752.     fmove.s    fp0,(a1)
  753. ;   C[M01] = r1[0][1] - r7[0][1];
  754.     lea    -$10(a5),a0
  755.     addq.w    #4,a0
  756.     fmove.s    (a0),fp0
  757.     lea    -$70(a5),a0
  758.     addq.w    #4,a0
  759.     fmove.s    (a0),fp1
  760.     fsub.x    fp1,fp0
  761.     lea    $10(a1),a0
  762.     fmove.s    fp0,(a0)
  763. ;   C[M10] = r1[1][0] - r7[1][0];
  764.     lea    -$10(a5),a0
  765.     addq.w    #$8,a0
  766.     fmove.s    (a0),fp0
  767.     lea    -$70(a5),a0
  768.     addq.w    #$8,a0
  769.     fmove.s    (a0),fp1
  770.     fsub.x    fp1,fp0
  771.     lea    4(a1),a0
  772.     fmove.s    fp0,(a0)
  773. ;   C[M11] = r1[1][1] - r7[1][1];
  774.     lea    -$10(a5),a0
  775.     addq.w    #$8,a0
  776.     addq.w    #4,a0
  777.     fmove.s    (a0),fp0
  778.     lea    -$70(a5),a0
  779.     addq.w    #$8,a0
  780.     addq.w    #4,a0
  781.     fmove.s    (a0),fp1
  782.     fsub.x    fp1,fp0
  783.     lea    $14(a1),a0
  784.     fmove.s    fp0,(a0)
  785. ;   C[M22] = -r6[0][0];
  786.     lea    -$60(a5),a0
  787.     fmove.s    (a0),fp0
  788.     fneg.s    fp0
  789.     lea    $28(a1),a0
  790.     fmove.s    fp0,(a0)
  791. ;   C[M23] = -r6[0][1];
  792.     lea    -$60(a5),a0
  793.     addq.w    #4,a0
  794.     fmove.s    (a0),fp0
  795.     fneg.s    fp0
  796.     lea    $38(a1),a0
  797.     fmove.s    fp0,(a0)
  798. ;   C[M32] = -r6[1][0];
  799.     lea    -$60(a5),a0
  800.     addq.w    #$8,a0
  801.     fmove.s    (a0),fp0
  802.     fneg.s    fp0
  803.     lea    $2C(a1),a0
  804.     fmove.s    fp0,(a0)
  805. ;   C[M33] = -r6[1][1];
  806.     lea    -$60(a5),a0
  807.     addq.w    #$8,a0
  808.     addq.w    #4,a0
  809.     fmove.s    (a0),fp0
  810.     fneg.s    fp0
  811.     lea    $3C(a1),a0
  812.     fmove.s    fp0,(a0)
  813.     fmovem.x (a7)+,fp2
  814.     move.l    (a7)+,a2
  815.     unlk    a5
  816.     rts
  817.  
  818.     SECTION "_invert_matrix:0",CODE
  819.  
  820.  
  821. ;static void invert_matrix( const GLfloat *m, GLfloat *out )
  822. _invert_matrix
  823. L112    EQU    -$68
  824.     link    a5,#L112
  825.     move.l    a2,-(a7)
  826.     fmovem.x fp2/fp3/fp4/fp5/fp6,-(a7)
  827.     movem.l    $8(a5),a0/a2
  828. L103
  829. ;   if( m41 != 0. || m42 != 0. || m43 != 0. || m44 != 1. ) 
  830.     lea    $C(a0),a1
  831.     fmove.s    (a1),fp0
  832.     ftst.d    fp0
  833.     fbne.b    L107
  834. L104
  835.     lea    $1C(a0),a1
  836.     fmove.s    (a1),fp0
  837.     ftst.d    fp0
  838.     fbne.b    L107
  839. L105
  840.     lea    $2C(a0),a1
  841.     fmove.s    (a1),fp0
  842.     ftst.d    fp0
  843.     fbne.b    L107
  844. L106
  845.     lea    $3C(a0),a1
  846.     fmove.s    (a1),fp0
  847.     fcmp.d    #$.3FF00000.00000000,fp0
  848.     fbeq.b    L108
  849. L107
  850. ;      invert_matrix_general(m, out);
  851.     move.l    a2,-(a7)
  852.     move.l    a0,-(a7)
  853.     jsr    _invert_matrix_general
  854.     addq.w    #$8,a7
  855.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  856.     move.l    (a7)+,a2
  857.     unlk    a5
  858.     rts
  859. L108
  860. ;   tmp[0]= m22 * m33 - m23 * m32;
  861.     lea    $14(a0),a1
  862.     fmove.s    (a1),fp0
  863.     lea    $28(a0),a1
  864.     fmove.s    (a1),fp1
  865.     fmul.x    fp1,fp0
  866.     lea    $24(a0),a1
  867.     fmove.s    (a1),fp1
  868.     lea    $18(a0),a1
  869.     fmove.s    (a1),fp2
  870.     fmul.x    fp2,fp1
  871.     fsub.x    fp1,fp0
  872.     lea    -$40(a5),a1
  873.     fmove.s    fp0,(a1)
  874. ;   tmp[1]= m23 * m31 - m21 * m33;
  875.     lea    $24(a0),a1
  876.     fmove.s    (a1),fp0
  877.     lea    $8(a0),a1
  878.     fmove.s    (a1),fp1
  879.     fmul.x    fp1,fp0
  880.     lea    4(a0),a1
  881.     fmove.s    (a1),fp1
  882.     lea    $28(a0),a1
  883.     fmove.s    (a1),fp2
  884.     fmul.x    fp2,fp1
  885.     fsub.x    fp1,fp0
  886.     lea    -$40(a5),a1
  887.     addq.w    #4,a1
  888.     fmove.s    fp0,(a1)
  889. ;   tmp[2]= m21 * m32 - m22 * m31;
  890.     lea    4(a0),a1
  891.     fmove.s    (a1),fp0
  892.     lea    $18(a0),a1
  893.     fmove.s    (a1),fp1
  894.     fmul.x    fp1,fp0
  895.     lea    $14(a0),a1
  896.     fmove.s    (a1),fp1
  897.     lea    $8(a0),a1
  898.     fmove.s    (a1),fp2
  899.     fmul.x    fp2,fp1
  900.     fsub.x    fp1,fp0
  901.     lea    -$40(a5),a1
  902.     addq.w    #$8,a1
  903.     fmove.s    fp0,(a1)
  904. ;   det= m11 * tmp[0] + m12 * tmp[1] + m13 * tmp[2];
  905.     fmove.s    (a0),fp0
  906.     lea    -$40(a5),a1
  907.     fmove.s    (a1),fp1
  908.     fmul.x    fp1,fp0
  909.     lea    $10(a0),a1
  910.     fmove.s    (a1),fp1
  911.     lea    -$40(a5),a1
  912.     addq.w    #4,a1
  913.     fmove.s    (a1),fp2
  914.     fmul.x    fp2,fp1
  915.     fadd.x    fp1,fp0
  916.     lea    $20(a0),a1
  917.     fmove.s    (a1),fp1
  918.     lea    -$40(a5),a1
  919.     addq.w    #$8,a1
  920.     fmove.s    (a1),fp2
  921.     fmul.x    fp2,fp1
  922.     fadd.x    fp1,fp0
  923. ;   if (det == 0.0F) 
  924.     fcmp.s    #$.00000000,fp0
  925.     fbne.b    L110
  926. L109
  927. ;      MEMCPY( out, I
  928.     pea    $40.w
  929.     move.l    #_Identity,-(a7)
  930.     move.l    a2,-(a7)
  931.     jsr    _memcpy
  932.     add.w    #$C,a7
  933.     bra    L111
  934. L110
  935. ;      det= 1. / det;
  936.     fmove.d    #$.3FF00000.00000000,fp1
  937.     fdiv.x    fp0,fp1
  938.     fmove.x    fp1,fp0
  939. ;      tmp[0] *= det;
  940.     lea    -$40(a5),a1
  941.     fmove.s    (a1),fp1
  942.     fmul.x    fp0,fp1
  943.     fmove.s    fp1,(a1)
  944. ;      tmp[1] *= det;
  945.     lea    -$40(a5),a1
  946.     addq.w    #4,a1
  947.     fmove.s    (a1),fp1
  948.     fmul.x    fp0,fp1
  949.     fmove.s    fp1,(a1)
  950. ;      tmp[2] *= det;
  951.     lea    -$40(a5),a1
  952.     addq.w    #$8,a1
  953.     fmove.s    (a1),fp1
  954.     fmul.x    fp0,fp1
  955.     fmove.s    fp1,(a1)
  956. ;      tmp[3]  = 0.;
  957.     lea    -$40(a5),a1
  958.     add.w    #$C,a1
  959.     clr.l    (a1)
  960. ;      im11= m11 * det;
  961.     fmove.s    (a0),fp3
  962.     fmul.x    fp0,fp3
  963. ;      im12= m12 * det;
  964.     lea    $10(a0),a1
  965.     fmove.s    (a1),fp2
  966.     fmul.x    fp0,fp2
  967. ;      im13= m13 * det;
  968.     lea    $20(a0),a1
  969.     fmove.s    (a1),fp1
  970.     fmul.x    fp0,fp1
  971. ;      im14= m14 * det;
  972.     lea    $30(a0),a1
  973.     move.l    (a1),-$64(a5)
  974.     fmove.s    -$64(a5),fp4
  975.     fmul.x    fp0,fp4
  976.     fmove.s    fp4,-$64(a5)
  977. ;      tmp[4] = im13 * m32 - im12 * m33;
  978.     lea    $18(a0),a1
  979.     fmove.s    (a1),fp0
  980.     fmul.x    fp1,fp0
  981.     lea    $28(a0),a1
  982.     fmove.s    (a1),fp4
  983.     fmul.x    fp2,fp4
  984.     fsub.x    fp4,fp0
  985.     lea    -$40(a5),a1
  986.     add.w    #$10,a1
  987.     fmove.s    fp0,(a1)
  988. ;      tmp[5] = im11 * m33 - im13 * m31;
  989.     lea    $28(a0),a1
  990.     fmove.s    (a1),fp0
  991.     fmul.x    fp3,fp0
  992.     lea    $8(a0),a1
  993.     fmove.s    (a1),fp4
  994.     fmul.x    fp1,fp4
  995.     fsub.x    fp4,fp0
  996.     lea    -$40(a5),a1
  997.     add.w    #$14,a1
  998.     fmove.s    fp0,(a1)
  999. ;      tmp[6] = im12 * m31 - im11 * m32;
  1000.     lea    $8(a0),a1
  1001.     fmove.s    (a1),fp0
  1002.     fmul.x    fp2,fp0
  1003.     lea    $18(a0),a1
  1004.     fmove.s    (a1),fp4
  1005.     fmul.x    fp3,fp4
  1006.     fsub.x    fp4,fp0
  1007.     lea    -$40(a5),a1
  1008.     add.w    #$18,a1
  1009.     fmove.s    fp0,(a1)
  1010. ;      tmp[7] = 0.;
  1011.     lea    -$40(a5),a1
  1012.     add.w    #$1C,a1
  1013.     clr.l    (a1)
  1014. ;      d12 = im11*m22 - m21*im12;
  1015.     lea    $14(a0),a1
  1016.     move.l    (a1),-$44(a5)
  1017.     fmove.s    -$44(a5),fp0
  1018.     fmul.x    fp3,fp0
  1019.     fmove.s    fp0,-$44(a5)
  1020.     lea    4(a0),a1
  1021.     fmove.s    (a1),fp0
  1022.     fmul.x    fp2,fp0
  1023.     fmove.s    -$44(a5),fp4
  1024.     fsub.x    fp0,fp4
  1025.     fmove.s    fp4,-$44(a5)
  1026. ;      d13 = im11*m23 - m21*im13;
  1027.     lea    $24(a0),a1
  1028.     move.l    (a1),-$48(a5)
  1029.     fmove.s    -$48(a5),fp0
  1030.     fmul.x    fp3,fp0
  1031.     fmove.s    fp0,-$48(a5)
  1032.     lea    4(a0),a1
  1033.     fmove.s    (a1),fp0
  1034.     fmul.x    fp1,fp0
  1035.     fmove.s    -$48(a5),fp4
  1036.     fsub.x    fp0,fp4
  1037.     fmove.s    fp4,-$48(a5)
  1038. ;      d23 = im12*m23 - m22*im13;
  1039.     lea    $24(a0),a1
  1040.     fmove.s    (a1),fp5
  1041.     fmul.x    fp2,fp5
  1042.     lea    $14(a0),a1
  1043.     fmove.s    (a1),fp0
  1044.     fmul.x    fp1,fp0
  1045.     fsub.x    fp0,fp5
  1046. ;      d24 = im12*m24 - m22*im14;
  1047.     lea    $34(a0),a1
  1048.     fmove.s    (a1),fp4
  1049.     fmul.x    fp2,fp4
  1050.     lea    $14(a0),a1
  1051.     fmove.s    (a1),fp0
  1052.     fmul.s    -$64(a5),fp0
  1053.     fsub.x    fp0,fp4
  1054. ;      d34 = im13*m24 - m23*im14;
  1055.     lea    $34(a0),a1
  1056.     fmove.s    (a1),fp2
  1057.     fmul.x    fp1,fp2
  1058.     lea    $24(a0),a1
  1059.     fmove.s    (a1),fp0
  1060.     fmul.s    -$64(a5),fp0
  1061.     fsub.x    fp0,fp2
  1062. ;      d41 = im14*m21 - m24*im11;
  1063.     lea    4(a0),a1
  1064.     fmove.s    (a1),fp1
  1065.     fmul.s    -$64(a5),fp1
  1066.     lea    $34(a0),a1
  1067.     fmove.s    (a1),fp0
  1068.     fmul.x    fp3,fp0
  1069.     fsub.x    fp0,fp1
  1070. ;      tmp[8] =  d23;
  1071.     lea    -$40(a5),a1
  1072.     add.w    #$20,a1
  1073.     fmove.s    fp5,(a1)
  1074. ;      tmp[9] = -d13;
  1075.     fmove.s    -$48(a5),fp0
  1076.     fneg.s    fp0
  1077.     lea    -$40(a5),a1
  1078.     add.w    #$24,a1
  1079.     fmove.s    fp0,(a1)
  1080. ;      tmp[10] = d12;
  1081.     lea    -$40(a5),a1
  1082.     add.w    #$28,a1
  1083.     move.l    -$44(a5),(a1)
  1084. ;      tmp[11] = 0.;
  1085.     lea    -$40(a5),a1
  1086.     add.w    #$2C,a1
  1087.     clr.l    (a1)
  1088. ;      tmp[12] = -(m32 * d34 - m33 * d24 + m34 * d23);
  1089.     lea    $18(a0),a1
  1090.     fmove.s    (a1),fp0
  1091.     fmul.x    fp2,fp0
  1092.     lea    $28(a0),a1
  1093.     fmove.s    (a1),fp3
  1094.     fmul.x    fp4,fp3
  1095.     fsub.x    fp3,fp0
  1096.     lea    $38(a0),a1
  1097.     fmove.s    (a1),fp3
  1098.     fmul.x    fp5,fp3
  1099.     fadd.x    fp3,fp0
  1100.     fneg.s    fp0
  1101.     lea    -$40(a5),a1
  1102.     add.w    #$30,a1
  1103.     fmove.s    fp0,(a1)
  1104. ;      tmp[13] =  (m31 * d34 + m33 * d41 + m34 * d13);
  1105.     lea    $8(a0),a1
  1106.     fmove.s    (a1),fp0
  1107.     fmul.x    fp2,fp0
  1108.     lea    $28(a0),a1
  1109.     fmove.s    (a1),fp2
  1110.     fmul.x    fp1,fp2
  1111.     fadd.x    fp2,fp0
  1112.     lea    $38(a0),a1
  1113.     fmove.s    (a1),fp2
  1114.     fmul.s    -$48(a5),fp2
  1115.     fadd.x    fp2,fp0
  1116.     lea    -$40(a5),a1
  1117.     add.w    #$34,a1
  1118.     fmove.s    fp0,(a1)
  1119. ;      tmp[14] = -(m31 * d24 + m32 * d41 + m34 * d12);
  1120.     lea    $8(a0),a1
  1121.     fmove.s    (a1),fp0
  1122.     fmul.x    fp4,fp0
  1123.     lea    $18(a0),a1
  1124.     fmove.s    (a1),fp2
  1125.     fmul.x    fp1,fp2
  1126.     fadd.x    fp2,fp0
  1127.     add.w    #$38,a0
  1128.     fmove.s    (a0),fp1
  1129.     fmul.s    -$44(a5),fp1
  1130.     fadd.x    fp1,fp0
  1131.     fneg.s    fp0
  1132.     lea    -$40(a5),a0
  1133.     add.w    #$38,a0
  1134.     fmove.s    fp0,(a0)
  1135. ;      tmp[15] =  1.;
  1136.     lea    -$40(a5),a0
  1137.     add.w    #$3C,a0
  1138.     move.l    #$3F800000,(a0)
  1139. ;      MEMCPY(out, tmp, 16*s
  1140.     pea    $40.w
  1141.     lea    -$40(a5),a0
  1142.     move.l    a0,-(a7)
  1143.     move.l    a2,-(a7)
  1144.     jsr    _memcpy
  1145.     add.w    #$C,a7
  1146. L111
  1147.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  1148.     move.l    (a7)+,a2
  1149.     unlk    a5
  1150.     rts
  1151.  
  1152.     SECTION "_is_identity:0",CODE
  1153.  
  1154.  
  1155. ;static GLboolean is_identity( const GLfloat m[16] )
  1156. _is_identity
  1157.     move.l    4(a7),a0
  1158. L113
  1159. ;   if (   m[0]==1.0F && m[4]==0.0F && m[ 8]==0.0F && m[12]==0.0F
  1160.     fmove.s    (a0),fp0
  1161.     fcmp.s    #$.3F800000,fp0
  1162.     fbne.b    L130
  1163. L114
  1164.     lea    $10(a0),a1
  1165.     fmove.s    (a1),fp0
  1166.     fcmp.s    #$.00000000,fp0
  1167.     fbne.b    L130
  1168. L115
  1169.     lea    $20(a0),a1
  1170.     fmove.s    (a1),fp0
  1171.     fcmp.s    #$.00000000,fp0
  1172.     fbne.b    L130
  1173. L116
  1174.     lea    $30(a0),a1
  1175.     fmove.s    (a1),fp0
  1176.     fcmp.s    #$.00000000,fp0
  1177.     fbne.b    L130
  1178. L117
  1179.     lea    4(a0),a1
  1180.     fmove.s    (a1),fp0
  1181.     fcmp.s    #$.00000000,fp0
  1182.     fbne.b    L130
  1183. L118
  1184.     lea    $14(a0),a1
  1185.     fmove.s    (a1),fp0
  1186.     fcmp.s    #$.3F800000,fp0
  1187.     fbne.b    L130
  1188. L119
  1189.     lea    $24(a0),a1
  1190.     fmove.s    (a1),fp0
  1191.     fcmp.s    #$.00000000,fp0
  1192.     fbne.b    L130
  1193. L120
  1194.     lea    $34(a0),a1
  1195.     fmove.s    (a1),fp0
  1196.     fcmp.s    #$.00000000,fp0
  1197.     fbne.b    L130
  1198. L121
  1199.     lea    $8(a0),a1
  1200.     fmove.s    (a1),fp0
  1201.     fcmp.s    #$.00000000,fp0
  1202.     fbne.b    L130
  1203. L122
  1204.     lea    $18(a0),a1
  1205.     fmove.s    (a1),fp0
  1206.     fcmp.s    #$.00000000,fp0
  1207.     fbne.b    L130
  1208. L123
  1209.     lea    $28(a0),a1
  1210.     fmove.s    (a1),fp0
  1211.     fcmp.s    #$.3F800000,fp0
  1212.     fbne.b    L130
  1213. L124
  1214.     lea    $38(a0),a1
  1215.     fmove.s    (a1),fp0
  1216.     fcmp.s    #$.00000000,fp0
  1217.     fbne.b    L130
  1218. L125
  1219.     lea    $C(a0),a1
  1220.     fmove.s    (a1),fp0
  1221.     fcmp.s    #$.00000000,fp0
  1222.     fbne.b    L130
  1223. L126
  1224.     lea    $1C(a0),a1
  1225.     fmove.s    (a1),fp0
  1226.     fcmp.s    #$.00000000,fp0
  1227.     fbne.b    L130
  1228. L127
  1229.     lea    $2C(a0),a1
  1230.     fmove.s    (a1),fp0
  1231.     fcmp.s    #$.00000000,fp0
  1232.     fbne.b    L130
  1233. L128
  1234.     add.w    #$3C,a0
  1235.     fmove.s    (a0),fp0
  1236.     fcmp.s    #$.3F800000,fp0
  1237.     fbne.b    L130
  1238. L129
  1239.     moveq    #1,d0
  1240.     rts
  1241. L130
  1242.     moveq    #0,d0
  1243.     rts
  1244.  
  1245.     SECTION "_gl_analyze_modelview_matrix:0",CODE
  1246.  
  1247.  
  1248. ;void gl_analyze_modelview_matrix( GLcontext *ctx )
  1249.     XDEF    _gl_analyze_modelview_matrix
  1250. _gl_analyze_modelview_matrix
  1251. L164    EQU    -4
  1252.     link    a5,#L164
  1253.     move.l    a2,-(a7)
  1254. L131
  1255. ;   const GLfloat *m = ctx->ModelViewMatrix;
  1256.     move.l    $8(a5),a0
  1257.     lea    $982(a0),a2
  1258. ;   if (is_identity(m)) 
  1259.     move.l    a2,-(a7)
  1260.     jsr    _is_identity
  1261.     addq.w    #4,a7
  1262.     tst.b    d0
  1263.     beq.b    L133
  1264. L132
  1265. ;      ctx->ModelViewMatrixType = MATRIX_IDENTITY;
  1266.     move.l    $8(a5),a0
  1267.     move.l    #1,$97E(a0)
  1268.     bra    L163
  1269. L133
  1270. ;   else if (                 m[4]==0.0F && m[ 8]==0.0F      
  1271.     lea    $10(a2),a0
  1272.     fmove.s    (a0),fp0
  1273.     fcmp.s    #$.00000000,fp0
  1274.     fbne.b    L146
  1275. L134
  1276.     lea    $20(a2),a0
  1277.     fmove.s    (a0),fp0
  1278.     fcmp.s    #$.00000000,fp0
  1279.     fbne.b    L146
  1280. L135
  1281.     lea    4(a2),a0
  1282.     fmove.s    (a0),fp0
  1283.     fcmp.s    #$.00000000,fp0
  1284.     fbne.b    L146
  1285. L136
  1286.     lea    $24(a2),a0
  1287.     fmove.s    (a0),fp0
  1288.     fcmp.s    #$.00000000,fp0
  1289.     fbne.b    L146
  1290. L137
  1291.     lea    $8(a2),a0
  1292.     fmove.s    (a0),fp0
  1293.     fcmp.s    #$.00000000,fp0
  1294.     fbne.b    L146
  1295. L138
  1296.     lea    $18(a2),a0
  1297.     fmove.s    (a0),fp0
  1298.     fcmp.s    #$.00000000,fp0
  1299.     fbne.b    L146
  1300. L139
  1301.     lea    $28(a2),a0
  1302.     fmove.s    (a0),fp0
  1303.     fcmp.s    #$.3F800000,fp0
  1304.     fbne.b    L146
  1305. L140
  1306.     lea    $38(a2),a0
  1307.     fmove.s    (a0),fp0
  1308.     fcmp.s    #$.00000000,fp0
  1309.     fbne.b    L146
  1310. L141
  1311.     lea    $C(a2),a0
  1312.     fmove.s    (a0),fp0
  1313.     fcmp.s    #$.00000000,fp0
  1314.     fbne.b    L146
  1315. L142
  1316.     lea    $1C(a2),a0
  1317.     fmove.s    (a0),fp0
  1318.     fcmp.s    #$.00000000,fp0
  1319.     fbne.b    L146
  1320. L143
  1321.     lea    $2C(a2),a0
  1322.     fmove.s    (a0),fp0
  1323.     fcmp.s    #$.00000000,fp0
  1324.     fbne.b    L146
  1325. L144
  1326.     lea    $3C(a2),a0
  1327.     fmove.s    (a0),fp0
  1328.     fcmp.s    #$.3F800000,fp0
  1329.     fbne.b    L146
  1330. L145
  1331. ;      ctx->ModelViewMatrixType = MATRIX_2D_NO_ROT;
  1332.     move.l    $8(a5),a0
  1333.     move.l    #5,$97E(a0)
  1334.     bra    L163
  1335. L146
  1336. ;   else if (                               m[ 8]==0.0F      
  1337.     lea    $20(a2),a0
  1338.     fmove.s    (a0),fp0
  1339.     fcmp.s    #$.00000000,fp0
  1340.     fbne.b    L157
  1341. L147
  1342.     lea    $24(a2),a0
  1343.     fmove.s    (a0),fp0
  1344.     fcmp.s    #$.00000000,fp0
  1345.     fbne.b    L157
  1346. L148
  1347.     lea    $8(a2),a0
  1348.     fmove.s    (a0),fp0
  1349.     fcmp.s    #$.00000000,fp0
  1350.     fbne.b    L157
  1351. L149
  1352.     lea    $18(a2),a0
  1353.     fmove.s    (a0),fp0
  1354.     fcmp.s    #$.00000000,fp0
  1355.     fbne.b    L157
  1356. L150
  1357.     lea    $28(a2),a0
  1358.     fmove.s    (a0),fp0
  1359.     fcmp.s    #$.3F800000,fp0
  1360.     fbne.b    L157
  1361. L151
  1362.     lea    $38(a2),a0
  1363.     fmove.s    (a0),fp0
  1364.     fcmp.s    #$.00000000,fp0
  1365.     fbne.b    L157
  1366. L152
  1367.     lea    $C(a2),a0
  1368.     fmove.s    (a0),fp0
  1369.     fcmp.s    #$.00000000,fp0
  1370.     fbne.b    L157
  1371. L153
  1372.     lea    $1C(a2),a0
  1373.     fmove.s    (a0),fp0
  1374.     fcmp.s    #$.00000000,fp0
  1375.     fbne.b    L157
  1376. L154
  1377.     lea    $2C(a2),a0
  1378.     fmove.s    (a0),fp0
  1379.     fcmp.s    #$.00000000,fp0
  1380.     fbne.b    L157
  1381. L155
  1382.     lea    $3C(a2),a0
  1383.     fmove.s    (a0),fp0
  1384.     fcmp.s    #$.3F800000,fp0
  1385.     fbne.b    L157
  1386. L156
  1387. ;      ctx->ModelViewMatrixType = MATRIX_2D;
  1388.     move.l    $8(a5),a0
  1389.     move.l    #4,$97E(a0)
  1390.     bra.b    L163
  1391. L157
  1392. ;   else if (m[3]==0.0F && m[7]==0.0F && m[11]==0.0F && m[15]
  1393.     lea    $C(a2),a0
  1394.     fmove.s    (a0),fp0
  1395.     fcmp.s    #$.00000000,fp0
  1396.     fbne.b    L162
  1397. L158
  1398.     lea    $1C(a2),a0
  1399.     fmove.s    (a0),fp0
  1400.     fcmp.s    #$.00000000,fp0
  1401.     fbne.b    L162
  1402. L159
  1403.     lea    $2C(a2),a0
  1404.     fmove.s    (a0),fp0
  1405.     fcmp.s    #$.00000000,fp0
  1406.     fbne.b    L162
  1407. L160
  1408.     lea    $3C(a2),a0
  1409.     fmove.s    (a0),fp0
  1410.     fcmp.s    #$.3F800000,fp0
  1411.     fbne.b    L162
  1412. L161
  1413. ;      ctx->ModelViewMatrixType = MATRIX_3D;
  1414.     move.l    $8(a5),a0
  1415.     move.l    #6,$97E(a0)
  1416.     bra.b    L163
  1417. L162
  1418. ;      ctx->ModelViewMatrixType = MATRIX_GENERAL;
  1419.     move.l    $8(a5),a0
  1420.     clr.l    $97E(a0)
  1421. L163
  1422. ;   invert_matrix( ctx->ModelViewMatrix, ctx->ModelViewInv );
  1423.     move.l    $8(a5),a1
  1424.     lea    $9C2(a1),a0
  1425.     move.l    a0,-(a7)
  1426.     move.l    $8(a5),a1
  1427.     lea    $982(a1),a0
  1428.     move.l    a0,-(a7)
  1429.     jsr    _invert_matrix
  1430.     addq.w    #$8,a7
  1431. ;   ctx->NewModelViewMatrix = GL_FALSE;
  1432.     move.l    $8(a5),a0
  1433.     clr.b    $97C(a0)
  1434.     move.l    (a7)+,a2
  1435.     unlk    a5
  1436.     rts
  1437.  
  1438.     SECTION "_gl_analyze_projection_matrix:0",CODE
  1439.  
  1440.  
  1441. ;void gl_analyze_projection_matrix( GLcontext *ctx )
  1442.     XDEF    _gl_analyze_projection_matrix
  1443. _gl_analyze_projection_matrix
  1444. L191    EQU    -4
  1445.     link    a5,#L191
  1446.     move.l    a2,-(a7)
  1447. L165
  1448. ;   const GLfloat *m = ctx->ProjectionMatrix;
  1449.     move.l    $8(a5),a0
  1450.     lea    $120C(a0),a2
  1451. ;   if (is_identity(m)) 
  1452.     move.l    a2,-(a7)
  1453.     jsr    _is_identity
  1454.     addq.w    #4,a7
  1455.     tst.b    d0
  1456.     beq.b    L167
  1457. L166
  1458. ;      ctx->ProjectionMatrixType = MATRIX_IDENTITY;
  1459.     move.l    $8(a5),a0
  1460.     move.l    #1,$1208(a0)
  1461.     bra    L190
  1462. L167
  1463. ;   else if (                 m[4]==0.0F && m[8] ==0.0F
  1464.     lea    $10(a2),a0
  1465.     fmove.s    (a0),fp0
  1466.     fcmp.s    #$.00000000,fp0
  1467.     fbne.b    L178
  1468. L168
  1469.     lea    $20(a2),a0
  1470.     fmove.s    (a0),fp0
  1471.     fcmp.s    #$.00000000,fp0
  1472.     fbne.b    L178
  1473. L169
  1474.     lea    4(a2),a0
  1475.     fmove.s    (a0),fp0
  1476.     fcmp.s    #$.00000000,fp0
  1477.     fbne.b    L178
  1478. L170
  1479.     lea    $24(a2),a0
  1480.     fmove.s    (a0),fp0
  1481.     fcmp.s    #$.00000000,fp0
  1482.     fbne.b    L178
  1483. L171
  1484.     lea    $8(a2),a0
  1485.     fmove.s    (a0),fp0
  1486.     fcmp.s    #$.00000000,fp0
  1487.     fbne.b    L178
  1488. L172
  1489.     lea    $18(a2),a0
  1490.     fmove.s    (a0),fp0
  1491.     fcmp.s    #$.00000000,fp0
  1492.     fbne.b    L178
  1493. L173
  1494.     lea    $C(a2),a0
  1495.     fmove.s    (a0),fp0
  1496.     fcmp.s    #$.00000000,fp0
  1497.     fbne.b    L178
  1498. L174
  1499.     lea    $1C(a2),a0
  1500.     fmove.s    (a0),fp0
  1501.     fcmp.s    #$.00000000,fp0
  1502.     fbne.b    L178
  1503. L175
  1504.     lea    $2C(a2),a0
  1505.     fmove.s    (a0),fp0
  1506.     fcmp.s    #$.00000000,fp0
  1507.     fbne.b    L178
  1508. L176
  1509.     lea    $3C(a2),a0
  1510.     fmove.s    (a0),fp0
  1511.     fcmp.s    #$.3F800000,fp0
  1512.     fbne.b    L178
  1513. L177
  1514. ;      ctx->ProjectionMatrixType = MATRIX_ORTHO;
  1515.     move.l    $8(a5),a0
  1516.     move.l    #2,$1208(a0)
  1517.     bra    L190
  1518. L178
  1519. ;   else if (                 m[4]==0.0F                 && m
  1520.     lea    $10(a2),a0
  1521.     fmove.s    (a0),fp0
  1522.     fcmp.s    #$.00000000,fp0
  1523.     fbne.b    L189
  1524. L179
  1525.     lea    $30(a2),a0
  1526.     fmove.s    (a0),fp0
  1527.     fcmp.s    #$.00000000,fp0
  1528.     fbne.b    L189
  1529. L180
  1530.     lea    4(a2),a0
  1531.     fmove.s    (a0),fp0
  1532.     fcmp.s    #$.00000000,fp0
  1533.     fbne.b    L189
  1534. L181
  1535.     lea    $34(a2),a0
  1536.     fmove.s    (a0),fp0
  1537.     fcmp.s    #$.00000000,fp0
  1538.     fbne.b    L189
  1539. L182
  1540.     lea    $8(a2),a0
  1541.     fmove.s    (a0),fp0
  1542.     fcmp.s    #$.00000000,fp0
  1543.     fbne.b    L189
  1544. L183
  1545.     lea    $18(a2),a0
  1546.     fmove.s    (a0),fp0
  1547.     fcmp.s    #$.00000000,fp0
  1548.     fbne.b    L189
  1549. L184
  1550.     lea    $C(a2),a0
  1551.     fmove.s    (a0),fp0
  1552.     fcmp.s    #$.00000000,fp0
  1553.     fbne.b    L189
  1554. L185
  1555.     lea    $1C(a2),a0
  1556.     fmove.s    (a0),fp0
  1557.     fcmp.s    #$.00000000,fp0
  1558.     fbne.b    L189
  1559. L186
  1560.     lea    $2C(a2),a0
  1561.     fmove.s    (a0),fp0
  1562.     fcmp.s    #$.BF800000,fp0
  1563.     fbne.b    L189
  1564. L187
  1565.     lea    $3C(a2),a0
  1566.     fmove.s    (a0),fp0
  1567.     fcmp.s    #$.00000000,fp0
  1568.     fbne.b    L189
  1569. L188
  1570. ;      ctx->ProjectionMatrixType = MATRIX_PERSPECTIVE;
  1571.     move.l    $8(a5),a0
  1572.     move.l    #3,$1208(a0)
  1573.     bra.b    L190
  1574. L189
  1575. ;      ctx->ProjectionMatrixType = MATRIX_GENERAL;
  1576.     move.l    $8(a5),a0
  1577.     clr.l    $1208(a0)
  1578. L190
  1579. ;   ctx->NewProjectionMatrix = GL_FALSE;
  1580.     move.l    $8(a5),a0
  1581.     clr.b    $1206(a0)
  1582.     move.l    (a7)+,a2
  1583.     unlk    a5
  1584.     rts
  1585.  
  1586.     SECTION "_gl_analyze_texture_matrix:0",CODE
  1587.  
  1588.  
  1589. ;void gl_analyze_texture_matrix( GLcontext *ctx )
  1590.     XDEF    _gl_analyze_texture_matrix
  1591. _gl_analyze_texture_matrix
  1592. L212    EQU    -4
  1593.     link    a5,#L212
  1594.     move.l    a2,-(a7)
  1595. L192
  1596. ;   const GLfloat *m = ctx->TextureMatrix;
  1597.     move.l    $8(a5),a0
  1598.     lea    $1B56(a0),a2
  1599. ;   if (is_identity(m)) 
  1600.     move.l    a2,-(a7)
  1601.     jsr    _is_identity
  1602.     addq.w    #4,a7
  1603.     tst.b    d0
  1604.     beq.b    L194
  1605. L193
  1606. ;      ctx->TextureMatrixType = MATRIX_IDENTITY;
  1607.     move.l    $8(a5),a0
  1608.     move.l    #1,$1B52(a0)
  1609.     bra    L211
  1610. L194
  1611. ;   else if (                               m[ 8]==0.0F      
  1612.     lea    $20(a2),a0
  1613.     fmove.s    (a0),fp0
  1614.     fcmp.s    #$.00000000,fp0
  1615.     fbne.b    L205
  1616. L195
  1617.     lea    $24(a2),a0
  1618.     fmove.s    (a0),fp0
  1619.     fcmp.s    #$.00000000,fp0
  1620.     fbne.b    L205
  1621. L196
  1622.     lea    $8(a2),a0
  1623.     fmove.s    (a0),fp0
  1624.     fcmp.s    #$.00000000,fp0
  1625.     fbne.b    L205
  1626. L197
  1627.     lea    $18(a2),a0
  1628.     fmove.s    (a0),fp0
  1629.     fcmp.s    #$.00000000,fp0
  1630.     fbne.b    L205
  1631. L198
  1632.     lea    $28(a2),a0
  1633.     fmove.s    (a0),fp0
  1634.     fcmp.s    #$.3F800000,fp0
  1635.     fbne.b    L205
  1636. L199
  1637.     lea    $38(a2),a0
  1638.     fmove.s    (a0),fp0
  1639.     fcmp.s    #$.00000000,fp0
  1640.     fbne.b    L205
  1641. L200
  1642.     lea    $C(a2),a0
  1643.     fmove.s    (a0),fp0
  1644.     fcmp.s    #$.00000000,fp0
  1645.     fbne.b    L205
  1646. L201
  1647.     lea    $1C(a2),a0
  1648.     fmove.s    (a0),fp0
  1649.     fcmp.s    #$.00000000,fp0
  1650.     fbne.b    L205
  1651. L202
  1652.     lea    $2C(a2),a0
  1653.     fmove.s    (a0),fp0
  1654.     fcmp.s    #$.00000000,fp0
  1655.     fbne.b    L205
  1656. L203
  1657.     lea    $3C(a2),a0
  1658.     fmove.s    (a0),fp0
  1659.     fcmp.s    #$.3F800000,fp0
  1660.     fbne.b    L205
  1661. L204
  1662. ;      ctx->TextureMatrixType = MATRIX_2D;
  1663.     move.l    $8(a5),a0
  1664.     move.l    #4,$1B52(a0)
  1665.     bra.b    L211
  1666. L205
  1667. ;   else if (m[3]==0.0F && m[7]==0.0F && m[11]==0.0F && m[15]
  1668.     lea    $C(a2),a0
  1669.     fmove.s    (a0),fp0
  1670.     fcmp.s    #$.00000000,fp0
  1671.     fbne.b    L210
  1672. L206
  1673.     lea    $1C(a2),a0
  1674.     fmove.s    (a0),fp0
  1675.     fcmp.s    #$.00000000,fp0
  1676.     fbne.b    L210
  1677. L207
  1678.     lea    $2C(a2),a0
  1679.     fmove.s    (a0),fp0
  1680.     fcmp.s    #$.00000000,fp0
  1681.     fbne.b    L210
  1682. L208
  1683.     lea    $3C(a2),a0
  1684.     fmove.s    (a0),fp0
  1685.     fcmp.s    #$.3F800000,fp0
  1686.     fbne.b    L210
  1687. L209
  1688. ;      ctx->TextureMatrixType = MATRIX_3D;
  1689.     move.l    $8(a5),a0
  1690.     move.l    #6,$1B52(a0)
  1691.     bra.b    L211
  1692. L210
  1693. ;      ctx->TextureMatrixType = MATRIX_GENERAL;
  1694.     move.l    $8(a5),a0
  1695.     clr.l    $1B52(a0)
  1696. L211
  1697. ;   ctx->NewTextureMatrix = GL_FALSE;
  1698.     move.l    $8(a5),a0
  1699.     clr.b    $1B50(a0)
  1700.     move.l    (a7)+,a2
  1701.     unlk    a5
  1702.     rts
  1703.  
  1704.     SECTION "_gl_Frustum:0",CODE
  1705.  
  1706.  
  1707. ;void gl_Frustum( GLcontext *ctx,
  1708.     XDEF    _gl_Frustum
  1709. _gl_Frustum
  1710. L220    EQU    -$64
  1711.     link    a5,#L220
  1712.     move.l    a2,-(a7)
  1713.     fmovem.x fp2/fp3/fp4/fp5/fp6,-(a7)
  1714.     move.l    $8(a5),a2
  1715.     fmove.d    $2C(a5),fp2
  1716.     fmove.d    $34(a5),fp3
  1717.     fmove.d    $24(a5),fp4
  1718.     fmove.d    $14(a5),fp5
  1719. L214
  1720. ;   if (nearval<=0.0 || farval<=0.0) 
  1721.     fcmp.d    #$.00000000.00000000,fp2
  1722.     fbole.b    L216
  1723. L215
  1724.     fcmp.d    #$.00000000.00000000,fp3
  1725.     fbogt.b    L217
  1726. L216
  1727. ;      gl_error( ctx,  GL_INVALID_VALUE, "glFrustum(near or far)
  1728.     move.l    #L213,-(a7)
  1729.     pea    $501.w
  1730.     move.l    a2,-(a7)
  1731.     jsr    _gl_error
  1732.     add.w    #$C,a7
  1733. L217
  1734. ;   x = (2.0*nearval) / (right-left);
  1735.     fmove.x    fp2,fp0
  1736.     fmul.d    #$.40000000.00000000,fp0
  1737.     fmove.x    fp5,fp1
  1738.     fsub.d    $C(a5),fp1
  1739.     fdiv.x    fp1,fp0
  1740.     fmove.s    fp0,-4(a5)
  1741. ;   y = (2.0*nearval) / (top-bottom);
  1742.     fmove.x    fp2,fp0
  1743.     fmul.d    #$.40000000.00000000,fp0
  1744.     fmove.x    fp4,fp1
  1745.     fsub.d    $1C(a5),fp1
  1746.     fdiv.x    fp1,fp0
  1747.     fmove.s    fp0,-$8(a5)
  1748. ;   a = (right+left) / (right-left);
  1749.     fmove.x    fp5,fp0
  1750.     fadd.d    $C(a5),fp0
  1751.     fsub.d    $C(a5),fp5
  1752.     fdiv.x    fp5,fp0
  1753.     fmove.s    fp0,-$C(a5)
  1754. ;   b = (top+bottom) / (top-bottom);
  1755.     fmove.x    fp4,fp0
  1756.     fadd.d    $1C(a5),fp0
  1757.     fsub.d    $1C(a5),fp4
  1758.     fdiv.x    fp4,fp0
  1759.     fmove.x    fp0,fp5
  1760. ;   c = -(farval+nearval) / ( farval-nearval);
  1761.     fmove.x    fp3,fp0
  1762.     fadd.x    fp2,fp0
  1763.     fneg.d    fp0
  1764.     fmove.x    fp3,fp1
  1765.     fsub.x    fp2,fp1
  1766.     fdiv.x    fp1,fp0
  1767.     fmove.x    fp0,fp4
  1768. ;   d = -(2.0*farval*nearval) / (farval-nearval);
  1769.     fmove.x    fp3,fp0
  1770.     fmul.d    #$.40000000.00000000,fp0
  1771.     fmul.x    fp2,fp0
  1772.     fneg.d    fp0
  1773.     fmove.x    fp3,fp1
  1774.     fsub.x    fp2,fp1
  1775.     fdiv.x    fp1,fp0
  1776. ;   M(0,0) = x;
  1777.     lea    -$58(a5),a0
  1778.     move.l    -4(a5),(a0)
  1779. ;     M(0,1) = 0.0F;
  1780.     lea    -$58(a5),a0
  1781.     add.w    #$10,a0
  1782.     clr.l    (a0)
  1783. ;  M(0,2) = a;
  1784.     lea    -$58(a5),a0
  1785.     add.w    #$20,a0
  1786.     move.l    -$C(a5),(a0)
  1787. ;      M(0,3) = 0.0F;
  1788.     lea    -$58(a5),a0
  1789.     add.w    #$30,a0
  1790.     clr.l    (a0)
  1791. ;   M(1,0) = 0.0F;
  1792.     lea    -$58(a5),a0
  1793.     addq.w    #4,a0
  1794.     clr.l    (a0)
  1795. ;  M(1,1) = y;
  1796.     lea    -$58(a5),a0
  1797.     add.w    #$14,a0
  1798.     move.l    -$8(a5),(a0)
  1799. ;     M(1,2) = b;
  1800.     lea    -$58(a5),a0
  1801.     add.w    #$24,a0
  1802.     fmove.s    fp5,(a0)
  1803. ;      M(1,3) = 0.0F;
  1804.     lea    -$58(a5),a0
  1805.     add.w    #$34,a0
  1806.     clr.l    (a0)
  1807. ;   M(2,0) = 0.0F;
  1808.     lea    -$58(a5),a0
  1809.     addq.w    #$8,a0
  1810.     clr.l    (a0)
  1811. ;  M(2,1) = 0.0F;
  1812.     lea    -$58(a5),a0
  1813.     add.w    #$18,a0
  1814.     clr.l    (a0)
  1815. ;  M(2,2) = c;
  1816.     lea    -$58(a5),a0
  1817.     add.w    #$28,a0
  1818.     fmove.s    fp4,(a0)
  1819. ;      M(2,3) = d;
  1820.     lea    -$58(a5),a0
  1821.     add.w    #$38,a0
  1822.     fmove.s    fp0,(a0)
  1823. ;   M(3,0) = 0.0F;
  1824.     lea    -$58(a5),a0
  1825.     add.w    #$C,a0
  1826.     clr.l    (a0)
  1827. ;  M(3,1) = 0.0F;
  1828.     lea    -$58(a5),a0
  1829.     add.w    #$1C,a0
  1830.     clr.l    (a0)
  1831. ;  M(3,2) = -1.0F;
  1832.     lea    -$58(a5),a0
  1833.     add.w    #$2C,a0
  1834.     move.l    #$BF800000,(a0)
  1835. ;  M(3,3) = 0.0F;
  1836.     lea    -$58(a5),a0
  1837.     add.w    #$3C,a0
  1838.     clr.l    (a0)
  1839. ;   gl_MultMatrixf( ctx, m );
  1840.     lea    -$58(a5),a0
  1841.     move.l    a0,-(a7)
  1842.     move.l    a2,-(a7)
  1843.     jsr    _gl_MultMatrixf
  1844.     addq.w    #$8,a7
  1845. ;   ctx->NearFarStack[ctx->ProjectionStackDepth][0] = nearval;
  1846.     fmove.x    fp2,fp0
  1847.     lea    $1A50(a2),a0
  1848.     move.l    $124C(a2),d0
  1849.     lea    0(a0,d0.l*8),a0
  1850.     fmove.s    fp0,(a0)
  1851. ;   ctx->NearFarStack[ctx->ProjectionStackDepth][1] = farval;
  1852.     fmove.x    fp3,fp0
  1853.     lea    $1A50(a2),a0
  1854.     move.l    $124C(a2),d0
  1855.     lea    0(a0,d0.l*8),a0
  1856.     addq.w    #4,a0
  1857.     fmove.s    fp0,(a0)
  1858. ;   if (ctx->Driver.NearFar) 
  1859.     lea    $8A0(a2),a0
  1860.     move.l    $70(a0),a0
  1861.     cmp.w    #0,a0
  1862.     beq.b    L219
  1863. L218
  1864. ;      (*ctx->Driver.NearFar)( ctx, nearval, farval );
  1865.     fmove.x    fp3,fp0
  1866.     fmove.s    fp0,-(a7)
  1867.     fmove.x    fp2,fp0
  1868.     fmove.s    fp0,-(a7)
  1869.     move.l    a2,-(a7)
  1870.     lea    $8A0(a2),a0
  1871.     move.l    $70(a0),a0
  1872.     jsr    (a0)
  1873.     add.w    #$C,a7
  1874. L219
  1875.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  1876.     move.l    (a7)+,a2
  1877.     unlk    a5
  1878.     rts
  1879.  
  1880. L213
  1881.     dc.b    'glFrustum(near or far)',0
  1882.  
  1883.     SECTION "_gl_Ortho:0",CODE
  1884.  
  1885.  
  1886. ;void gl_Ortho( GLcontext *ctx,
  1887.     XDEF    _gl_Ortho
  1888. _gl_Ortho
  1889. L224    EQU    -$68
  1890.     link    a5,#L224
  1891.     move.l    a2,-(a7)
  1892.     fmovem.x fp2/fp3/fp4/fp5/fp6,-(a7)
  1893.     move.l    $8(a5),a2
  1894.     fmove.d    $24(a5),fp1
  1895.     fmove.d    $14(a5),fp2
  1896.     fmove.d    $2C(a5),fp3
  1897.     fmove.d    $34(a5),fp4
  1898.     fmove.d    $1C(a5),fp5
  1899. L221
  1900. ;   x = 2.0 / (right-left);
  1901.     fmove.x    fp2,fp0
  1902.     fsub.d    $C(a5),fp0
  1903.     fmove.d    #$.40000000.00000000,fp6
  1904.     fdiv.x    fp0,fp6
  1905.     fmove.x    fp6,fp0
  1906.     fmove.s    fp0,-4(a5)
  1907. ;   y = 2.0 / (top-bottom);
  1908.     fmove.x    fp1,fp0
  1909.     fsub.x    fp5,fp0
  1910.     fmove.d    #$.40000000.00000000,fp6
  1911.     fdiv.x    fp0,fp6
  1912.     fmove.x    fp6,fp0
  1913.     fmove.s    fp0,-$8(a5)
  1914. ;   z = -2.0 / (farval-nearval);
  1915.     fmove.x    fp4,fp0
  1916.     fsub.x    fp3,fp0
  1917.     fmove.d    #$.C0000000.00000000,fp6
  1918.     fdiv.x    fp0,fp6
  1919.     fmove.x    fp6,fp0
  1920.     fmove.s    fp0,-$C(a5)
  1921. ;   tx = -(right+left) / (right-left);
  1922.     fmove.x    fp2,fp0
  1923.     fadd.d    $C(a5),fp0
  1924.     fneg.d    fp0
  1925.     fsub.d    $C(a5),fp2
  1926.     fdiv.x    fp2,fp0
  1927.     fmove.s    fp0,-$10(a5)
  1928. ;   ty = -(top+bottom) / (top-bottom);
  1929.     fmove.x    fp1,fp0
  1930.     fadd.x    fp5,fp0
  1931.     fneg.d    fp0
  1932.     fsub.x    fp5,fp1
  1933.     fdiv.x    fp1,fp0
  1934.     fmove.x    fp0,fp2
  1935. ;   tz = -(farval+nearval) / (farval-nearval);
  1936.     fmove.x    fp4,fp0
  1937.     fadd.x    fp3,fp0
  1938.     fneg.d    fp0
  1939.     fmove.x    fp4,fp1
  1940.     fsub.x    fp3,fp1
  1941.     fdiv.x    fp1,fp0
  1942. ;   M(0,0) = x;
  1943.     lea    -$58(a5),a0
  1944.     move.l    -4(a5),(a0)
  1945. ;     M(0,1) = 0.0F;
  1946.     lea    -$58(a5),a0
  1947.     add.w    #$10,a0
  1948.     clr.l    (a0)
  1949. ;  M(0,2) = 0.0F;
  1950.     lea    -$58(a5),a0
  1951.     add.w    #$20,a0
  1952.     clr.l    (a0)
  1953. ;  M(0,3) = tx;
  1954.     lea    -$58(a5),a0
  1955.     add.w    #$30,a0
  1956.     move.l    -$10(a5),(a0)
  1957. ;   M(1,0) = 0.0F;
  1958.     lea    -$58(a5),a0
  1959.     addq.w    #4,a0
  1960.     clr.l    (a0)
  1961. ;  M(1,1) = y;
  1962.     lea    -$58(a5),a0
  1963.     add.w    #$14,a0
  1964.     move.l    -$8(a5),(a0)
  1965. ;     M(1,2) = 0.0F;
  1966.     lea    -$58(a5),a0
  1967.     add.w    #$24,a0
  1968.     clr.l    (a0)
  1969. ;  M(1,3) = ty;
  1970.     lea    -$58(a5),a0
  1971.     add.w    #$34,a0
  1972.     fmove.s    fp2,(a0)
  1973. ;   M(2,0) = 0.0F;
  1974.     lea    -$58(a5),a0
  1975.     addq.w    #$8,a0
  1976.     clr.l    (a0)
  1977. ;  M(2,1) = 0.0F;
  1978.     lea    -$58(a5),a0
  1979.     add.w    #$18,a0
  1980.     clr.l    (a0)
  1981. ;  M(2,2) = z;
  1982.     lea    -$58(a5),a0
  1983.     add.w    #$28,a0
  1984.     move.l    -$C(a5),(a0)
  1985. ;     M(2,3) = tz;
  1986.     lea    -$58(a5),a0
  1987.     add.w    #$38,a0
  1988.     fmove.s    fp0,(a0)
  1989. ;   M(3,0) = 0.0F;
  1990.     lea    -$58(a5),a0
  1991.     add.w    #$C,a0
  1992.     clr.l    (a0)
  1993. ;  M(3,1) = 0.0F;
  1994.     lea    -$58(a5),a0
  1995.     add.w    #$1C,a0
  1996.     clr.l    (a0)
  1997. ;  M(3,2) = 0.0F;
  1998.     lea    -$58(a5),a0
  1999.     add.w    #$2C,a0
  2000.     clr.l    (a0)
  2001. ;  M(3,3) = 1.0F;
  2002.     lea    -$58(a5),a0
  2003.     add.w    #$3C,a0
  2004.     move.l    #$3F800000,(a0)
  2005. ;   gl_MultMatrixf( ctx, m );
  2006.     lea    -$58(a5),a0
  2007.     move.l    a0,-(a7)
  2008.     move.l    a2,-(a7)
  2009.     jsr    _gl_MultMatrixf
  2010.     addq.w    #$8,a7
  2011. ;   if (ctx->Driver.NearFar) 
  2012.     lea    $8A0(a2),a0
  2013.     move.l    $70(a0),a0
  2014.     cmp.w    #0,a0
  2015.     beq.b    L223
  2016. L222
  2017. ;      (*ctx->Driver.NearFar)( ctx, nearval, farval );
  2018.     fmove.x    fp4,fp0
  2019.     fmove.s    fp0,-(a7)
  2020.     fmove.x    fp3,fp0
  2021.     fmove.s    fp0,-(a7)
  2022.     move.l    a2,-(a7)
  2023.     lea    $8A0(a2),a0
  2024.     move.l    $70(a0),a0
  2025.     jsr    (a0)
  2026.     add.w    #$C,a7
  2027. L223
  2028.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  2029.     move.l    (a7)+,a2
  2030.     unlk    a5
  2031.     rts
  2032.  
  2033.     SECTION "_gl_MatrixMode:0",CODE
  2034.  
  2035.  
  2036. ;void gl_MatrixMode( GLcontext *ctx, GLenum mode )
  2037.     XDEF    _gl_MatrixMode
  2038. _gl_MatrixMode
  2039.     move.l    $8(a7),d0
  2040.     move.l    4(a7),a0
  2041. L226
  2042. ;   if (INSIDE_BEGIN_END(ctx)) 
  2043.     move.l    a0,a1
  2044.     add.l    #$E08A,a1
  2045.     move.l    (a1),d1
  2046.     cmp.l    #$1A00,d1
  2047.     beq.b    L228
  2048. L227
  2049. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glMatrixMode" );
  2050.     move.l    #L225,-(a7)
  2051.     pea    $502.w
  2052.     move.l    a0,-(a7)
  2053.     jsr    _gl_error
  2054.     add.w    #$C,a7
  2055.     rts
  2056. L228
  2057. ;   switch (mode)
  2058.     move.l    d0,d1
  2059.     cmp.l    #$1701,d1
  2060.     beq.b    L229
  2061.     bgt.b    L232
  2062.     cmp.l    #$1700,d1
  2063.     beq.b    L229
  2064.     bra.b    L230
  2065. L232
  2066.     cmp.l    #$1702,d1
  2067.     beq.b    L229
  2068.     bra.b    L230
  2069. ;      
  2070. L229
  2071. ;     ctx->Transform.MatrixMode = mode;
  2072.     add.l    #$DC12,a0
  2073.     move.l    d0,(a0)
  2074. ;     
  2075.     bra.b    L231
  2076. L230
  2077. ;     gl_error( ctx,  GL_INVALID_ENUM, "glMatrixMode" );
  2078.     move.l    #L225,-(a7)
  2079.     pea    $500.w
  2080.     move.l    a0,-(a7)
  2081.     jsr    _gl_error
  2082.     add.w    #$C,a7
  2083. L231
  2084.     rts
  2085.  
  2086. L225
  2087.     dc.b    'glMatrixMode',0
  2088.  
  2089.     SECTION "_gl_PushMatrix:0",CODE
  2090.  
  2091.  
  2092. ;void gl_PushMatrix( GLcontext *ctx )
  2093.     XDEF    _gl_PushMatrix
  2094. _gl_PushMatrix
  2095.     move.l    a2,-(a7)
  2096.     move.l    $8(a7),a2
  2097. L235
  2098. ;   if (INSIDE_BEGIN_END(ctx)) 
  2099.     move.l    a2,a0
  2100.     add.l    #$E08A,a0
  2101.     move.l    (a0),d0
  2102.     cmp.l    #$1A00,d0
  2103.     beq.b    L237
  2104. L236
  2105. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glPushMatrix" );
  2106.     move.l    #L233,-(a7)
  2107.     pea    $502.w
  2108.     move.l    a2,-(a7)
  2109.     jsr    _gl_error
  2110.     add.w    #$C,a7
  2111.     move.l    (a7)+,a2
  2112.     rts
  2113. L237
  2114. ;   switch (ctx->Transform.MatrixMode)
  2115.     move.l    a2,a0
  2116.     add.l    #$DC12,a0
  2117.     lea    (a0),a0
  2118.     move.l    (a0),d0
  2119.     cmp.l    #$1701,d0
  2120.     beq.b    L241
  2121.     bgt.b    L249
  2122.     cmp.l    #$1700,d0
  2123.     beq.b    L238
  2124.     bra    L247
  2125. L249
  2126.     cmp.l    #$1702,d0
  2127.     beq    L244
  2128.     bra    L247
  2129. ;      
  2130. L238
  2131. ;     if (ctx->ModelViewStackDepth>=MAX_MODELVIEW_STACK_DEPTH-1) 
  2132.     move.l    $A02(a2),d0
  2133.     cmp.l    #$1F,d0
  2134.     blo.b    L240
  2135. L239
  2136. ;        gl_error( ctx,  GL_STACK_OVERFLOW, "glPushMatrix");
  2137.     move.l    #L233,-(a7)
  2138.     pea    $503.w
  2139.     move.l    a2,-(a7)
  2140.     jsr    _gl_error
  2141.     add.w    #$C,a7
  2142.     move.l    (a7)+,a2
  2143.     rts
  2144. L240
  2145. ;         16*sizeof(GLfloat) );
  2146.     pea    $40.w
  2147.     lea    $982(a2),a0
  2148.     move.l    a0,-(a7)
  2149.     lea    $A06(a2),a0
  2150.     move.l    $A02(a2),d0
  2151.     asl.l    #6,d0
  2152.     add.l    d0,a0
  2153.     move.l    a0,-(a7)
  2154.     jsr    _memcpy
  2155.     add.w    #$C,a7
  2156. ;     ctx->ModelViewStackDepth++;
  2157.     move.l    $A02(a2),d0
  2158.     addq.l    #1,d0
  2159.     move.l    d0,$A02(a2)
  2160. ;     
  2161.     bra    L248
  2162. L241
  2163. ;     if (ctx->ProjectionStackDepth>=MAX_PROJECTION_STACK_DEPTH) 
  2164.     move.l    $124C(a2),d0
  2165.     cmp.l    #$20,d0
  2166.     blo.b    L243
  2167. L242
  2168. ;        gl_error( ctx,  GL_STACK_OVERFLOW, "glPushMatrix");
  2169.     move.l    #L233,-(a7)
  2170.     pea    $503.w
  2171.     move.l    a2,-(a7)
  2172.     jsr    _gl_error
  2173.     add.w    #$C,a7
  2174.     move.l    (a7)+,a2
  2175.     rts
  2176. L243
  2177. ;         16*sizeof(GLfloat) );
  2178.     pea    $40.w
  2179.     lea    $120C(a2),a0
  2180.     move.l    a0,-(a7)
  2181.     lea    $1250(a2),a0
  2182.     move.l    $124C(a2),d0
  2183.     asl.l    #6,d0
  2184.     add.l    d0,a0
  2185.     move.l    a0,-(a7)
  2186.     jsr    _memcpy
  2187.     add.w    #$C,a7
  2188. ;     ctx->ProjectionStackDepth++;
  2189.     move.l    $124C(a2),d0
  2190.     addq.l    #1,d0
  2191.     move.l    d0,$124C(a2)
  2192. ;     ctx->NearFarStack[ctx->ProjectionStackDepth][0]
  2193.     lea    $1A50(a2),a0
  2194.     move.l    $124C(a2),d0
  2195.     subq.l    #1,d0
  2196.     lea    0(a0,d0.l*8),a0
  2197.     fmove.s    (a0),fp0
  2198.     lea    $1A50(a2),a0
  2199.     move.l    $124C(a2),d0
  2200.     lea    0(a0,d0.l*8),a0
  2201.     fmove.s    fp0,(a0)
  2202. ;     ctx->NearFarStack[ctx->ProjectionStackDepth][1]
  2203.     lea    $1A50(a2),a0
  2204.     move.l    $124C(a2),d0
  2205.     subq.l    #1,d0
  2206.     lea    0(a0,d0.l*8),a0
  2207.     addq.w    #4,a0
  2208.     fmove.s    (a0),fp0
  2209.     lea    $1A50(a2),a0
  2210.     move.l    $124C(a2),d0
  2211.     lea    0(a0,d0.l*8),a0
  2212.     addq.w    #4,a0
  2213.     fmove.s    fp0,(a0)
  2214. ;     
  2215.     bra.b    L248
  2216. L244
  2217. ;     if (ctx->TextureStackDepth>=MAX_TEXTURE_STACK_DEPTH) 
  2218.     move.l    $1B96(a2),d0
  2219.     cmp.l    #$A,d0
  2220.     blo.b    L246
  2221. L245
  2222. ;        gl_error( ctx,  GL_STACK_OVERFLOW, "glPushMatrix");
  2223.     move.l    #L233,-(a7)
  2224.     pea    $503.w
  2225.     move.l    a2,-(a7)
  2226.     jsr    _gl_error
  2227.     add.w    #$C,a7
  2228.     move.l    (a7)+,a2
  2229.     rts
  2230. L246
  2231. ;         16*sizeof(GLfloat) );
  2232.     pea    $40.w
  2233.     lea    $1B56(a2),a0
  2234.     move.l    a0,-(a7)
  2235.     lea    $1B9A(a2),a0
  2236.     move.l    $1B96(a2),d0
  2237.     asl.l    #6,d0
  2238.     add.l    d0,a0
  2239.     move.l    a0,-(a7)
  2240.     jsr    _memcpy
  2241.     add.w    #$C,a7
  2242. ;     ctx->TextureStackDepth++;
  2243.     move.l    $1B96(a2),d0
  2244.     addq.l    #1,d0
  2245.     move.l    d0,$1B96(a2)
  2246. ;     
  2247.     bra.b    L248
  2248. L247
  2249. ;     gl_problem(ctx, "Bad matrix mode in gl_PushMatrix");
  2250.     move.l    #L234,-(a7)
  2251.     move.l    a2,-(a7)
  2252.     jsr    _gl_problem
  2253.     addq.w    #$8,a7
  2254. L248
  2255.     move.l    (a7)+,a2
  2256.     rts
  2257.  
  2258. L234
  2259.     dc.b    'Bad matrix mode in gl_PushMatrix',0
  2260. L233
  2261.     dc.b    'glPushMatrix',0
  2262.  
  2263.     SECTION "_gl_PopMatrix:0",CODE
  2264.  
  2265.  
  2266. ;void gl_PopMatrix( GLcontext *ctx )
  2267.     XDEF    _gl_PopMatrix
  2268. _gl_PopMatrix
  2269.     move.l    a2,-(a7)
  2270.     move.l    $8(a7),a2
  2271. L252
  2272. ;   if (INSIDE_BEGIN_END(ctx)) 
  2273.     move.l    a2,a0
  2274.     add.l    #$E08A,a0
  2275.     move.l    (a0),d0
  2276.     cmp.l    #$1A00,d0
  2277.     beq.b    L254
  2278. L253
  2279. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glPopMatrix" );
  2280.     move.l    #L250,-(a7)
  2281.     pea    $502.w
  2282.     move.l    a2,-(a7)
  2283.     jsr    _gl_error
  2284.     add.w    #$C,a7
  2285.     move.l    (a7)+,a2
  2286.     rts
  2287. L254
  2288. ;   switch (ctx->Transform.MatrixMode)
  2289.     move.l    a2,a0
  2290.     add.l    #$DC12,a0
  2291.     lea    (a0),a0
  2292.     move.l    (a0),d0
  2293.     cmp.l    #$1701,d0
  2294.     beq.b    L258
  2295.     bgt.b    L268
  2296.     cmp.l    #$1700,d0
  2297.     beq.b    L255
  2298.     bra    L266
  2299. L268
  2300.     cmp.l    #$1702,d0
  2301.     beq    L263
  2302.     bra    L266
  2303. ;      
  2304. L255
  2305. ;     if (ctx->ModelViewStackDepth==0) 
  2306.     move.l    $A02(a2),d0
  2307.     bne.b    L257
  2308. L256
  2309. ;        gl_error( ctx,  GL_STACK_UNDERFLOW, "glPopMatrix");
  2310.     move.l    #L250,-(a7)
  2311.     pea    $504.w
  2312.     move.l    a2,-(a7)
  2313.     jsr    _gl_error
  2314.     add.w    #$C,a7
  2315.     move.l    (a7)+,a2
  2316.     rts
  2317. L257
  2318. ;     ctx->ModelViewStackDepth--;
  2319.     move.l    $A02(a2),d0
  2320.     subq.l    #1,d0
  2321.     move.l    d0,$A02(a2)
  2322. ;         16*sizeof(GLfloat) );
  2323.     pea    $40.w
  2324.     lea    $A06(a2),a0
  2325.     move.l    $A02(a2),d0
  2326.     asl.l    #6,d0
  2327.     add.l    d0,a0
  2328.     move.l    a0,-(a7)
  2329.     lea    $982(a2),a0
  2330.     move.l    a0,-(a7)
  2331.     jsr    _memcpy
  2332.     add.w    #$C,a7
  2333. ;     ctx->NewModelViewMatrix = GL_TRUE;
  2334.     move.b    #1,$97C(a2)
  2335. ;     
  2336.     bra    L267
  2337. L258
  2338. ;     if (ctx->ProjectionStackDepth==0) 
  2339.     move.l    $124C(a2),d0
  2340.     bne.b    L260
  2341. L259
  2342. ;        gl_error( ctx,  GL_STACK_UNDERFLOW, "glPopMatrix");
  2343.     move.l    #L250,-(a7)
  2344.     pea    $504.w
  2345.     move.l    a2,-(a7)
  2346.     jsr    _gl_error
  2347.     add.w    #$C,a7
  2348.     move.l    (a7)+,a2
  2349.     rts
  2350. L260
  2351. ;     ctx->ProjectionStackDepth--;
  2352.     move.l    $124C(a2),d0
  2353.     subq.l    #1,d0
  2354.     move.l    d0,$124C(a2)
  2355. ;         16*sizeof(GLfloat) );
  2356.     pea    $40.w
  2357.     lea    $1250(a2),a0
  2358.     move.l    $124C(a2),d0
  2359.     asl.l    #6,d0
  2360.     add.l    d0,a0
  2361.     move.l    a0,-(a7)
  2362.     lea    $120C(a2),a0
  2363.     move.l    a0,-(a7)
  2364.     jsr    _memcpy
  2365.     add.w    #$C,a7
  2366. ;     ctx->NewProjectionMatrix = GL_TRUE;
  2367.     move.b    #1,$1206(a2)
  2368. ;        GLfloat nearVal = ctx->NearFarStack[ctx->ProjectionStackDe
  2369.     lea    $1A50(a2),a0
  2370.     move.l    $124C(a2),d0
  2371.     lea    0(a0,d0.l*8),a0
  2372.     fmove.s    (a0),fp1
  2373. ;        GLfloat farVal  = ctx->NearFarStack[ctx->ProjectionStackDe
  2374.     lea    $1A50(a2),a0
  2375.     move.l    $124C(a2),d0
  2376.     lea    0(a0,d0.l*8),a0
  2377.     addq.w    #4,a0
  2378.     fmove.s    (a0),fp0
  2379. ;        if (ctx->Driver.NearFar) 
  2380.     lea    $8A0(a2),a0
  2381.     move.l    $70(a0),a0
  2382.     cmp.w    #0,a0
  2383.     beq.b    L262
  2384. L261
  2385. ;           (*ctx->Driver.NearFar)( ctx, nearVal, farVal );
  2386.     fmove.s    fp0,-(a7)
  2387.     fmove.s    fp1,-(a7)
  2388.     move.l    a2,-(a7)
  2389.     lea    $8A0(a2),a0
  2390.     move.l    $70(a0),a0
  2391.     jsr    (a0)
  2392.     add.w    #$C,a7
  2393. L262
  2394. ;     
  2395.     bra.b    L267
  2396. L263
  2397. ;     if (ctx->TextureStackDepth==0) 
  2398.     move.l    $1B96(a2),d0
  2399.     bne.b    L265
  2400. L264
  2401. ;        gl_error( ctx,  GL_STACK_UNDERFLOW, "glPopMatrix");
  2402.     move.l    #L250,-(a7)
  2403.     pea    $504.w
  2404.     move.l    a2,-(a7)
  2405.     jsr    _gl_error
  2406.     add.w    #$C,a7
  2407.     move.l    (a7)+,a2
  2408.     rts
  2409. L265
  2410. ;     ctx->TextureStackDepth--;
  2411.     move.l    $1B96(a2),d0
  2412.     subq.l    #1,d0
  2413.     move.l    d0,$1B96(a2)
  2414. ;         16*sizeof(GLfloat) );
  2415.     pea    $40.w
  2416.     lea    $1B9A(a2),a0
  2417.     move.l    $1B96(a2),d0
  2418.     asl.l    #6,d0
  2419.     add.l    d0,a0
  2420.     move.l    a0,-(a7)
  2421.     lea    $1B56(a2),a0
  2422.     move.l    a0,-(a7)
  2423.     jsr    _memcpy
  2424.     add.w    #$C,a7
  2425. ;     ctx->NewTextureMatrix = GL_TRUE;
  2426.     move.b    #1,$1B50(a2)
  2427. ;     
  2428.     bra.b    L267
  2429. L266
  2430. ;     gl_problem(ctx, "Bad matrix mode in gl_PopMatrix");
  2431.     move.l    #L251,-(a7)
  2432.     move.l    a2,-(a7)
  2433.     jsr    _gl_problem
  2434.     addq.w    #$8,a7
  2435. L267
  2436.     move.l    (a7)+,a2
  2437.     rts
  2438.  
  2439. L251
  2440.     dc.b    'Bad matrix mode in gl_PopMatrix',0
  2441. L250
  2442.     dc.b    'glPopMatrix',0
  2443.  
  2444.     SECTION "_gl_LoadIdentity:0",CODE
  2445.  
  2446.  
  2447. ;void gl_LoadIdentity( GLcontext *ctx )
  2448.     XDEF    _gl_LoadIdentity
  2449. _gl_LoadIdentity
  2450.     move.l    a2,-(a7)
  2451.     move.l    $8(a7),a2
  2452. L271
  2453. ;   if (INSIDE_BEGIN_END(ctx)) 
  2454.     move.l    a2,a0
  2455.     add.l    #$E08A,a0
  2456.     move.l    (a0),d0
  2457.     cmp.l    #$1A00,d0
  2458.     beq.b    L273
  2459. L272
  2460. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glLoadIdentity" );
  2461.     move.l    #L269,-(a7)
  2462.     pea    $502.w
  2463.     move.l    a2,-(a7)
  2464.     jsr    _gl_error
  2465.     add.w    #$C,a7
  2466.     move.l    (a7)+,a2
  2467.     rts
  2468. L273
  2469. ;   switch (ctx->Transform.MatrixMode)
  2470.     move.l    a2,a0
  2471.     add.l    #$DC12,a0
  2472.     lea    (a0),a0
  2473.     move.l    (a0),d0
  2474.     cmp.l    #$1701,d0
  2475.     beq.b    L275
  2476.     bgt.b    L279
  2477.     cmp.l    #$1700,d0
  2478.     beq.b    L274
  2479.     bra    L277
  2480. L279
  2481.     cmp.l    #$1702,d0
  2482.     beq.b    L276
  2483.     bra    L277
  2484. ;      
  2485. L274
  2486. ;ctx->ModelViewMat
  2487.     pea    $40.w
  2488.     move.l    #_Identity,-(a7)
  2489.     lea    $982(a2),a0
  2490.     move.l    a0,-(a7)
  2491.     jsr    _memcpy
  2492.     add.w    #$C,a7
  2493. ;Y( ctx->ModelView
  2494.     pea    $40.w
  2495.     move.l    #_Identity,-(a7)
  2496.     lea    $9C2(a2),a0
  2497.     move.l    a0,-(a7)
  2498.     jsr    _memcpy
  2499.     add.w    #$C,a7
  2500. ;     ctx->ModelViewMatrixType = MATRIX_IDENTITY;
  2501.     move.l    #1,$97E(a2)
  2502. ;     ctx->NewModelViewMatrix = GL_FALSE;
  2503.     clr.b    $97C(a2)
  2504. ;     
  2505.     bra.b    L278
  2506. L275
  2507. ;tx->ProjectionMat
  2508.     pea    $40.w
  2509.     move.l    #_Identity,-(a7)
  2510.     lea    $120C(a2),a0
  2511.     move.l    a0,-(a7)
  2512.     jsr    _memcpy
  2513.     add.w    #$C,a7
  2514. ;     ctx->ProjectionMatrixType = MATRIX_IDENTITY;
  2515.     move.l    #1,$1208(a2)
  2516. ;     ctx->NewProjectionMatrix = GL_FALSE;
  2517.     clr.b    $1206(a2)
  2518. ;     
  2519.     bra.b    L278
  2520. L276
  2521. ;( ctx->TextureMat
  2522.     pea    $40.w
  2523.     move.l    #_Identity,-(a7)
  2524.     lea    $1B56(a2),a0
  2525.     move.l    a0,-(a7)
  2526.     jsr    _memcpy
  2527.     add.w    #$C,a7
  2528. ;     ctx->TextureMatrixType = MATRIX_IDENTITY;
  2529.     move.l    #1,$1B52(a2)
  2530. ;     ctx->NewTextureMatrix = GL_FALSE;
  2531.     clr.b    $1B50(a2)
  2532. ;     
  2533.     bra.b    L278
  2534. L277
  2535. ;     gl_problem(ctx, "Bad matrix mode in gl_LoadIdentity");
  2536.     move.l    #L270,-(a7)
  2537.     move.l    a2,-(a7)
  2538.     jsr    _gl_problem
  2539.     addq.w    #$8,a7
  2540. L278
  2541.     move.l    (a7)+,a2
  2542.     rts
  2543.  
  2544. L270
  2545.     dc.b    'Bad matrix mode in gl_LoadIdentity',0
  2546. L269
  2547.     dc.b    'glLoadIdentity',0
  2548.  
  2549.     SECTION "_gl_LoadMatrixf:0",CODE
  2550.  
  2551.  
  2552. ;void gl_LoadMatrixf( GLcontext *ctx, const GLfloat *m )
  2553.     XDEF    _gl_LoadMatrixf
  2554. _gl_LoadMatrixf
  2555.     move.l    a2,-(a7)
  2556.     move.l    $C(a7),a0
  2557.     move.l    $8(a7),a2
  2558. L282
  2559. ;   if (INSIDE_BEGIN_END(ctx)) 
  2560.     move.l    a2,a1
  2561.     add.l    #$E08A,a1
  2562.     move.l    (a1),d0
  2563.     cmp.l    #$1A00,d0
  2564.     beq.b    L284
  2565. L283
  2566. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glLoadMatrix" );
  2567.     move.l    #L280,-(a7)
  2568.     pea    $502.w
  2569.     move.l    a2,-(a7)
  2570.     jsr    _gl_error
  2571.     add.w    #$C,a7
  2572.     move.l    (a7)+,a2
  2573.     rts
  2574. L284
  2575. ;   switch (ctx->Transform.MatrixMode)
  2576.     move.l    a2,a1
  2577.     add.l    #$DC12,a1
  2578.     lea    (a1),a1
  2579.     move.l    (a1),d0
  2580.     cmp.l    #$1701,d0
  2581.     beq.b    L286
  2582.     bgt.b    L290
  2583.     cmp.l    #$1700,d0
  2584.     beq.b    L285
  2585.     bra.b    L288
  2586. L290
  2587.     cmp.l    #$1702,d0
  2588.     beq.b    L287
  2589.     bra.b    L288
  2590. ;      
  2591. L285
  2592. ;EMCPY( ctx->Model
  2593.     pea    $40.w
  2594.     move.l    a0,-(a7)
  2595.     lea    $982(a2),a0
  2596.     move.l    a0,-(a7)
  2597.     jsr    _memcpy
  2598.     add.w    #$C,a7
  2599. ;     ctx->NewModelViewMatrix = GL_TRUE;
  2600.     move.b    #1,$97C(a2)
  2601. ;     
  2602.     bra.b    L289
  2603. L286
  2604. ;MCPY( ctx->Projec
  2605.     pea    $40.w
  2606.     move.l    a0,-(a7)
  2607.     lea    $120C(a2),a0
  2608.     move.l    a0,-(a7)
  2609.     jsr    _memcpy
  2610.     add.w    #$C,a7
  2611. ;     ctx->NewProjectionMatrix = GL_TRUE;
  2612.     move.b    #1,$1206(a2)
  2613. ;     
  2614.     bra.b    L289
  2615. L287
  2616. ; MEMCPY( ctx->Tex
  2617.     pea    $40.w
  2618.     move.l    a0,-(a7)
  2619.     lea    $1B56(a2),a0
  2620.     move.l    a0,-(a7)
  2621.     jsr    _memcpy
  2622.     add.w    #$C,a7
  2623. ;     ctx->NewTextureMatrix = GL_TRUE;
  2624.     move.b    #1,$1B50(a2)
  2625. ;     
  2626.     bra.b    L289
  2627. L288
  2628. ;     gl_problem(ctx, "Bad matrix mode in gl_LoadMatrixf");
  2629.     move.l    #L281,-(a7)
  2630.     move.l    a2,-(a7)
  2631.     jsr    _gl_problem
  2632.     addq.w    #$8,a7
  2633. L289
  2634.     move.l    (a7)+,a2
  2635.     rts
  2636.  
  2637. L281
  2638.     dc.b    'Bad matrix mode in gl_LoadMatrixf',0
  2639. L280
  2640.     dc.b    'glLoadMatrix',0
  2641.  
  2642.     SECTION "_gl_MultMatrixf:0",CODE
  2643.  
  2644.  
  2645. ;void gl_MultMatrixf( GLcontext *ctx, const GLfloat *m )
  2646.     XDEF    _gl_MultMatrixf
  2647. _gl_MultMatrixf
  2648.     move.l    a2,-(a7)
  2649.     move.l    $C(a7),a0
  2650.     move.l    $8(a7),a2
  2651. L293
  2652. ;   if (INSIDE_BEGIN_END(ctx)) 
  2653.     move.l    a2,a1
  2654.     add.l    #$E08A,a1
  2655.     move.l    (a1),d0
  2656.     cmp.l    #$1A00,d0
  2657.     beq.b    L295
  2658. L294
  2659. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glMultMatrix" );
  2660.     move.l    #L291,-(a7)
  2661.     pea    $502.w
  2662.     move.l    a2,-(a7)
  2663.     jsr    _gl_error
  2664.     add.w    #$C,a7
  2665.     move.l    (a7)+,a2
  2666.     rts
  2667. L295
  2668. ;   switch (ctx->Transform.MatrixMode)
  2669.     move.l    a2,a1
  2670.     add.l    #$DC12,a1
  2671.     lea    (a1),a1
  2672.     move.l    (a1),d0
  2673.     cmp.l    #$1701,d0
  2674.     beq.b    L297
  2675.     bgt.b    L301
  2676.     cmp.l    #$1700,d0
  2677.     beq.b    L296
  2678.     bra.b    L299
  2679. L301
  2680.     cmp.l    #$1702,d0
  2681.     beq.b    L298
  2682.     bra.b    L299
  2683. ;      
  2684. L296
  2685. ;     matmul( ctx->ModelViewMatrix, ctx->ModelViewMatrix, m );
  2686.     move.l    a0,-(a7)
  2687.     lea    $982(a2),a0
  2688.     move.l    a0,-(a7)
  2689.     lea    $982(a2),a0
  2690.     move.l    a0,-(a7)
  2691.     jsr    _matmul
  2692.     add.w    #$C,a7
  2693. ;     ctx->NewModelViewMatrix = GL_TRUE;
  2694.     move.b    #1,$97C(a2)
  2695. ;     
  2696.     bra.b    L300
  2697. L297
  2698. ;     matmul( ctx->ProjectionMatrix, ctx->ProjectionMatrix, m );
  2699.     move.l    a0,-(a7)
  2700.     lea    $120C(a2),a0
  2701.     move.l    a0,-(a7)
  2702.     lea    $120C(a2),a0
  2703.     move.l    a0,-(a7)
  2704.     jsr    _matmul
  2705.     add.w    #$C,a7
  2706. ;     ctx->NewProjectionMatrix = GL_TRUE;
  2707.     move.b    #1,$1206(a2)
  2708. ;     
  2709.     bra.b    L300
  2710. L298
  2711. ;     matmul( ctx->TextureMatrix, ctx->TextureMatrix, m );
  2712.     move.l    a0,-(a7)
  2713.     lea    $1B56(a2),a0
  2714.     move.l    a0,-(a7)
  2715.     lea    $1B56(a2),a0
  2716.     move.l    a0,-(a7)
  2717.     jsr    _matmul
  2718.     add.w    #$C,a7
  2719. ;     ctx->NewTextureMatrix = GL_TRUE;
  2720.     move.b    #1,$1B50(a2)
  2721. ;     
  2722.     bra.b    L300
  2723. L299
  2724. ;     gl_problem(ctx, "Bad matrix mode in gl_MultMatrixf");
  2725.     move.l    #L292,-(a7)
  2726.     move.l    a2,-(a7)
  2727.     jsr    _gl_problem
  2728.     addq.w    #$8,a7
  2729. L300
  2730.     move.l    (a7)+,a2
  2731.     rts
  2732.  
  2733. L292
  2734.     dc.b    'Bad matrix mode in gl_MultMatrixf',0
  2735. L291
  2736.     dc.b    'glMultMatrix',0
  2737.  
  2738.     SECTION "_gl_rotation_matrix:0",CODE
  2739.  
  2740.  
  2741. ;void gl_rotation_matrix( GLfloat angle, GLfloat x, GLfloat y, GLfloa
  2742.     XDEF    _gl_rotation_matrix
  2743. _gl_rotation_matrix
  2744. L305    EQU    -$4C
  2745.     link    a5,#L305
  2746.     move.l    a2,-(a7)
  2747.     fmovem.x fp2/fp3/fp4/fp5/fp6,-(a7)
  2748.     move.l    $18(a5),a2
  2749.     fmove.s    $14(a5),fp2
  2750.     fmove.s    $10(a5),fp3
  2751.     fmove.s    $C(a5),fp4
  2752.     fmove.s    $8(a5),fp5
  2753. L302
  2754. ;   s = sin( angle * DEG2RAD );
  2755.     fmove.x    fp5,fp0
  2756.     fmul.d    #$.3F91DF46.9D353915,fp0
  2757.     fmove.d    fp0,-(a7)
  2758.     jsr    _sin__r
  2759.     addq.w    #$8,a7
  2760.     fmove.s    fp0,-$8(a5)
  2761. ;   c = cos( angle * DEG2RAD );
  2762.     fmove.x    fp5,fp0
  2763.     fmul.d    #$.3F91DF46.9D353915,fp0
  2764.     fmove.d    fp0,-(a7)
  2765.     jsr    _cos__r
  2766.     addq.w    #$8,a7
  2767.     fmove.x    fp0,fp5
  2768. ;   mag = GL_SQRT( x*x + y*y + z*z );
  2769.     fmove.x    fp4,fp0
  2770.     fmul.x    fp4,fp0
  2771.     fmove.x    fp3,fp1
  2772.     fmul.x    fp3,fp1
  2773.     fadd.x    fp1,fp0
  2774.     fmove.x    fp2,fp1
  2775.     fmul.x    fp2,fp1
  2776.     fadd.x    fp1,fp0
  2777.     fmove.d    fp0,-(a7)
  2778.     jsr    _sqrt__r
  2779.     addq.w    #$8,a7
  2780. ;   if (mag == 0.0) 
  2781.     fmove.x    fp0,fp1
  2782.     ftst.d    fp1
  2783.     fbne.b    L304
  2784. L303
  2785. ;      MEMCPY(m, Identity
  2786.     pea    $40.w
  2787.     move.l    #_Identity,-(a7)
  2788.     move.l    a2,-(a7)
  2789.     jsr    _memcpy
  2790.     add.w    #$C,a7
  2791.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  2792.     move.l    (a7)+,a2
  2793.     unlk    a5
  2794.     rts
  2795. L304
  2796. ;   x /= mag;
  2797.     fdiv.x    fp0,fp4
  2798. ;   y /= mag;
  2799.     fdiv.x    fp0,fp3
  2800. ;   z /= mag;
  2801.     fdiv.x    fp0,fp2
  2802. ;   xx = x * x;
  2803.     fmove.x    fp4,fp1
  2804.     fmul.x    fp4,fp1
  2805. ;   yy = y * y;
  2806.     fmove.x    fp3,fp0
  2807.     fmul.x    fp3,fp0
  2808.     fmove.s    fp0,-$14(a5)
  2809. ;   zz = z * z;
  2810.     fmove.x    fp2,fp0
  2811.     fmul.x    fp2,fp0
  2812.     fmove.s    fp0,-$18(a5)
  2813. ;   xy = x * y;
  2814.     fmove.x    fp4,fp0
  2815.     fmul.x    fp3,fp0
  2816.     fmove.s    fp0,-$1C(a5)
  2817. ;   yz = y * z;
  2818.     fmove.x    fp3,fp0
  2819.     fmul.x    fp2,fp0
  2820.     fmove.s    fp0,-$20(a5)
  2821. ;   zx = z * x;
  2822.     fmove.x    fp2,fp0
  2823.     fmul.x    fp4,fp0
  2824.     fmove.s    fp0,-$24(a5)
  2825. ;   xs = x * s;
  2826.     fmul.s    -$8(a5),fp4
  2827. ;   ys = y * s;
  2828.     fmul.s    -$8(a5),fp3
  2829. ;   zs = z * s;
  2830.     fmul.s    -$8(a5),fp2
  2831. ;   one_c = 1.0F - c;
  2832.     fmove.s    #$.3F800000,fp0
  2833.     fsub.x    fp5,fp0
  2834. ;   M(0,0) = (one_c * xx) + c;
  2835.     fmul.x    fp0,fp1
  2836.     fadd.x    fp5,fp1
  2837.     fmove.s    fp1,(a2)
  2838. ;   M(0,1) = (one_c * xy) - zs;
  2839.     fmove.x    fp0,fp1
  2840.     fmul.s    -$1C(a5),fp1
  2841.     fsub.x    fp2,fp1
  2842.     lea    $10(a2),a0
  2843.     fmove.s    fp1,(a0)
  2844. ;   M(0,2) = (one_c * zx) + ys;
  2845.     fmove.x    fp0,fp1
  2846.     fmul.s    -$24(a5),fp1
  2847.     fadd.x    fp3,fp1
  2848.     lea    $20(a2),a0
  2849.     fmove.s    fp1,(a0)
  2850. ;   M(0,3) = 0.0F;
  2851.     lea    $30(a2),a0
  2852.     clr.l    (a0)
  2853. ;   M(1,0) = (one_c * xy) + zs;
  2854.     fmove.x    fp0,fp1
  2855.     fmul.s    -$1C(a5),fp1
  2856.     fadd.x    fp2,fp1
  2857.     lea    4(a2),a0
  2858.     fmove.s    fp1,(a0)
  2859. ;   M(1,1) = (one_c * yy) + c;
  2860.     fmove.x    fp0,fp1
  2861.     fmul.s    -$14(a5),fp1
  2862.     fadd.x    fp5,fp1
  2863.     lea    $14(a2),a0
  2864.     fmove.s    fp1,(a0)
  2865. ;   M(1,2) = (one_c * yz) - xs;
  2866.     fmove.x    fp0,fp1
  2867.     fmul.s    -$20(a5),fp1
  2868.     fsub.x    fp4,fp1
  2869.     lea    $24(a2),a0
  2870.     fmove.s    fp1,(a0)
  2871. ;   M(1,3) = 0.0F;
  2872.     lea    $34(a2),a0
  2873.     clr.l    (a0)
  2874. ;   M(2,0) = (one_c * zx) - ys;
  2875.     fmove.x    fp0,fp1
  2876.     fmul.s    -$24(a5),fp1
  2877.     fsub.x    fp3,fp1
  2878.     lea    $8(a2),a0
  2879.     fmove.s    fp1,(a0)
  2880. ;   M(2,1) = (one_c * yz) + xs;
  2881.     fmove.x    fp0,fp1
  2882.     fmul.s    -$20(a5),fp1
  2883.     fadd.x    fp4,fp1
  2884.     lea    $18(a2),a0
  2885.     fmove.s    fp1,(a0)
  2886. ;   M(2,2) = (one_c * zz) + c;
  2887.     fmul.s    -$18(a5),fp0
  2888.     fadd.x    fp5,fp0
  2889.     lea    $28(a2),a0
  2890.     fmove.s    fp0,(a0)
  2891. ;   M(2,3) = 0.0F;
  2892.     lea    $38(a2),a0
  2893.     clr.l    (a0)
  2894. ;   M(3,0) = 0.0F;
  2895.     lea    $C(a2),a0
  2896.     clr.l    (a0)
  2897. ;   M(3,1) = 0.0F;
  2898.     lea    $1C(a2),a0
  2899.     clr.l    (a0)
  2900. ;   M(3,2) = 0.0F;
  2901.     lea    $2C(a2),a0
  2902.     clr.l    (a0)
  2903. ;   M(3,3) = 1.0F;
  2904.     lea    $3C(a2),a0
  2905.     move.l    #$3F800000,(a0)
  2906.     fmovem.x (a7)+,fp2/fp3/fp4/fp5/fp6
  2907.     move.l    (a7)+,a2
  2908.     unlk    a5
  2909.     rts
  2910.  
  2911.     SECTION "_gl_Rotatef:0",CODE
  2912.  
  2913.  
  2914. ;void gl_Rotatef( GLcontext *ctx,
  2915.     XDEF    _gl_Rotatef
  2916. _gl_Rotatef
  2917. L307    EQU    -$40
  2918.     link    a5,#L307
  2919.     move.l    a2,-(a7)
  2920.     fmovem.x fp2/fp3,-(a7)
  2921.     move.l    $8(a5),a2
  2922.     fmove.s    $C(a5),fp0
  2923.     fmove.s    $10(a5),fp1
  2924.     fmove.s    $14(a5),fp2
  2925.     fmove.s    $18(a5),fp3
  2926. L306
  2927. ;   gl_rotation_matrix( angle, x, y, z, m );
  2928.     lea    -$40(a5),a0
  2929.     move.l    a0,-(a7)
  2930.     fmove.s    fp3,-(a7)
  2931.     fmove.s    fp2,-(a7)
  2932.     fmove.s    fp1,-(a7)
  2933.     fmove.s    fp0,-(a7)
  2934.     jsr    _gl_rotation_matrix
  2935.     add.w    #$14,a7
  2936. ;   gl_MultMatrixf( ctx, m );
  2937.     lea    -$40(a5),a0
  2938.     move.l    a0,-(a7)
  2939.     move.l    a2,-(a7)
  2940.     jsr    _gl_MultMatrixf
  2941.     addq.w    #$8,a7
  2942.     fmovem.x (a7)+,fp2/fp3
  2943.     move.l    (a7)+,a2
  2944.     unlk    a5
  2945.     rts
  2946.  
  2947.     SECTION "_gl_Scalef:0",CODE
  2948.  
  2949.  
  2950. ;void gl_Scalef( GLcontext *ctx, GLfloat x, GLfloat y, GLfloat z )
  2951.     XDEF    _gl_Scalef
  2952. _gl_Scalef
  2953.     fmovem.x fp2/fp3/fp4,-(a7)
  2954.     move.l    $28(a7),a1
  2955.     fmove.s    $34(a7),fp1
  2956.     fmove.s    $30(a7),fp2
  2957.     fmove.s    $2C(a7),fp3
  2958. L310
  2959. ;   if (INSIDE_BEGIN_END(ctx)) 
  2960.     move.l    a1,a0
  2961.     add.l    #$E08A,a0
  2962.     move.l    (a0),d0
  2963.     cmp.l    #$1A00,d0
  2964.     beq.b    L312
  2965. L311
  2966. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glScale" );
  2967.     move.l    #L308,-(a7)
  2968.     pea    $502.w
  2969.     move.l    a1,-(a7)
  2970.     jsr    _gl_error
  2971.     add.w    #$C,a7
  2972.     fmovem.x (a7)+,fp2/fp3/fp4
  2973.     rts
  2974. L312
  2975. ;   switch (ctx->Transform.MatrixMode)
  2976.     move.l    a1,a0
  2977.     add.l    #$DC12,a0
  2978.     lea    (a0),a0
  2979.     move.l    (a0),d0
  2980.     cmp.l    #$1701,d0
  2981.     beq.b    L314
  2982.     bgt.b    L318
  2983.     cmp.l    #$1700,d0
  2984.     beq.b    L313
  2985.     bra.b    L316
  2986. L318
  2987.     cmp.l    #$1702,d0
  2988.     beq.b    L315
  2989.     bra.b    L316
  2990. ;      
  2991. L313
  2992. ;     m = ctx->ModelViewMatrix;
  2993.     lea    $982(a1),a0
  2994. ;     ctx->NewModelViewMatrix = GL_TRUE;
  2995.     move.b    #1,$97C(a1)
  2996. ;     
  2997.     bra.b    L317
  2998. L314
  2999. ;     m = ctx->ProjectionMatrix;
  3000.     lea    $120C(a1),a0
  3001. ;     ctx->NewProjectionMatrix = GL_TRUE;
  3002.     move.b    #1,$1206(a1)
  3003. ;     
  3004.     bra.b    L317
  3005. L315
  3006. ;     m = ctx->TextureMatrix;
  3007.     lea    $1B56(a1),a0
  3008. ;     ctx->NewTextureMatrix = GL_TRUE;
  3009.     move.b    #1,$1B50(a1)
  3010. ;     
  3011.     bra.b    L317
  3012. L316
  3013. ;     gl_problem(ctx, "Bad matrix mode in gl_Scalef");
  3014.     move.l    #L309,-(a7)
  3015.     move.l    a1,-(a7)
  3016.     jsr    _gl_problem
  3017.     addq.w    #$8,a7
  3018.     fmovem.x (a7)+,fp2/fp3/fp4
  3019.     rts
  3020. L317
  3021. ;     return;
  3022. ;   m[0] *= x;
  3023.     fmove.s    (a0),fp0
  3024.     fmul.x    fp3,fp0
  3025.     fmove.s    fp0,(a0)
  3026. ;   m[4] *= y;
  3027.     lea    $10(a0),a1
  3028.     fmove.s    (a1),fp0
  3029.     fmul.x    fp2,fp0
  3030.     fmove.s    fp0,(a1)
  3031. ;   m[8]  *= z;
  3032.     lea    $20(a0),a1
  3033.     fmove.s    (a1),fp0
  3034.     fmul.x    fp1,fp0
  3035.     fmove.s    fp0,(a1)
  3036. ;   m[1] *= x;
  3037.     lea    4(a0),a1
  3038.     fmove.s    (a1),fp0
  3039.     fmul.x    fp3,fp0
  3040.     fmove.s    fp0,(a1)
  3041. ;   m[5] *= y;
  3042.     lea    $14(a0),a1
  3043.     fmove.s    (a1),fp0
  3044.     fmul.x    fp2,fp0
  3045.     fmove.s    fp0,(a1)
  3046. ;   m[9]  *= z;
  3047.     lea    $24(a0),a1
  3048.     fmove.s    (a1),fp0
  3049.     fmul.x    fp1,fp0
  3050.     fmove.s    fp0,(a1)
  3051. ;   m[2] *= x;
  3052.     lea    $8(a0),a1
  3053.     fmove.s    (a1),fp0
  3054.     fmul.x    fp3,fp0
  3055.     fmove.s    fp0,(a1)
  3056. ;   m[6] *= y;
  3057.     lea    $18(a0),a1
  3058.     fmove.s    (a1),fp0
  3059.     fmul.x    fp2,fp0
  3060.     fmove.s    fp0,(a1)
  3061. ;   m[10] *= z;
  3062.     lea    $28(a0),a1
  3063.     fmove.s    (a1),fp0
  3064.     fmul.x    fp1,fp0
  3065.     fmove.s    fp0,(a1)
  3066. ;   m[3] *= x;
  3067.     lea    $C(a0),a1
  3068.     fmove.s    (a1),fp0
  3069.     fmul.x    fp3,fp0
  3070.     fmove.s    fp0,(a1)
  3071. ;   m[7] *= y;
  3072.     lea    $1C(a0),a1
  3073.     fmove.s    (a1),fp0
  3074.     fmul.x    fp2,fp0
  3075.     fmove.s    fp0,(a1)
  3076. ;   m[11] *= z;
  3077.     add.w    #$2C,a0
  3078.     fmove.s    (a0),fp0
  3079.     fmul.x    fp1,fp0
  3080.     fmove.s    fp0,(a0)
  3081.     fmovem.x (a7)+,fp2/fp3/fp4
  3082.     rts
  3083.  
  3084. L309
  3085.     dc.b    'Bad matrix mode in gl_Scalef',0
  3086. L308
  3087.     dc.b    'glScale',0
  3088.  
  3089.     SECTION "_gl_Translatef:0",CODE
  3090.  
  3091.  
  3092. ;void gl_Translatef( GLcontext *ctx, GLfloat x, GLfloat y, GLfloat z )
  3093.     XDEF    _gl_Translatef
  3094. _gl_Translatef
  3095.     fmovem.x fp2/fp3/fp4/fp5,-(a7)
  3096.     move.l    $34(a7),a1
  3097.     fmove.s    $40(a7),fp2
  3098.     fmove.s    $3C(a7),fp3
  3099.     fmove.s    $38(a7),fp4
  3100. L321
  3101. ;   if (INSIDE_BEGIN_END(ctx)) 
  3102.     move.l    a1,a0
  3103.     add.l    #$E08A,a0
  3104.     move.l    (a0),d0
  3105.     cmp.l    #$1A00,d0
  3106.     beq.b    L323
  3107. L322
  3108. ;      gl_error( ctx, GL_INVALID_OPERATION, "glTranslate" );
  3109.     move.l    #L319,-(a7)
  3110.     pea    $502.w
  3111.     move.l    a1,-(a7)
  3112.     jsr    _gl_error
  3113.     add.w    #$C,a7
  3114.     fmovem.x (a7)+,fp2/fp3/fp4/fp5
  3115.     rts
  3116. L323
  3117. ;   switch (ctx->Transform.MatrixMode)
  3118.     move.l    a1,a0
  3119.     add.l    #$DC12,a0
  3120.     lea    (a0),a0
  3121.     move.l    (a0),d0
  3122.     cmp.l    #$1701,d0
  3123.     beq.b    L325
  3124.     bgt.b    L329
  3125.     cmp.l    #$1700,d0
  3126.     beq.b    L324
  3127.     bra.b    L327
  3128. L329
  3129.     cmp.l    #$1702,d0
  3130.     beq.b    L326
  3131.     bra.b    L327
  3132. ;      
  3133. L324
  3134. ;     m = ctx->ModelViewMatrix;
  3135.     lea    $982(a1),a0
  3136. ;     ctx->NewModelViewMatrix = GL_TRUE;
  3137.     move.b    #1,$97C(a1)
  3138. ;     
  3139.     bra.b    L328
  3140. L325
  3141. ;     m = ctx->ProjectionMatrix;
  3142.     lea    $120C(a1),a0
  3143. ;     ctx->NewProjectionMatrix = GL_TRUE;
  3144.     move.b    #1,$1206(a1)
  3145. ;     
  3146.     bra.b    L328
  3147. L326
  3148. ;     m = ctx->TextureMatrix;
  3149.     lea    $1B56(a1),a0
  3150. ;     ctx->NewTextureMatrix = GL_TRUE;
  3151.     move.b    #1,$1B50(a1)
  3152. ;     
  3153.     bra.b    L328
  3154. L327
  3155. ;     gl_problem(ctx, "Bad matrix mode in gl_Translatef");
  3156.     move.l    #L320,-(a7)
  3157.     move.l    a1,-(a7)
  3158.     jsr    _gl_problem
  3159.     addq.w    #$8,a7
  3160.     fmovem.x (a7)+,fp2/fp3/fp4/fp5
  3161.     rts
  3162. L328
  3163. ;     return;
  3164. ;   m[12] = m[0] * x + m[4] * y + m[8]  * z + m[12];
  3165.     fmove.s    (a0),fp0
  3166.     fmul.x    fp4,fp0
  3167.     lea    $10(a0),a1
  3168.     fmove.s    (a1),fp1
  3169.     fmul.x    fp3,fp1
  3170.     fadd.x    fp1,fp0
  3171.     lea    $20(a0),a1
  3172.     fmove.s    (a1),fp1
  3173.     fmul.x    fp2,fp1
  3174.     fadd.x    fp1,fp0
  3175.     lea    $30(a0),a1
  3176.     fmove.s    (a1),fp1
  3177.     fadd.x    fp1,fp0
  3178.     lea    $30(a0),a1
  3179.     fmove.s    fp0,(a1)
  3180. ;   m[13] = m[1] * x + m[5] * y + m[9]  * z + m[13];
  3181.     lea    4(a0),a1
  3182.     fmove.s    (a1),fp0
  3183.     fmul.x    fp4,fp0
  3184.     lea    $14(a0),a1
  3185.     fmove.s    (a1),fp1
  3186.     fmul.x    fp3,fp1
  3187.     fadd.x    fp1,fp0
  3188.     lea    $24(a0),a1
  3189.     fmove.s    (a1),fp1
  3190.     fmul.x    fp2,fp1
  3191.     fadd.x    fp1,fp0
  3192.     lea    $34(a0),a1
  3193.     fmove.s    (a1),fp1
  3194.     fadd.x    fp1,fp0
  3195.     lea    $34(a0),a1
  3196.     fmove.s    fp0,(a1)
  3197. ;   m[14] = m[2] * x + m[6] * y + m[10] * z + m[14];
  3198.     lea    $8(a0),a1
  3199.     fmove.s    (a1),fp0
  3200.     fmul.x    fp4,fp0
  3201.     lea    $18(a0),a1
  3202.     fmove.s    (a1),fp1
  3203.     fmul.x    fp3,fp1
  3204.     fadd.x    fp1,fp0
  3205.     lea    $28(a0),a1
  3206.     fmove.s    (a1),fp1
  3207.     fmul.x    fp2,fp1
  3208.     fadd.x    fp1,fp0
  3209.     lea    $38(a0),a1
  3210.     fmove.s    (a1),fp1
  3211.     fadd.x    fp1,fp0
  3212.     lea    $38(a0),a1
  3213.     fmove.s    fp0,(a1)
  3214. ;   m[15] = m[3] * x + m[7] * y + m[11] * z + m[15];
  3215.     lea    $C(a0),a1
  3216.     fmove.s    (a1),fp0
  3217.     fmul.x    fp4,fp0
  3218.     lea    $1C(a0),a1
  3219.     fmove.s    (a1),fp1
  3220.     fmul.x    fp3,fp1
  3221.     fadd.x    fp1,fp0
  3222.     lea    $2C(a0),a1
  3223.     fmove.s    (a1),fp1
  3224.     fmul.x    fp2,fp1
  3225.     fadd.x    fp1,fp0
  3226.     lea    $3C(a0),a1
  3227.     fmove.s    (a1),fp1
  3228.     fadd.x    fp1,fp0
  3229.     add.w    #$3C,a0
  3230.     fmove.s    fp0,(a0)
  3231.     fmovem.x (a7)+,fp2/fp3/fp4/fp5
  3232.     rts
  3233.  
  3234. L320
  3235.     dc.b    'Bad matrix mode in gl_Translatef',0
  3236. L319
  3237.     dc.b    'glTranslate',0
  3238.  
  3239.     SECTION "_gl_Viewport:0",CODE
  3240.  
  3241.  
  3242. ;void gl_Viewport( GLcontext *ctx,
  3243.     XDEF    _gl_Viewport
  3244. _gl_Viewport
  3245.     movem.l    d2-d4,-(a7)
  3246.     move.l    $20(a7),d0
  3247.     move.l    $1C(a7),d1
  3248.     move.l    $18(a7),d2
  3249.     move.l    $14(a7),d3
  3250.     move.l    $10(a7),a0
  3251. L331
  3252. ;   if (width<0 || height<0) 
  3253.     tst.l    d1
  3254.     bmi.b    L333
  3255. L332
  3256.     tst.l    d0
  3257.     bpl.b    L334
  3258. L333
  3259. ;      gl_error( ctx,  GL_INVALID_VALUE, "glViewport" );
  3260.     move.l    #L330,-(a7)
  3261.     pea    $501.w
  3262.     move.l    a0,-(a7)
  3263.     jsr    _gl_error
  3264.     add.w    #$C,a7
  3265.     movem.l    (a7)+,d2-d4
  3266.     rts
  3267. L334
  3268. ;   if (INSIDE_BEGIN_END(ctx)) 
  3269.     move.l    a0,a1
  3270.     add.l    #$E08A,a1
  3271.     move.l    (a1),d4
  3272.     cmp.l    #$1A00,d4
  3273.     beq.b    L336
  3274. L335
  3275. ;      gl_error( ctx,  GL_INVALID_OPERATION, "glViewport" );
  3276.     move.l    #L330,-(a7)
  3277.     pea    $502.w
  3278.     move.l    a0,-(a7)
  3279.     jsr    _gl_error
  3280.     add.w    #$C,a7
  3281.     movem.l    (a7)+,d2-d4
  3282.     rts
  3283. L336
  3284. ;   width  = CLAMP( width,  1, MAX_WIDTH );
  3285.     cmp.l    #1,d1
  3286.     bge.b    L338
  3287. L337
  3288.     moveq    #1,d1
  3289.     bra.b    L342
  3290. L338
  3291.     cmp.l    #$640,d1
  3292.     ble.b    L340
  3293. L339
  3294.     move.l    #$640,d1
  3295. L340
  3296. L341
  3297. L342
  3298. ;   height = CLAMP( height, 1, MAX_HEIGHT );
  3299.     cmp.l    #1,d0
  3300.     bge.b    L344
  3301. L343
  3302.     moveq    #1,d0
  3303.     bra.b    L348
  3304. L344
  3305.     cmp.l    #$4B0,d0
  3306.     ble.b    L346
  3307. L345
  3308.     move.l    #$4B0,d0
  3309. L346
  3310. L347
  3311. L348
  3312. ;   ctx->Viewport.X = x;
  3313.     move.l    a0,a1
  3314.     add.l    #$DC7E,a1
  3315.     move.l    d3,(a1)
  3316. ;   ctx->Viewport.Width = width;
  3317.     move.l    a0,a1
  3318.     add.l    #$DC86,a1
  3319.     move.l    d1,(a1)
  3320. ;   ctx->Viewport.Y = y;
  3321.     move.l    a0,a1
  3322.     add.l    #$DC82,a1
  3323.     move.l    d2,(a1)
  3324. ;   ctx->Viewport.Height = height;
  3325.     move.l    a0,a1
  3326.     add.l    #$DC8A,a1
  3327.     move.l    d0,(a1)
  3328. ;   ctx->Viewport.Sx = (GLfloat) width / 2.0F;
  3329.     fmove.l    d1,fp0
  3330.     fdiv.s    #$.40000000,fp0
  3331.     move.l    a0,a1
  3332.     add.l    #$DC96,a1
  3333.     fmove.s    fp0,(a1)
  3334. ;   ctx->Viewport.Tx = ctx->Viewport.Sx + x;
  3335.     move.l    a0,a1
  3336.     add.l    #$DC7E,a1
  3337.     lea    (a1),a1
  3338.     fmove.s    $18(a1),fp0
  3339.     fmove.l    d3,fp1
  3340.     fadd.x    fp1,fp0
  3341.     move.l    a0,a1
  3342.     add.l    #$DCA2,a1
  3343.     fmove.s    fp0,(a1)
  3344. ;   ctx->Viewport.Sy = (GLfloat) height / 2.0F;
  3345.     fmove.l    d0,fp0
  3346.     fdiv.s    #$.40000000,fp0
  3347.     move.l    a0,a1
  3348.     add.l    #$DC9A,a1
  3349.     fmove.s    fp0,(a1)
  3350. ;   ctx->Viewport.Ty = ctx->Viewport.Sy + y;
  3351.     move.l    a0,a1
  3352.     add.l    #$DC7E,a1
  3353.     lea    (a1),a1
  3354.     fmove.s    $1C(a1),fp0
  3355.     fmove.l    d2,fp1
  3356.     fadd.x    fp1,fp0
  3357.     move.l    a0,a1
  3358.     add.l    #$DCA6,a1
  3359.     fmove.s    fp0,(a1)
  3360. ;   ctx->NewState |= NEW_ALL;
  3361.     move.l    a0,a1
  3362.     add.l    #$E082,a1
  3363.     move.l    (a1),d0
  3364.     or.l    #$F,d0
  3365.     move.l    a0,a1
  3366.     add.l    #$E082,a1
  3367.     move.l    d0,(a1)
  3368. ;   gl_ResizeBuffersMESA(ctx);
  3369.     move.l    a0,-(a7)
  3370.     jsr    _gl_ResizeBuffersMESA
  3371.     addq.w    #4,a7
  3372.     movem.l    (a7)+,d2-d4
  3373.     rts
  3374.  
  3375. L330
  3376.     dc.b    'glViewport',0
  3377.  
  3378.     END
  3379.