home *** CD-ROM | disk | FTP | other *** search
/ ST-Computer Leser 2002 January / STC_CD_01_2002.iso / SCENE / IMATROLL / SRC / SYS / DSP_FIX.S next >
Text File  |  2001-11-06  |  10KB  |  264 lines
  1. ; dsp_fix.s
  2. ;
  3. ; COPYRIGHT (c) 1998 by NoCrew Laboratories.
  4. ;
  5. ; Implements:
  6. ;
  7. ;     extern Int dsp_load_program(Byte *program, Int length);
  8. ;
  9. ; Where length is the number of DSP words (e.i. 3 byte tuples).
  10. ; A return value of 1 means that the loading was sucessful. 0
  11. ; means something went wrong.
  12. ;
  13. ; This module will always load the DSP program. It is compatible
  14. ; with the Dsp_ExecProg loader. However, as it reloads the DSP
  15. ; bootstrap code every time -- which the TOS version does not --
  16. ; this one does not freeze up.
  17.  
  18.     
  19.         section    text
  20.  
  21. dspmod_dsp_load_program:
  22.         move.l    a0,dspmod_dsp_program
  23.         move.l    d0,dspmod_dsp_length
  24.  
  25.         ;Test for supervisor mode.
  26.         move    sr,d0
  27.         btst    #13,d0
  28.         bne.s    dspmod_dsp_load
  29.     
  30.         move.l    #dspmod_dsp_load,-(sp)
  31.         move.w    #$26,-(sp)
  32.         trap    #14
  33.         addq.w    #6,sp
  34.  
  35.         move.l    dspmod_dsp_status,d0
  36.         rts
  37.  
  38. dspmod_dsp_load:    
  39.         bsr    dspmod_dsp_reset
  40.         bsr    dspmod_dsp_go
  41.         move.l    d0,dspmod_dsp_status
  42.         rts
  43.  
  44. dspmod_dsp_reset:    ;Power down.
  45.         move.b    #$e,$ffff8800.w
  46.         move.b    $ffff8800.w,d0
  47.         and.b    #$ef,d0
  48.         move.b    d0,$ffff8802.w
  49.         or.b    #$10,d0
  50.         move.b    d0,$ffff8802.w
  51.  
  52.         ;Wait for DSP to power down.
  53.         move.w    #10000-1,d0
  54. dspmod_wait:        nop
  55.         dbra    d0,dspmod_wait
  56.  
  57.         ;Power up.
  58.         move.b    #$e,$ffff8800.w
  59.         move.b    $ffff8800.w,d0
  60.         and.b    #$ef,d0
  61.         move.b    d0,$ffff8802.w
  62.         rts
  63.  
  64. dspmod_dsp_go:
  65.         ;Load system startup code.
  66.         lea    dspmod_dsp_bootstrap_code,a0
  67.         move.w    #512-1,d0
  68. dspmod_next:        btst.b    #1,$ffffa202.w
  69.         beq.s    dspmod_next
  70.         move.b    (a0)+,$ffffa205.w
  71.         move.b    (a0)+,$ffffa206.w
  72.         move.b    (a0)+,$ffffa207.w
  73.         dbra    d0,dspmod_next
  74.         rts
  75.  
  76.  
  77.         ;Load DSP binary
  78. ;        move.l    dsp_program,a0
  79. ;        move.l    dsp_length,d0
  80. ;        subq.w    #1,d0
  81. ;        bmi.s    no_way
  82. ;copy:        btst.b    #1,$ffffa202.w
  83. ;        beq.s    copy
  84. ;        move.b    (a0)+,$ffffa205.w
  85. ;        move.b    (a0)+,$ffffa206.w
  86. ;        move.b    (a0)+,$ffffa207.w
  87. ;        dbra    d0,copy
  88. ;
  89. ;        ;Launch DSP binary
  90. ;go:        btst.b    #1,$ffffa202.w
  91. ;        beq.s    go
  92. ;        move.l    #3,$ffffa204.w
  93. ;    
  94. ;        moveq    #1,d0
  95. ;        rts
  96. ;no_way:    moveq    #0,d0
  97. ;        rts
  98.  
  99.         section    data
  100. dspmod_dsp_bootstrap_code:
  101.         dc.b    $0c,$00,$40,$00,$00,$00,$00,$00,$00,$00
  102.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  103.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  104.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  105.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  106.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  107.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  108.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  109.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  110.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  111.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  112.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  113.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  114.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  115.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  116.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  117.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  118.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  119.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  120.         dc.b    $00,$00,$60,$f4,$00,$00,$00,$4f,$61,$f4
  121.         dc.b    $00,$00,$7e,$a9,$06,$2e,$80,$00,$00,$47
  122.         dc.b    $07,$d8,$84,$07,$59,$84,$08,$f4,$a8,$00
  123.         dc.b    $00,$04,$08,$f4,$bf,$00,$0c,$00,$00,$fe
  124.         dc.b    $b8,$0a,$f0,$80,$00,$7e,$a9,$08,$f4,$a0
  125.         dc.b    $00,$00,$01,$08,$f4,$be,$00,$00,$00,$0a
  126.         dc.b    $a9,$80,$00,$7e,$ad,$08,$4e,$2b,$44,$f4
  127.         dc.b    $00,$00,$00,$03,$44,$f4,$45,$00,$00,$01
  128.         dc.b    $0e,$a0,$00,$0a,$a9,$80,$00,$7e,$b5,$08
  129.         dc.b    $50,$2b,$0a,$a9,$80,$00,$7e,$b8,$08,$46
  130.         dc.b    $2b,$44,$f4,$45,$00,$00,$02,$0a,$f0,$aa
  131.         dc.b    $00,$7e,$c9,$20,$00,$45,$0a,$f0,$aa,$00
  132.         dc.b    $7e,$d0,$06,$c6,$00,$00,$7e,$c6,$0a,$a9
  133.         dc.b    $80,$00,$7e,$c4,$08,$58,$6b,$0a,$f0,$80
  134.         dc.b    $00,$7e,$ad,$06,$c6,$00,$00,$7e,$cd,$0a
  135.         dc.b    $a9,$80,$00,$7e,$cb,$08,$58,$ab,$0a,$f0
  136.         dc.b    $80,$00,$7e,$ad,$06,$c6,$00,$00,$7e,$d4
  137.         dc.b    $0a,$a9,$80,$00,$7e,$d2,$08,$58,$eb,$0a
  138.         dc.b    $f0,$80,$00,$7e,$ad,$00,$00,$00,$00,$00
  139.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  140.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  141.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  142.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  143.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  144.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  145.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  146.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  147.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  148.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  149.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  150.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  151.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  152.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  153.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  154.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  155.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  156.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  157.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  158.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  159.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  160.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  161.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  162.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  163.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  164.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  165.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  166.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  167.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  168.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  169.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  170.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  171.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  172.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  173.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  174.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  175.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  176.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  177.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  178.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  179.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  180.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  181.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  182.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  183.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  184.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  185.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  186.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  187.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  188.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  189.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  190.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  191.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  192.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  193.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  194.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  195.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  196.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  197.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  198.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  199.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  200.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  201.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  202.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  203.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  204.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  205.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  206.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  207.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  208.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  209.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  210.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  211.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  212.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  213.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  214.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  215.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  216.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  217.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  218.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  219.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  220.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  221.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  222.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  223.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  224.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  225.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  226.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  227.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  228.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  229.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  230.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  231.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  232.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  233.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  234.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  235.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  236.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  237.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  238.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  239.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  240.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  241.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  242.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  243.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  244.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  245.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  246.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  247.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  248.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  249.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  250.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  251.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  252.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  253.         dc.b    $00,$00,$00,$00,$00,$00,$00,$00,$00,$00
  254.         dc.b    $00,$00,$00,$00,$00,$00
  255.  
  256.  
  257.         section    bss
  258.  
  259. dspmod_dsp_program:    ds.l    1
  260. dspmod_dsp_length:    ds.l    1
  261. dspmod_dsp_status:    ds.l    1
  262.  
  263.  
  264.         section    text