home *** CD-ROM | disk | FTP | other *** search
/ Amiga ISO Collection / AmigaUtilCD1.iso / Disk&HD / LSD-LOS.LHA / TrackLoader.Src < prev   
Encoding:
Text File  |  1980-01-18  |  7.7 KB  |  397 lines
  1.  
  2. * EXAMPLE OF USE!
  3.  
  4.     move.w #$4000,$dff09a    ;Disable Irqs....
  5.  
  6.     jsr INIT_DISK        ;set up
  7.  
  8.     move.l #loadspace,a6    ;Address of load
  9.     move.l #$10000,d6        ;Bytes to load
  10.     move.w #880,d7        ;Start block
  11.     jsr Block_load
  12.  
  13.     tst.w d7            ;check for failure
  14.     beq.s fileok
  15.  
  16.     move.w #$7fff,d0        ;red screen = error 
  17. erlp    move.w #$f00,$dff180
  18.     dbf d0,erlp
  19.  
  20. fileok    jsr motor_off
  21.     move.w #$c000,$dff09a
  22.     rts
  23.  
  24. loadspace dcb.l $8000,$00
  25.  
  26. *****************************************************************************
  27.  
  28.             *     System Independant Block Loader - V1.1 26/4/94   *
  29.             *------------------------------------------------------*
  30.  
  31.                     * By PHIL RUSTON AKA:PHIL!94/LSD *
  32.  
  33. * Call "INIT_DISK" before loading for the 1st time!!
  34.  
  35. * To LOAD A FILE Set:-
  36.  
  37. * A6 - Destination Address.
  38. * D6 - Bytes to load.
  39. * D7 - Starting Block.
  40.  
  41. * Then call: "BLOCK_LOAD" - All registers preserved except D7
  42.  
  43. * D7 returns as 00 is load OK. Else one of the following errors:
  44.  
  45. * 01 = No speed signal from motor   (disk ejected whilst loading?)
  46. * 02 = No DMA transfer time out     (bad disk / ''             '')
  47. * 03 = No disk in drive.            (Obvious)
  48. * 04 = Can't find that disk block   (disk corrupt)
  49. * 05 = Wrong track marker ID        ('')
  50. * 06 = Checksum error on disk block ('')
  51. * 07 = Block number out of range    (>$6df)
  52.  
  53. * Call "MOTOR_OFF" when finished loading for a while!!
  54.  
  55. *******************************************************************************
  56.  
  57.     section loadcode,code
  58.  
  59. DRIVE equ 0
  60.  
  61.  
  62. INIT_DISK    movem.l d7/a1/a2,-(a7)
  63.     move.l #$bfd000,a1
  64.     move.l #Variables,a2
  65.     bsr motor_off
  66.     bclr #drive+3,$100(a1)
  67.     bsr initialize_drive
  68.     bsr motor_off
  69.     movem.l (a7)+,d7/a1/a2
  70.     rts
  71.  
  72. BLOCK_LOAD
  73.     movem.l d0-d6/a0-a6,-(a7)
  74.     move.l #$dff000,a0
  75.     move.l #$bfd000,a1
  76.     move.l #Variables,a2
  77.     moveq #0,d0
  78.     move.w d7,d0
  79.     subq.l #1,d6   
  80. nxt_blk    bsr get_block
  81.     tst.b error(a2)
  82.     bne.s Load_done
  83.     tst.l d6            ;Byte countdown ended?
  84.     bmi.s load_done
  85.     addq.w #1,d0
  86.     bra nxt_blk
  87.  
  88. load_done    tst.b error(a2)        ;Disk removed handler.
  89.     beq.s no_error
  90.     bsr motor_off
  91.     move.w #1000,d7        
  92.     bsr cia_wait
  93.  
  94. no_error    moveq #0,d7
  95.     move.b error(a2),d7
  96.     movem.l (a7)+,d0-d6/a0-a6
  97.     rts
  98.  
  99.  
  100. MOTOR_OFF    movem.l d7/a1-a2,-(a7)
  101.     move.l #$bfd000,a1
  102.     move.l #variables,a2
  103.     clr.b motor(a2)
  104.     move.b #$ff,$100(a1)
  105.     move.b #$87,$100(a1)
  106.     bsr wait1msec
  107.     move.b #$ff,$100(a1)
  108.     movem.l (a7)+,d7/a1-a2
  109.     rts
  110.  
  111. *****************************************************************************
  112.  
  113. *************
  114. * Get Block *
  115. *************
  116.  
  117. * D0 will equal block number required ($0 - $6df)
  118.  
  119. Get_block    cmp.w #$6df,d0        ;check block is range
  120.     bls.s blockinrange
  121.     move.b #$7,error(a2)
  122.     bra No_reload
  123.  
  124. Blockinrange
  125.  
  126.     move.w #$0503,attempts(a2)
  127.     move.l d0,d1        
  128.     divu #11,d1        ;what cylinder is that on?
  129.     tst.b motor(a2)
  130.     beq.s reload
  131.  
  132.     cmp.b trackside(a2),d1    
  133.     beq.s Trksde_in        ;that track is already in.
  134.  
  135. Reload    bsr Fetch_trackside        ;loads MFM track required
  136.     tst.b error(a2)
  137.     bne No_reload
  138.  
  139. Trksde_in    clr.b error(a2)        ;find a sector
  140.     swap d1            ;get sector number lo.
  141.     move.l #MFMbuffer,a3
  142.     lea $31fe(a3),a5
  143. find_sync    move.w #$4489,d7
  144. fs_loop    cmp.w (a3)+,d7
  145.     beq.s found_sync
  146.     cmp.l a5,a3
  147.     bls.s fs_loop
  148.     move.b #4,error(a2)        ;couldnt find that sector-error 4
  149.     bra MFM_error
  150.  
  151. found_sync    
  152.  
  153.     cmp.w (a3),d7        ;2 syncs?
  154.     beq.s syncstart
  155.     subq.w #2,a3
  156.  
  157. syncstart    lea $2a(a3),a4        ;Check header checksum.
  158.     bsr decode_lw        
  159.     move.l $2(a3),d3
  160.     move.l $6(a3),d4
  161.     andi.l #$55555555,d3
  162.     andi.l #$55555555,d4
  163.     eor.l d4,d3
  164.     cmp.l d3,d5
  165.     bne.s Not_sector
  166.  
  167.     lea $2(a3),a4        ;Track mark = Head position?
  168.     bsr decode_lw
  169.     move.l d5,d4        
  170.     swap d4
  171.     cmp.b trackside(a2),d4
  172.     beq.s Track_mark_ok
  173.     move.b #5,error(a2)        ;wrong track mark - error 5
  174.     bra MFM_error
  175.  
  176. Track_mark_ok
  177.  
  178.     lsr.w #8,d5        ;Is this the sector required?
  179.     cmp.b d5,d1
  180.     beq.s Found_block
  181.     
  182. Not_sector
  183.  
  184.     add.w #$430,a3          ;loop until find correct sector
  185.     bra.s find_sync
  186.  
  187. Found_Block
  188.     
  189.     moveq #0,d2        ;Transfer converted MFM to dest.
  190.     move.l #$55555555,d7
  191.     lea $3a(a3),a4        
  192.     lea $23a(a3),a5
  193.     move.l d6,d1        ;back up pointers in case of error.
  194.     move.l a6,a3        
  195.     moveq #$7f,d3
  196.  
  197. conv_lw    move.l (a4)+,d5
  198.     move.l (a5)+,d4
  199.     and.l d7,d5
  200.     and.l d7,d4
  201.     eor.l d5,d2        ;update checksum
  202.     eor.l d4,d2
  203.     add.l d5,d5
  204.     or.l d4,d5
  205.     subq.l #4,d6
  206.     bmi.s lst_bytes
  207.     move.l d5,(a6)+
  208. nxt_lw    dbf d3,conv_lw
  209.     bra.s blk_done
  210.  
  211. Lst_bytes    move.w d6,d4
  212.     addq.w #4,d4        ;last bytes
  213.     bmi.s nxt_lw
  214.  
  215. Lb_loop    rol.l #8,d5
  216.     move.b d5,(a6)+
  217.     dbf d4,Lb_loop
  218.     bra.s nxt_lw
  219.         
  220. blk_done    sub.w #$208,a4        ;get data checksum
  221.     bsr decode_lw        
  222.     cmp.l d5,d2
  223.     beq.s no_reload
  224.     move.b #6,error(a2)        ;checksum error - error 6
  225.     move.l a3,a6        ;restore pointers
  226.     move.l d1,d6
  227.  
  228. MFM_error    move.l d0,d1        
  229.     divu #11,d1        
  230.     subq.b #1,attempts(a2)
  231.     bne Reload
  232.     bsr initialize_Drive    ;reset heads
  233.     move.b #5,attempts(a2)
  234.     subq.b #1,attempts+1(a2)
  235.     bne Reload
  236.  
  237. No_reload    rts
  238.  
  239. *****************************************************************************
  240.  
  241. * MFM Track loader!
  242. * D1 will equal trackside 0 - 159
  243.  
  244. Fetch_trackside
  245.     
  246.     clr.b error(a2)        
  247.     tst.b motor(a2)
  248.     bne.s motor_on
  249.     move.b #$ff,$100(a1)
  250.     bclr #drive+3,$100(a1)
  251.     bsr wait1msec
  252.     btst #2,$1001(a1)
  253.     bne.s start_mot
  254.     btst #1,trackside(a2)
  255.     beq.s inchk
  256.     bsr stepout
  257.     bra.s stepchk
  258. inchk    bsr stepin
  259. stepchk    btst #2,$1001(a1)
  260.     beq.s no_disk
  261.     bsr initialize_drive
  262.     
  263. start_mot    move.b #$7f,$100(a1)    ;drive selected / motor on.
  264.     bclr #drive+3,$100(a1)
  265.     move.b #1,motor(a2)
  266.     move.w #200,d2        ;wait for correct motor speed.
  267. wdskrdy    moveq #10,d7
  268.     bsr cia_wait        
  269.     btst #5,$1001(a1)        
  270.     dbeq d2,wdskrdy
  271.     tst.w d2
  272.     bpl motor_on
  273.     move.b #1,error(a2)        ;no speed signal - error 1
  274.     bra trackload_end
  275.  
  276. motor_on    btst #2,$1001(a1)        ;disk removed?        
  277.     bne.s disk_in
  278. no_disk    move.b #3,error(a2)
  279.     bra trackload_end
  280.  
  281. disk_in    move.w d1,d3
  282.     lsr.b #1,d3        ;select disk side to load from.
  283.     bcc.s head1
  284.     bclr #2,$100(a1)
  285.     bra.s checkhead
  286. head1    bset #2,$100(a1)
  287.  
  288. checkhead    move.b trackside(a2),d2    ;ensure head is over correct
  289.     lsr.b #1,d2        ;track
  290.     cmp.b d2,d3
  291.     beq.s headok
  292.     bls.s seekout
  293.     bsr stepin
  294.     bra.s checkhead 
  295. seekout    bsr stepout    
  296.     bra.s checkhead
  297.  
  298. headok    move.b d1,trackside(a2)
  299.     move.w #$2,$9c(a0)        ;clear disk block irq
  300.     moveq #18,d7        ;settle wait.
  301.     bsr cia_wait
  302.  
  303.     move.l #mfmbuffer,$20(a0)
  304.     move.w #$4000,$24(a0)    
  305.     move.w #$8010,$96(a0)    ;enable dma
  306.     move.w #$6800,$9e(a0)    
  307.     move.w #$9500,$9e(a0)
  308.     move.w #$4489,$7e(a0)    ;sync
  309.     move.w #$9900,$24(a0)    
  310.     move.w #$9900,$24(a0)    
  311.  
  312.     move.w #200,d2
  313. waitdirq    moveq #10,d7
  314.     bsr cia_wait        
  315.     btst #1,$1f(a0)        
  316.     dbne d2,waitdirq
  317.     tst.w d2
  318.     bpl.s read_ok
  319.     move.b #2,error(a2)        ;No DMA finish-Time Out-error 2
  320.  
  321. read_ok    move.w #$4000,$24(a0)    
  322.     move.w #$10,$96(a0)        ;disable dma
  323.  
  324. Trackload_end
  325.  
  326.     rts
  327.  
  328. *******************************************************************************
  329.  
  330. decode_lw    move.l #$55555555,d7    ;decode two consec mfm longwords
  331.     move.l (a4),d5        ;into d5
  332.     move.l $4(a4),d4    
  333.     and.l d7,d5    
  334.     and.l d7,d4
  335.     add.l d5,d5
  336.     or.l d4,d5        
  337.     rts
  338.  
  339. stepout    subq.b #2,trackside(a2)
  340.     bset #1,$100(a1)
  341.     bra.s step
  342.  
  343. stepin    addq.b #2,trackside(a2)
  344.     bclr #1,$100(a1)
  345. step    bsr.s shortwait
  346.     bclr #0,$100(a1)
  347.     bsr.s shortwait
  348.     bset #0,$100(a1)
  349.     moveq #4,d7
  350.     bsr cia_wait
  351.     rts
  352.  
  353. shortwait    nop
  354.     nop
  355.     nop    
  356.     nop    
  357.     rts
  358.  
  359. initialize_drive
  360.  
  361.     btst #$4,$1001(a1)        
  362.     beq.s gottrack0
  363.     bsr.s stepout
  364.     bra.s initialize_drive
  365.  
  366. gottrack0    clr.b trackside(a2)    
  367.     move.w #20,d7
  368.     bsr cia_wait
  369.     rts
  370.  
  371. wait1msec    moveq #1,d7
  372.     
  373. cia_wait    move.b #$08,$f00(a1)    ;set one shot / stop timer.
  374.     move.b #$cc,$600(a1)    ;set timer lo
  375.     move.b #$02,$700(a1)    ;set timer hi (starts counter)
  376. ciawlp2    btst #0,$f00(a1)        ;wait for ciab timer b to timeout
  377.     bne.s ciawlp2
  378.     subq.w #1,d7
  379.     bne.s cia_wait        ;d7 = milliseconds to wait.
  380.     rts
  381.  
  382. *******************************************************************************
  383.  
  384. attempts     equ $0
  385. trackside    equ $2
  386. error           equ $3
  387. motor        equ $4
  388.  
  389. variables    dcb.w $3,$0
  390.  
  391.     section chipstuff,data_c
  392.  
  393. mfmbuffer    dcb.w $1910,$0000
  394.  
  395. *******************************************************************************
  396.  
  397.