Blame | Last modification | View Log | Download | RSS feed
Tue Jul 17 11:00:16 2018 Page 12500 A.D. 65816 Macro Assembler #26960 - Version 5.02g-----------------------------------------------------Input Filename : src\F8\fdc.asmOutput Filename : obj\F8\fdc.objListing Has Been Relocated2591 .LIST on25922593 F8FFB1 .INCLUDE inc\dirp00.inc2594 ;----------------------------------------------------------2595 ; DIRP00.ASM2596 ; PROGETTO: B16012597 ;2598 ; Variabili in Direct Page $002599 ;----------------------------------------------------------26002601 ; sezione COMMON -- questo permette di includere il file in piu' file26022603 .LIST on26042605 DIRP00: .SECTION page0, ref_only, common ;Direct-Page 0026062607 000000 .ABSOLUTE ;; inizia sempre da $002608 000000 .ORG 0x002609 0000002610 000000 0000 JiffyClk .DW ; contatore 10ms 32 bit2611 000002 0000 .DW2612 000004 SysTmr .DS SYSTMRCNT ; system timer 0 (10ms)2613 000008 SysTMF .DS SYSTMRCNT ; flag timer (80 -> start)2614 00000C 00 Bnk0Flag .DB ; <7>: flag test RAM banco 0 ok2615 ; <6>: flag warm reset2616 00000D 00 RTCFlag .DB26172618 00000E diskstat .DS 2 ; flag device on ata bus #0 & #12619 ; <7>: device ready2620 ; <6>: compact flash device (C.F.)2621 ; <5>: device identification ok2622 ; <4>: MBR loaded2623 ; <3>: valid signature in MBR2624 ; <2>: first partition found&active2625 ; <1>:2626 ; <0>: valid partition flag26272628 ; <7>: device ready2629 ; <6>: USB device2630 ; <5>: compact flash device (C.F.)2631 ; <4>: device identification ok2632 ; <3>: MBR loaded2633 ; <2>: first partition found&active2634 ; <1>: always 12635 ; <0>: valid partition flag2636 000010Tue Jul 17 11:00:16 2018 Page 226372638 00000E atadev .EQU diskstat26392640 000010 usbdev .DS 2 ; flag flash disk on usb bus #02641 ; <7>: device plugged and ready2642 ; <6>: always 12643 ; <5>: device identification ok2644 ; <4>: MBR loaded2645 ; <3>: valid signature in MBR2646 ; <2>: first partition found&active2647 ; <1>:2648 ; <0>: valid partition flag26492650 000012 diskmax .DS 16 ; disk max. sector's2651 000012 atasec .EQU diskmax2652 00001A usbsec .EQU diskmax+8265326542655 000022 atambr .DS 8 ; data for first partition found in mbr2656 ; first 3 bytes for start sector of partition2657 ; last byte for partition type2658 00002A usbmbr .DS 826592660 000032 ataprt .DS 8 ; total sec's of first partition2661 00003A usbprt .DS 8 ; total sec's of first partition266226632664 000042 00 usb0ch .DB ; usb0 (ch375/ch376) flag2665 ; <7>: module on2666 ; <6>: ch376 flag2667 ; <5:0>: chip version26682669 000043 00 usb0st .DB ; usb0 status2670 ; <7>: usb0 host mode ok2671 ; <6>: flash disk attached flag2672 ; <5>: usb device attached26732674 000044 00 fdcdrv .DB ; phisycal drive status (drive #0)2675 ; <7>: disk format established in bit 0&12676 ; <6>: double step seek done2677 ; <5>: trust format bit's (set after ok r/w)2678 ; <4>: write protect bit (if disk in drive)2679 ; <3>: don't care2680 ; <2>: don't care2681 ; <1>: HD disk if set else DD disk2682 ; <0>: CBM format if set else IBM format26832684 000045 00 vdrive .DB ; virtual drive status (ram disk, drive #1)2685 ; <7>: disk format established in bit 0&12686 ; <6>: change disk simulation (after format)2687 ; <5>: don't care2688 ; <4>: write protect bit (under sw control)2689 ; <3>: don't care2690 ; <2>: don't care2691 ; <1>: HD disk if set else DD disk2692 ; <0>: CBM format if set else IBM format2693Tue Jul 17 11:00:16 2018 Page 32694 000046 00 fdcctl .DB ; fdc controller status2695 ; <7>: drive is attached2696 ; <6>: drive need recalibration (restore)2697 ; <5>: FDC controller ok2698 ; <4>: motor on2699 ; <3>: dma is active2700 ; <2>: dma chip ok (post routine)2701 ; <1>: clock rate (1=HD,0=DD)2702 ; <0>: disk ready27032704 000047 00 fdctrk .DB ; fd: current seek track2705 000048 00 fdcerr .DB ; fd: last error code2706 000049 00 ataerr .DB ; ata: last error code2707 00004A 00 ataxer .DB ; ata: last extended error code27082709 00004B 00 CtrlBrk .DB ; flag CTRL+BREAK (NMI)27102711 00004C 0000 MemTop .DW ; top memoria RAM2712 00004E 00 .DB ; banco top mem27132714 00004F 00 DflTxtIn .DB ; device di default text input2715 000050 00 DflTxtOut .DB ; device di default text output27162717 000051 COPPtr LP ; long pointer for COP decoding2718 000054 00 COPIdx .DB ; COP signature/index27192720 000055 00 BiosEnt .DB ; flag accesso a bios setup27212722 ; variabili utilizzate da ACIA2723 000056 spwrk .DS $3027242725 ; bios mem2726 000086 0000 nsize .DW ; dimensione blocco da allocare2727 ;bsize .DW ; dimensione vera blocco free2728 000088 0000 splitsz .DW ; dimensione blocco splittato2729 00008A 0000 bfree .DW ; puntatore blocco free2730 00008C 0000 hdrptr .DW ; puntatore header heap27312732 00008E 0000 pbrklv .DW ; current break level of current process2733 000090 0000 pbrkmin .DW ; minimum breal level of current process2734 000092 0000 pbrkmax .DW ; maximum breal level of current process2735 0000942736 ; bios temp. work area2737 000094 bwrktmp .DS $2827382739 0000BC 00 coptmp .DB ; temp. used while cop27402741 0000BD 00 tstser .DB ; check ser/usb test board post2742 ; <7>: VIA2 ok2743 ; <6>: PICRAM ok2744 ; <1>: UART 16C550 ok2745 ; <0>: R65C51 ok274627472748 ;crc16 .DW27492750 0000BD .RELATIVETue Jul 17 11:00:16 2018 Page 427512752 .ENDS27532754 [01] .IFDEF _ACIA_INC_2755 .INCLUDE INC\SP.INC2756 [00] .ENDIF27572761 .LIST on27622763 F8FFB1 .INCLUDE inc\BIOSSEG.INC27642765 ;---------------------------------------------------------------------------2766 ; BIOS Working Segment2767 ;---------------------------------------------------------------------------27682769 010000 BIOSSEG .EQU $0100002770 000001 BIOSWKB .EQU .SEG.TOSSEG ; BIOS working bank2771 010000 _BS .SET BIOSSEG2772 01FFFF _BE .SET BIOSSEG + $FFFF2773 ;;TO .SET TOSWKM27742775 _BIOS: .SECTION ref_only, common, offset _BS, range _BS _BE ;BIOS working area2776 010000 _BIOS_START .DS 027772778 010000 _vram .DS $08002779 010800 _vattr .DS $08002780 011000 _vpal .DS $04002781 011400 _ioram .DS $04002782 011800 _ioram2 .DS $080027832784 012000 _xram .DS $200027852786 014000 _dmasave .DS $4800 ; save 36 fdc sec. ($4800)27872788 ;_atamod0 .DS 41 ; model string device ata #02789 ;_ataser0 .DS 21 ; serial string device ata #02790 ;_atarev0 .DS 9 ; revision string device ata #027912792 ;_atamod1 .DS 41 ; model string device ata #12793 ;_ataser1 .DS 21 ; serial string device ata #12794 ;_atarev1 .DS 9 ; revision string device ata #127952796 ;_usbdsc0 .DS 32 ; identification string device usb #02797 ;_usbdsc1 .DS 32 ; identification string device usb #127982799 018800 _BIOS_END .DS 02800 008800 BIOSSIZ .EQU (_BIOS_END - _BIOS_START)2801 .ENDS28022803 ;DMASEG .EQU $0200002804 ;DMASWKB .EQU .SEG.DMASEG ; DMA working bank2805 ;_DS .SET DMASEG2806 ;_DE .SET DMASEG + $FFFF28072808 ;_DMAS1: .SECTION ref_only, common, offset _DS, range _DS _DE ;DMA segment2809 ;_clscache .DS $80002810 ;.ENDSTue Jul 17 11:00:16 2018 Page 5281128122813 000002 BUFDSK1 .EQU $022814 000003 BUFDSK2 .EQU $0328152816 ; costanti di temporizzazione2817 000010 T1MS .EQU (4 * PHI2) ; costante 1ms (timer PHI2)2818 009C40 T10MS .EQU (10 * 1000 * PHI2)2819 000014 T20MS .EQU 202820 0007D0 SNDTMO .EQU 2000 ; 2000ms (timer PB6) - timeout SendTo28212822 0009C4 INTTMO .EQU 2500 ; 2000ms (timer PB6) - timeout INT2823 0009C4 RESTMO .EQU 2500 ; 2500ms (timer PB6) - timeout res28242825 0003B6 MOTACL .EQU 950 ; ritardo spin-up (ms)2826 000A28 MOTDCL .EQU 2600 ; ritardo spin-down (ms)28272828 ; GAP 3 read/write2829 00001B RWGPL3DD .EQU $1B ; GPL3 -> D.D. standard2830 000010 RWGPL3DDA .EQU $10 ; GPL3 -> D.D. 10 tracce2831 000036 RWGPL3HD .EQU $36 ; GPL3 -> H.D.2832 000014 RWGPL3HDA .EQU $14 ; GPL3 -> D.D. 10 tracce28332834 ; GAP 3 format2835 000054 FMGPL3DD .EQU $54 ; GPL3 -> D.D. standard2836 000024 FMGPL3DDA .EQU $24 ; GPL3 -> D.D. 10 tracce2837 00006C FMGPL3HD .EQU $6C ; GPL3 -> H.D.2838 000032 FMGPL3HDA .EQU $32 ; GPL3 -> H.D.28392840 ; comandi per UM83882841 000003 CMDSPECIFY .EQU $032842 000004 CMDSENSEST .EQU $042843 000007 CMDRECAL .EQU $072844 000008 CMDSENSEINT .EQU $082845 00000F CMDSEEK .EQU $0F2846 000045 CMDWRITE .EQU $452847 00004A CMDREADID .EQU $4A2848 00004D CMDFMT .EQU $4D2849 000066 CMDREAD .EQU $6628502851 0000DF UM_SRTHUT .EQU $DF ; SRT = 3ms, HUT = 240ms2852 ;UM_SRTHUT .EQU $0F ; SRT = 3ms, HUT = 240ms28532854 000002 UM_HLTND .EQU $02 ; HLT = 2ms, ND = 0 (DMA MODE)2855 ;UM_HLTND .EQU $FE ; HLT = 2ms, ND = 0 (DMA MODE)28562857 ; costanti per modo DMA (no autoinc, address inc, single mode)2858 000042 VERFTRASF .EQU $42 ; verfy transfer: read FDC, dummy MEM2859 000046 WRITETRASF .EQU $46 ; write transfer: read FDC, write MEM2860 00004A READTRASF .EQU $4A ; read transfer: read MEM, write FDC28612862 000005 maxret .EQU 5 ; retries #28632864 ; page 0 local var's (declared in bios temp. work area)2865 _P0BTMP: .SECTION page0, ref_only, offset bwrktmp ; DP Tmp. BIOS28662867 000094 FDCTMP_START .EQU $Tue Jul 17 11:00:16 2018 Page 628682869 000094 0000 ncnt .DW ; number of bytes for dma2870 000096 0000 ntrsf .DW ; number of trasferred bytes2871 000098 0000 ptmp .DW ; temp. pointer used by format2872 00009A 0000 bufstart .DW ; used by ram disk2873 00009C 0000 bufend .DW ; used by ram disk2874 00009E bufp LP ; buffer pointer2875 0000A1 verfp LP ; verify buffer pointer28762877 000098 xmstart .EQU ptmp ; ram disk start address2878 00009C dmabuf .EQU bufend ; dma buffer # & needs dma buffers #2879 00009D bufcnt .EQU bufend+12880 00009A drvhead .EQU bufstart2881 00009B dtlstp .EQU bufstart+12882 0000A1 lpfn .EQU verfp ; callback function pointer28832884 0000A4 fdcres .DS 7 ; store phase reult bytes2885 0000AB 00 drive .DB ; current drive #2886 0000AC 00 track .DB ; current track2887 0000AD 00 head .DB ; current side2888 0000AE 00 sector .DB ; start sector2889 0000AF 00 sectnum .DB ; sector's number/track2890 0000B0 00 maxsect .DB ; max. number of sects/track + 12891 0000B1 00 eot .DB ; end of track2892 0000B2 00 gap3 .DB ; gap 3 length2893 0000B3 00 dmast .DB ; save dma status reg.2894 0000B4 00 fdop .DB ; fdc function index2895 0000B5 00 vdop .DB ; ram disk operation2896 0000B6 00 opfg .DB ; flag param's28972898 0000B6 fmtfg .EQU opfg2899 0000B2 buftst .EQU gap3 ; used by ram disk29002901 0000B7 00 dskfmt .DB ; disk format2902 0000B8 00 fmtfill .DB ; fill byte while format2903 0000B9 00 tmpa .DB2904 0000BA 00 tmpx .DB2905 0000BB 00 retries .DB ; retries #29062907 0000BB xmbank .EQU retries ; bank that hold ram disk2908 0000B9 mcand1 .EQU tmpa ; used by ram disk2909 0000BA mcand2 .EQU tmpx29102911 000028 FDCTMP_SIZ .EQU ($-FDCTMP_START)29122913 .ENDS29142915 .CODEF82916 .GLOBAL fdinit, vdinit2917 ;.EXTERN LF8Tst, getctime2918 F8921B2919 .LONGA off2920 .LONGI off2921 F8921B2922 F8921B .DS 3729232924 ;---------------------------------------------------------------------------Tue Jul 17 11:00:16 2018 Page 72925 ; System interface2926 ;---------------------------------------------------------------------------29272928 ;---------------------------------------------------------------------------2929 ; sys_fdrw - read/write/verify sectors in floppy disk2930 ;2931 ; prototype: sys_fdrw(bDrive, bTrak, bHead, bSect, bNum, bBuf, bFlag)2932 ;2933 ; Params (7 bytes):2934 ; bDrive = drive number (0..1)2935 ; bTrak = track number ($00..$4F)2936 ; bHead = head number ($00..$01)2937 ; bSect = sector number ($01...)2938 ; bNum = number of sectors to be read/write ($01...)2939 ; bBuf = buffer number ($00..$FF)2940 ; bFlag = flag2941 ; <7>: verify data after writing2942 ; <0>: CBM format (otherwise DOS format)2943 ;2944 ; Out:2945 ; CF = 0 if operation completed successfully2946 ; C = number of bytes effectively transferred2947 ; X = disk format ($00, $01, $02, $03)2948 ; Y = unchanged2949 ; CF = 1 if error2950 ; C = number of bytes effectively transferred2951 ; X = disk format ($00, $01, $02, $03, $FF)2952 ; Y = error code2953 ; Status register always preserved except carry29542955 ; params offset2956 000013 bFlag .SET STKPRMS2957 000014 bBuf .SET STKPRMS + 12958 000015 bNum .SET STKPRMS + 22959 000016 bSect .SET STKPRMS + 32960 000017 bHead .SET STKPRMS + 42961 000018 bTrak .SET STKPRMS + 52962 000019 bDrive .SET STKPRMS + 629632964 F89240 sys_fdrw:2965 .GLOBAL sys_fdrw29662967 F89240 ACC16 ; retrieve function number2968 F89240 C2 20 rep #PMFLAG2969 .LONGA on2970 .MNLIST2971 F89242 A3 10 lda STKPCL,s ; pointer to byte after signature2972 F89244 85 51 sta COPPtr2973 F89246 1A inc a ; update return address2974 F89247 83 10 sta STKPCL,s2975 F89249 64 96 stz ntrsf ; clear bytes transferred2976 F8924B ACC08 ; A,M -> 8 bit2977 F8924B E2 20 sep #PMFLAG2978 .LONGA off2979 .MNLIST2980 F8924D 64 48 stz fdcerr2981 F8924F 64 B3 stz dmastTue Jul 17 11:00:16 2018 Page 82982 F89251 A9 FF lda #$FF ; invalid format2983 F89253 85 B7 sta dskfmt2984 F89255 A3 12 lda STKPBR,s ; bank where was executed cop instruction2985 F89257 85 53 sta COPPtr+22986 F89259 A7 51 lda [COPPtr] ; byte after signature2987 F8925B C9 03 cmp #$03 ; right value: 0,1,22988 F8925D B0 50 bcs ?12 ; error2989 F8925F 85 B4 sta fdop2990 F89261 A3 19 lda bDrive,s ; drive number2991 F89263 AA tax2992 F89264 E0 02 cpx #FDMAXDRIVE2993 F89266 B0 4B bcs ?14 ; error2994 F89268 85 AB sta drive2995 F8926A A3 18 lda bTrak,s ; track number2996 F8926C C9 50 cmp #$50 ; max track number $4F2997 F8926E B0 47 bcs ?16 ; error2998 F89270 85 AC sta track2999 F89272 A3 17 lda bHead,s ; head number3000 F89274 C9 02 cmp #$023001 F89276 B0 3F bcs ?163002 F89278 85 AD sta head3003 F8927A 38 sec3004 F8927B A3 16 lda bSect,s ; starting sector3005 F8927D F0 38 beq ?163006 F8927F 85 AE sta sector3007 F89281 A3 15 lda bNum,s ; number of sector3008 F89283 F0 32 beq ?163009 F89285 85 AF sta sectnum3010 F89287 A3 14 lda bBuf,s ; buffer number3011 F89289 85 9C sta dmabuf3012 F8928B A3 13 lda bFlag,s ; flag3013 F8928D 29 81 and #$81 ; mask bit 7 and bit 03014 F8928F 85 B6 sta opfg3015 F89291 8A txa ; phisycal drive?3016 F89292 F0 11 beq ?08 ; yes3017 F89294 A5 45 lda vdrive ; ram disk formatted?3018 F89296 10 13 bpl ?10 ; no3019 F89298 29 03 and #$033020 F8929A C9 03 cmp #$03 ; format $03?3021 F8929C F0 0D beq ?10 ; yes, invalid format3022 F8929E 85 B7 sta dskfmt ; current ram disk format3023 F892A0 20 99 9E jsr vdrw ; ram disk operation3024 F892A3 80 1C bra ?243025 F892A5 24 46 ?08: bit fdcctl ; drive attached?3026 F892A7 30 15 bmi ?22 ; yes3027 F892A9 80 08 bra ?143028 F892AB A9 0D ?10: lda #FDC_BADFMT3029 F892AD 80 0A bra ?203030 F892AF A9 15 ?12: lda #FDC_BADOP3031 F892B1 80 06 bra ?203032 F892B3 A9 0E ?14: lda #FDC_NODRIVE ; invalid drive3033 F892B5 80 02 bra ?203034 F892B7 A9 14 ?16: lda #FDC_PARAMS3035 F892B9 85 48 ?20: sta fdcerr3036 F892BB 38 sec3037 F892BC 80 03 bra ?243038 F892BE 20 E1 94 ?22: jsr fdrw ; fd operationTue Jul 17 11:00:16 2018 Page 93039 F892C1 ?24: ACC16 ; report out data3040 F892C1 C2 20 rep #PMFLAG3041 .LONGA on3042 .MNLIST3043 F892C3 A5 96 lda ntrsf3044 F892C5 83 0D sta STKCR,s3045 F892C7 ACC083046 F892C7 E2 20 sep #PMFLAG3047 .LONGA off3048 .MNLIST3049 F892C9 A5 B7 lda dskfmt3050 F892CB 83 0B sta STKXR,s3051 F892CD A9 00 lda #03052 F892CF 83 0C sta STKXR+1,s3053 F892D1 A5 48 lda fdcerr ; error code if CF=13054 F892D3 6B rtl3055 F892D43056 ;---------------------------------------------------------------------------3057 ; sys_fdtrack - read/write/verify whole track (both side) on floppy disk3058 ;3059 ; prototype: sys_fdtrack(bDrive, bTrak, bBuf, bFlag)3060 ;3061 ; Params (4 bytes):3062 ; bDrive = drive number3063 ; bTrak = track number ($00..$4F)3064 ; bBuf = buffer number ($00..$FF)3065 ; bFlag = flag3066 ; <7>: verify data after writing3067 ; <0>: CBM format (otherwise DOS format)3068 ;3069 ; Out:3070 ; CF = 0 if operation completed successfully3071 ; C = number of bytes effectively transferred3072 ; X = disk format ($00, $01, $02, $03)3073 ; Y = unchanged3074 ; CF = 1 if error3075 ; C = number of bytes effectively transferred3076 ; X = disk format ($00, $01, $02, $03, $FF)3077 ; Y = error code3078 ; Status register always preserved except carry30793080 ; params offset3081 000013 bFlag .SET STKPRMS3082 000014 bBuf .SET STKPRMS + 13083 000015 bTrak .SET STKPRMS + 23084 000016 bDrive .SET STKPRMS + 330853086 F892D4 sys_fdtrack:3087 .GLOBAL sys_fdtrack30883089 F892D4 ACC16 ; retrieve function number3090 F892D4 C2 20 rep #PMFLAG3091 .LONGA on3092 .MNLIST3093 F892D6 A3 10 lda STKPCL,s ; pointer to byte after signature3094 F892D8 85 51 sta COPPtr3095 F892DA 1A inc a ; update return addressTue Jul 17 11:00:16 2018 Page 103096 F892DB 83 10 sta STKPCL,s3097 F892DD 64 96 stz ntrsf ; clear bytes transferred3098 F892DF ACC08 ; A,M -> 8 bit3099 F892DF E2 20 sep #PMFLAG3100 .LONGA off3101 .MNLIST3102 F892E1 64 48 stz fdcerr3103 F892E3 64 B3 stz dmast3104 F892E5 A9 FF lda #$FF3105 F892E7 85 B7 sta dskfmt3106 F892E9 A3 12 lda STKPBR,s ; bank where was executed cop instruction3107 F892EB 85 53 sta COPPtr+23108 F892ED A7 51 lda [COPPtr] ; byte after signature3109 F892EF C9 03 cmp #$03 ; right value: 0,1,23110 F892F1 B0 43 bcs ?12 ; error3111 F892F3 85 B4 sta fdop3112 F892F5 A3 16 lda bDrive,s ; drive number3113 F892F7 AA tax3114 F892F8 E0 02 cpx #FDMAXDRIVE3115 F892FA B0 3E bcs ?14 ; error3116 F892FC 85 AB sta drive3117 F892FE A3 15 lda bTrak,s ; track number3118 F89300 C9 50 cmp #$50 ; max track number $4F3119 F89302 B0 3A bcs ?16 ; error3120 F89304 85 AC sta track3121 F89306 64 AD stz head3122 F89308 A9 01 lda #13123 F8930A 85 AE sta sector3124 F8930C A3 14 lda bBuf,s ; buffer number3125 F8930E 85 9C sta dmabuf3126 F89310 A3 13 lda bFlag,s ; flag3127 F89312 29 81 and #$81 ; mask bit 7 and bit 03128 F89314 09 40 ora #$40 ; flag MT3129 F89316 85 B6 sta opfg3130 F89318 8A txa ; phisycal drive?3131 F89319 F0 11 beq ?08 ; yes3132 F8931B A5 45 lda vdrive ; ram disk formatted?3133 F8931D 10 13 bpl ?10 ; no3134 F8931F 29 03 and #$033135 F89321 C9 03 cmp #$03 ; format $03?3136 F89323 F0 0D beq ?10 ; yes, invalid format3137 F89325 85 B7 sta dskfmt ; current ram disk format3138 F89327 20 99 9E jsr vdrw ; ram disk operation3139 F8932A 80 1C bra ?243140 F8932C 24 46 ?08: bit fdcctl ; drive attached?3141 F8932E 30 15 bmi ?22 ; yes3142 F89330 80 08 bra ?143143 F89332 A9 0D ?10: lda #FDC_BADFMT3144 F89334 80 0A bra ?203145 F89336 A9 15 ?12: lda #FDC_BADOP3146 F89338 80 06 bra ?203147 F8933A A9 0E ?14: lda #FDC_NODRIVE3148 F8933C 80 02 bra ?203149 F8933E A9 14 ?16: lda #FDC_PARAMS3150 F89340 85 48 ?20: sta fdcerr3151 F89342 38 sec3152 F89343 80 03 bra ?24Tue Jul 17 11:00:16 2018 Page 113153 F89345 20 E1 94 ?22: jsr fdrw ; fd drive operation3154 F89348 ?24: ACC16 ; report out data3155 F89348 C2 20 rep #PMFLAG3156 .LONGA on3157 .MNLIST3158 F8934A A5 96 lda ntrsf3159 F8934C 83 0D sta STKCR,s3160 F8934E ACC083161 F8934E E2 20 sep #PMFLAG3162 .LONGA off3163 .MNLIST3164 F89350 A5 B7 lda dskfmt3165 F89352 83 0B sta STKXR,s3166 F89354 A9 00 lda #03167 F89356 83 0C sta STKXR+1,s3168 F89358 A5 48 lda fdcerr ; error code if CF=13169 F8935A 6B rtl31703171 ;---------------------------------------------------------------------------3172 ; sys_fdfmt - low level format whole floppy disk3173 ;3174 ; prototype: sys_fdfmt(bDrive, bFlag, bFill, lpCall)3175 ;3176 ; Params (6 bytes):3177 ; bDrive = drive number3178 ; bFlag = format flag3179 ; <7>: valid callback function in lpCall3180 ; <6>: verify track after format one3181 ; <1>: select H.D. format (otherwise D.D. format)3182 ; <0>: select CBM format (otherwise standard DOS format)3183 ; bFill = fill byte for all sectors3184 ; lpCall = long pointer to callback user function while formatting3185 ;3186 ; Out:3187 ; CF = 0 if operation completed successfully3188 ; A,X,Y preserved3189 ; CF = 1 if error3190 ; A, X preserved3191 ; Y = error code3192 ; Status register always preserved except carry31933194 ; params offset3195 000013 lpCall .SET STKPRMS3196 000016 bFill .SET STKPRMS + 33197 000017 bFlag .SET STKPRMS + 43198 000018 bDrive .SET STKPRMS + 531993200 F8935B sys_fdfmt:3201 .GLOBAL sys_fdfmt32023203 F8935B A3 18 lda bDrive,s ; recover params from stack3204 F8935D 85 AB sta drive ; drive number3205 F8935F A8 tay3206 F89360 A3 17 lda bFlag,s3207 F89362 85 B6 sta fmtfg ; format flag3208 F89364 AA tax3209 F89365 29 03 and #00000011BTue Jul 17 11:00:16 2018 Page 123210 F89367 85 B7 sta dskfmt ; required format3211 F89369 C9 03 cmp #00000011B ; format 3 is invalid3212 F8936B D0 05 bne ?013213 F8936D A9 0D lda #FDC_BADFMT3214 F8936F 38 sec3215 F89370 80 45 bra ?05 ; error3216 F89372 A3 16 ?01: lda bFill,s3217 F89374 85 B8 sta fmtfill ; fill byte3218 F89376 8A txa3219 F89377 10 14 bpl ?04 ; no callback3220 F89379 A3 15 lda lpCall+2,s ; bank that hold callback function3221 F8937B 85 A3 sta lpfn+23222 F8937D D0 06 bne ?02 ; callback function cannot stay in bank $003223 F8937F A9 80 lda #$80 ; invalid callback3224 F89381 14 B6 trb fmtfg ; no callback3225 F89383 80 08 bra ?043226 F89385 ?02: CPU163227 F89385 C2 30 rep #(PMFLAG.OR.PXFLAG)3228 .LONGA on3229 .LONGI on3230 .MNLIST3231 F89387 A3 13 lda lpCall,s ; address of callback function3232 F89389 85 A1 sta lpfn3233 F8938B CPU083234 F8938B E2 30 sep #(PMFLAG.OR.PXFLAG)3235 .LONGA off3236 .LONGI off3237 .MNLIST3238 F8938D A9 00 ?04: lda #03239 F8938F AA tax3240 F89390 85 48 sta fdcerr ; clear error3241 F89392 85 AC sta track3242 F89394 85 AD sta head3243 F89396 85 9E sta bufp ; set dma buffer at $0300003244 F89398 85 9F sta bufp+13245 F8939A 1A inc a3246 F8939B 85 AE sta sector ; sector = 13247 F8939D 1A inc a3248 F8939E 1A inc a3249 F8939F 85 A0 sta bufp+23250 F893A1 CA dex3251 F893A2 86 9B stx dtlstp ; DTL/STP = $FF3252 F893A4 A6 B7 ldx dskfmt3253 F893A6 BF A1 A0 F8 lda >MAXSECT,x3254 F893AA 85 B0 sta maxsect ; max. numbers of sectors/track + 13255 F893AC 3A dec a3256 F893AD 85 AF sta sectnum ; sectors/track3257 F893AF 85 B1 sta eot ; end of track3258 F893B1 C0 02 cpy #FDMAXDRIVE3259 F893B3 90 05 bcc ?063260 F893B5 A9 0E lda #FDC_NODRIVE3261 F893B7 85 48 ?05: sta fdcerr3262 F893B9 6B rtl3263 F893BA BB ?06: tyx ; phisycal drive?3264 F893BB F0 05 beq ?08 ; yes3265 F893BD 20 F1 9D jsr vdfmt ; ram disk formattation3266 F893C0 80 03 bra ?10Tue Jul 17 11:00:16 2018 Page 133267 F893C2 20 7E 95 ?08: jsr fdfmt ; format floppy disk3268 F893C5 A5 48 ?10: lda fdcerr ; report error if one3269 F893C7 6B rtl32703271 ;---------------------------------------------------------------------------3272 ; sys_fdverf - verify integrity of low level format of whole floppy disk3273 ;3274 ; prototype: sys_fdverf(bDrive, lpCall)3275 ;3276 ; Params (4 bytes):3277 ; bDrive = drive number3278 ; lpCall = long pointer to callback user function while verify3279 ; if lpCall = null the callback function is not called3280 ; callback function ignored for ram disk3281 ;3282 ; Out:3283 ; CF = 0 if operation completed successfully3284 ; A,X preserved3285 ; Y = disk format3286 ; CF = 1 if error3287 ; A, X preserved3288 ; Y = error code3289 ; Status register always preserved except carry32903291 ; params offset3292 000013 lpCall .SET STKPRMS3293 000016 bDrive .SET STKPRMS + 332943295 F893C8 sys_fdverf:3296 .GLOBAL sys_fdverf32973298 F893C8 64 B6 stz fmtfg ; no callback3299 F893CA 64 48 stz fdcerr3300 F893CC A3 16 lda bDrive,s ; recover params from stack3301 F893CE 85 AB sta drive ; drive number3302 F893D0 A8 tay3303 F893D1 A3 15 lda lpCall+2,s ; bank that hold callback function3304 F893D3 85 A3 sta lpfn+23305 F893D5 F0 0C beq ?02 ; callback function cannot stay in bank $003306 F893D7 CPU163307 F893D7 C2 30 rep #(PMFLAG.OR.PXFLAG)3308 .LONGA on3309 .LONGI on3310 .MNLIST3311 F893D9 A3 13 lda lpCall,s ; address of callback function3312 F893DB 85 A1 sta lpfn3313 F893DD CPU083314 F893DD E2 30 sep #(PMFLAG.OR.PXFLAG)3315 .LONGA off3316 .LONGI off3317 .MNLIST3318 F893DF A9 80 lda #$80 ; call callback function3319 F893E1 04 B6 tsb fmtfg3320 F893E3 C0 02 ?02: cpy #FDMAXDRIVE3321 F893E5 90 05 bcc ?063322 F893E7 A9 0E lda #FDC_NODRIVE ; error3323 F893E9 85 48 ?04: sta fdcerrTue Jul 17 11:00:16 2018 Page 143324 F893EB 6B rtl3325 F893EC BB ?06: tyx ; phisycal drive?3326 F893ED F0 0E beq ?10 ; yes3327 F893EF A5 45 lda vdrive ; ram disk formatted?3328 F893F1 30 05 bmi ?08 ; yes3329 F893F3 A9 0D lda #FDC_BADFMT3330 F893F5 38 sec3331 F893F6 80 F1 bra ?043332 F893F8 29 0B ?08: and #000000113333 F893FA 18 clc3334 F893FB 80 07 bra ?123335 F893FD 20 67 96 ?10: jsr fdverf ; verify floppy disk format3336 F89400 B0 08 bcs ?143337 F89402 A5 B7 lda dskfmt ; get format3338 F89404 83 09 ?12: sta STKYR,s3339 F89406 A9 00 lda #03340 F89408 83 0A sta STKYR+1,s3341 F8940A A5 48 ?14: lda fdcerr ; report error if one3342 F8940C 6B rtl33433344 ;---------------------------------------------------------------------------3345 ; sys_fdctl - control function3346 ;3347 ; prototype: sys_fdctl(X=drive number if required)3348 ;3349 ; Functions:3350 ; $00: reset FDC controller3351 ; input reg.: none3352 ; output reg.: unchanged3353 ; $01: POST routine (init FDC controller)3354 ; input reg.: none3355 ; output reg.: unchanged3356 ; $02: get drive status3357 ; input reg.: X = drive number3358 ; output reg.: Y = drive status (ST3), A,X unchanged3359 ; output reg.: A,X,Y unchanged3360 ; $03: check if disk inserted into drive3361 ; input reg.: X = drive number3362 ; output reg.: unchanged3363 ; $04: get format diskette if inserted into drive3364 ; input reg.: X = drive number3365 ; output reg.: Y = diskette format, A,X unchanged3366 ; $05: set write protect bit on ram disk (no effect for phis. drive)3367 ; input reg.: X = drive number3368 ; output reg.: unchanged3369 ; $06: reset write protect bit on ram disk (no effect for phis. drive)3370 ; input reg.: X = drive number3371 ; output reg.: unchanged3372 ; Out:3373 ; CF = 0 if operation completed successfully3374 ; CF = 1 if error3375 ; A, X preserved3376 ; Y = error code3377 ; Status register always preserved except carry3378 F8940D sys_fdctl:3379 .GLOBAL sys_fdctl3380Tue Jul 17 11:00:16 2018 Page 153381 F8940D ACC16 ; retrieve function number3382 F8940D C2 20 rep #PMFLAG3383 .LONGA on3384 .MNLIST3385 F8940F A3 10 lda STKPCL,s ; pointer to byte after signature3386 F89411 85 51 sta COPPtr3387 F89413 1A inc a ; update return address3388 F89414 83 10 sta STKPCL,s3389 F89416 ACC08 ; A,M -> 8 bit3390 F89416 E2 20 sep #PMFLAG3391 .LONGA off3392 .MNLIST3393 F89418 A3 12 lda STKPBR,s ; bank where was executed cop instruction3394 F8941A 85 53 sta COPPtr+23395 F8941C A3 0B lda STKXR,s3396 F8941E 85 AB sta drive ; get drive # (X reg.)3397 F89420 A7 51 lda [COPPtr] ; byte after signature3398 F89422 C9 07 cmp #MXCTLFN3399 F89424 90 05 bcc ?043400 F89426 A9 15 lda #FDC_BADOP3401 F89428 85 48 sta fdcerr3402 F8942A 60 rts3403 F8942B 64 48 ?04: stz fdcerr3404 F8942D 0A asl a3405 F8942E AA tax ; function index3406 F8942F FC 93 A0 jsr (CTLFN,x)3407 F89432 A5 48 lda fdcerr ; return error code if any3408 F89434 6B rtl34093410 ; ctl function 0: reset controller3411 F89435 ctl_fn0:3412 F89435 20 3A 9B jsr fdcrst3413 F89438 85 48 sta fdcerr3414 F8943A 60 rts34153416 ; ctl function 1: POST routine (init)3417 F8943B ctl_fn1:3418 F8943B 4C B6 9F jmp fdinit34193420 ; ctl function 2: get drive status3421 F8943E ctl_fn2:3422 F8943E 20 C9 94 jsr ctl_tst ; check drive #3423 F89441 AA tax ; phisycal drive?3424 F89442 F0 10 beq ?10 ; yes3425 F89444 A5 45 lda vdrive ; bit 4: wp on bit3426 F89446 0A asl a3427 F89447 0A asl a ; shift to bit 63428 F89448 29 40 and #01000000B3429 F8944A 09 20 ora #00100000B ; ready bit3430 F8944C 18 clc3431 F8944D 83 0B ?05: sta STKYR+2,s ; report status3432 F8944F A9 00 lda #03433 F89451 83 0C sta STKYR+3,s3434 F89453 60 rts3435 F89454 20 D6 94 ?10: jsr ctl_dr ; check drive attached3436 F89457 20 2E 99 jsr drvst3437 F8945A 90 F1 bcc ?05Tue Jul 17 11:00:16 2018 Page 163438 F8945C 60 rts3439 F8945D3440 ; ctl function 3: check disk ready3441 F8945D ctl_fn3:3442 F8945D 20 C9 94 jsr ctl_tst ; check drive #3443 F89460 AA tax ; phisycal drive?3444 F89461 F0 0F beq ?10 ; yes3445 F89463 24 45 bit vdrive ; test bit 6: change disk bit3446 F89465 18 clc3447 F89466 50 09 bvc ?05 ; disk not changed3448 F89468 A9 40 lda #$403449 F8946A 14 45 trb vdrive ; reset change disk bit3450 F8946C A9 11 lda #FDC_CHANGE3451 F8946E 85 48 sta fdcerr3452 F89470 38 sec3453 F89471 60 ?05: rts3454 F89472 20 D6 94 ?10: jsr ctl_dr ; check drive attached3455 F89475 20 D7 98 jsr chkdsk ; change disk line test3456 F89478 4C 77 95 jmp stop34573458 ; ctl function 4: get disk format3459 F8947B ctl_fn4:3460 F8947B 20 C9 94 jsr ctl_tst ; check drive #3461 F8947E AA tax ; phisycal drive?3462 F8947F F0 14 beq ?10 ; yes3463 F89481 A5 45 lda vdrive ; test bit 7: ram disk formatted?3464 F89483 30 06 bmi ?02 ; yes3465 F89485 A9 0D lda #FDC_BADFMT3466 F89487 85 48 sta fdcerr3467 F89489 38 sec3468 F8948A 60 rts3469 F8948B 29 03 ?02: and #00000011B ; report current format3470 F8948D 83 0B sta STKYR+2,s3471 F8948F A9 00 lda #03472 F89491 83 0C sta STKYR+3,s3473 F89493 18 clc3474 F89494 60 rts3475 F89495 64 44 ?10: stz fdcdrv ; get disk format - invalidate current format3476 F89497 20 3F 98 jsr chkfmt ; try to check format3477 F8949A B0 12 bcs ?20 ; error3478 F8949C A5 44 lda fdcdrv ; update format3479 F8949E 29 7C and #01111100B3480 F894A0 05 B7 ora dskfmt3481 F894A2 09 80 ora #$80 ; recognized format3482 F894A4 85 44 sta fdcdrv3483 F894A6 A5 B7 lda dskfmt ; report format in Y reg.3484 F894A8 83 0B sta STKYR+2,s3485 F894AA A9 00 lda #03486 F894AC 83 0C sta STKYR+3,s3487 F894AE 4C 77 95 ?20: jmp stop34883489 ; ctl function 5: set write protect bit on ram disk3490 F894B1 ctl_fn5:3491 F894B1 20 C9 94 jsr ctl_tst ; check drive #3492 F894B4 AA tax ; phisycal drive?3493 F894B5 F0 04 beq ?10 ; yes, done3494 F894B7 A9 10 lda #$10 ; set bit 4Tue Jul 17 11:00:16 2018 Page 173495 F894B9 04 45 tsb vdrive3496 F894BB 18 ?10: clc3497 F894BC 60 rts34983499 ; ctl function 6: reset write protect bit on ram disk3500 F894BD ctl_fn6:3501 F894BD 20 C9 94 jsr ctl_tst ; check drive #3502 F894C0 AA tax ; phisycal drive?3503 F894C1 F0 04 beq ?10 ; yes, done3504 F894C3 A9 10 lda #$10 ; reset bit 43505 F894C5 14 45 trb vdrive3506 F894C7 18 ?10: clc3507 F894C8 60 rts35083509 ; test drive number3510 F894C9 ctl_tst:3511 F894C9 A5 AB lda drive3512 F894CB C9 02 cmp #FDMAXDRIVE3513 F894CD 90 06 bcc ?103514 F894CF A9 0E lda #FDC_NODRIVE ; error: invalid drive3515 F894D1 85 48 sta fdcerr3516 F894D3 68 pla ; skip return address3517 F894D4 68 pla3518 F894D5 60 ?10: rts35193520 ; test if drive is attached to controller3521 F894D6 ctl_dr:3522 F894D6 24 46 bit fdcctl3523 F894D8 30 06 bmi ?103524 F894DA A9 0E lda #FDC_NODRIVE ; error: invalid drive3525 F894DC 85 48 sta fdcerr3526 F894DE 68 pla ; skip return address3527 F894DF 68 pla3528 F894E0 60 ?10: rts35293530 ;---------------------------------------------------------------------------3531 ; fdc read/write & format routines3532 ;---------------------------------------------------------------------------35333534 ; execute read/verf/write track/sector's on floppy disk3535 ; param's:3536 ; fdop=fdc operation (0=read,1=fake verify,2=write)3537 ; track=fd track3538 ; sector=fd first sector3539 ; head=fd side3540 ; eot=fd last sector3541 ; gap3=gap3 length for read/write3542 ; dtlstp=fd DTL/STP param3543 ; ncnt=bytes # to transfer3544 ; opfg<7>=verify buffer with disk3545 ; opfg<6>=MT command (multi track)3546 ; bufp=buffer pointer3547 ; verfp=verify buffer pointer3548 ;3549 ; out: CF=1 if error, fdcerr hold error code3550 F894E1 fdrw:3551 F894E1 20 3F 98 jsr chkfmt ; start motor and test disk formatTue Jul 17 11:00:16 2018 Page 183552 F894E4 90 03 bcc ?003553 F894E6 4C 77 95 jmp stop ; stop motor3554 F894E9 20 60 9D ?00: jsr chkparms ; check params3555 F894EC 90 03 bcc ?013556 F894EE 4C 77 95 jmp stop ; stop motor3557 F894F1 A9 05 ?01: lda #maxret ; retries count3558 F894F3 85 BB sta retries3559 F894F5 24 B6 bit opfg ; will verify buffer?3560 F894F7 10 03 bpl ?02 ; no3561 F894F9 20 2C 9D jsr savebuf ; save dma buffer for verify3562 F894FC A4 AC ?02: ldy track ; seek track3563 F894FE 20 C6 99 jsr seek3564 F89501 B0 55 bcs ?14 ; error: retry?3565 F89503 A6 B4 ldx fdop3566 F89505 BF B1 A0 F8 lda >CMDTAB,x ; FDC command3567 F89509 48 pha3568 F8950A BF B4 A0 F8 lda >DMATAB,x ; DMA mode3569 F8950E EB xba ; B=dma mode3570 F8950F A6 9E ldx bufp3571 F89511 A4 9F ldy bufp+13572 F89513 A5 A0 lda bufp+23573 F89515 20 7C 9A jsr dmaset ; dma setup3574 F89518 68 pla ; FDC command3575 F89519 24 B6 bit opfg3576 F8951B 50 02 bvc ?04 ; no MT3577 F8951D 09 80 ora #$80 ; MT operation3578 F8951F 20 6F 97 ?04: jsr fdcmd ; execute command3579 F89522 B0 34 bcs ?14 ; error: retry?3580 F89524 24 B6 bit opfg ; will verify data?3581 F89526 10 36 bpl ?16 ; no -- no error3582 F89528 A9 46 lda #WRITETRASF ; read disk into verify buffer3583 F8952A EB xba ; dma mode (read data)3584 F8952B A6 A1 ldx verfp3585 F8952D A4 A2 ldy verfp+13586 F8952F A5 A3 lda verfp+23587 F89531 20 7C 9A jsr dmaset ; dma setup3588 F89534 A9 66 lda #CMDREAD3589 F89536 24 B6 bit opfg3590 F89538 50 02 bvc ?06 ; no MT3591 F8953A 09 80 ora #$80 ; MT operation3592 F8953C 20 6F 97 ?06: jsr fdcmd ; execute command3593 F8953F B0 17 bcs ?14 ; error: retry?3594 F89541 A0 00 ldy #03595 F89543 INDEX16 ; verify buffer's3596 F89543 C2 10 rep #PXFLAG3597 .LONGI on3598 .MNLIST3599 F89545 B7 9E ?08: lda [bufp],y3600 F89547 D7 A1 cmp [verfp],y3601 F89549 D0 05 bne ?10 ; unmatch (ZF=0)3602 F8954B C8 iny3603 F8954C C4 94 cpy ncnt3604 F8954E 90 F5 bcc ?083605 F89550 ?10: INDEX08 ; here ZF=1 if match, ZF=0 if not3606 F89550 E2 10 sep #PXFLAG3607 .LONGI off3608 .MNLISTTue Jul 17 11:00:16 2018 Page 193609 F89552 18 clc ; assume no error3610 F89553 F0 09 beq ?16 ; match3611 F89555 A9 12 lda #FDC_VER ; verify error3612 F89557 38 sec3613 F89558 C6 BB ?14: dec retries ; try again?3614 F8955A D0 A0 bne ?02 ; yes3615 F8955C 80 0A bra ?18 ; CF=1, A=error code3616 F8955E A5 44 ?16: lda fdcdrv ; set valid format3617 F89560 29 7C and #01111100B3618 F89562 05 B7 ora dskfmt ; update format in drive3619 F89564 09 A0 ora #$A0 ; current valid format&trust bit3620 F89566 85 44 sta fdcdrv3621 F89568 24 B6 ?18: bit opfg ; will restore dma buffer after verify?3622 F8956A 10 03 bpl done ; no3623 F8956C 20 44 9D jsr restbuf ; restore dma buffer36243625 ; end fdc operation: reset controller if any error3626 ; stop motor & set fdcerr if error3627 ; in: CF=1 if error, A=error code3628 F8956F done:3629 F8956F 90 0A bcc stop23630 F89571 48 pha ; save error code3631 F89572 20 3A 9B jsr fdcrst ; reset controller after error3632 F89575 68 pla ; restore error code3633 F89576 38 sec36343635 ; stop motor & set error code if any3636 ; in: CF=1 if error, A=error code3637 F89577 stop:3638 F89577 90 02 bcc stop23639 F89579 85 48 sta fdcerr ; set error code3640 F8957B stop2:3641 F8957B 4C 07 9D jmp stopmtr36423643 ; format whole floppy disk3644 ; out: CF=1 if error, fdcerr hold error code3645 F8957E fdfmt:3646 F8957E 24 46 bit fdcctl ; drive attached?3647 F89580 30 06 bmi ?02 ; yes3648 F89582 A9 0E lda #FDC_NODRIVE3649 F89584 85 48 sta fdcerr3650 F89586 38 sec3651 F89587 60 rts3652 F89588 20 D7 98 ?02: jsr chkdsk ; start motor and check if disk in drive3653 F8958B 90 02 bcc ?04 ; ok - ready3654 F8958D 50 E8 bvc stop ; not ready, stop motor&exit3655 F8958F A9 10 ?04: lda #$10 ; test disk write protect on3656 F89591 24 44 bit fdcdrv3657 F89593 F0 04 beq ?063658 F89595 A9 0B lda #FDC_WP ; wp on error3659 F89597 80 DE bra stop ; stop motor&exit3660 F89599 64 48 ?06: stz fdcerr ; clear error3661 F8959B A5 44 lda fdcdrv ; reset format3662 F8959D 29 5C and #01011100B3663 F8959F 85 44 sta fdcdrv3664 F895A1 24 44 bit fdcdrv ; need to call seek0 double step?3665 F895A3 70 05 bvs ?08 ; noTue Jul 17 11:00:16 2018 Page 203666 F895A5 20 95 99 jsr seek0 ; double step seek track 03667 F895A8 B0 CD bcs stop ; error3668 F895AA A5 B7 ?08: lda dskfmt ; set FDC rate3669 F895AC 20 BB 9C jsr setrate3670 F895AF A9 01 lda #$01 ; reset bit 0...3671 F895B1 14 B6 trb fmtfg ; ...for first call to callback3672 F895B3 ACC163673 F895B3 C2 20 rep #PMFLAG3674 .LONGA on3675 .MNLIST3676 F895B5 3B tsc ; make room for a local buffer in stack3677 F895B6 38 sec3678 F895B7 E9 50 00 sbc #803679 F895BA 1B tcs3680 F895BB 1A inc a ; pointer to temp. buffer3681 F895BC 85 98 sta ptmp3682 F895BE ACC083683 F895BE E2 20 sep #PMFLAG3684 .LONGA off3685 .MNLIST3686 F895C0 A0 4F ldy #79 ; save buffer dma in temp. buffer3687 F895C2 B7 9E ?09: lda [bufp],y3688 F895C4 91 98 sta (ptmp),y3689 F895C6 88 dey3690 F895C7 10 F9 bpl ?093691 F895C9 C8 iny ; Y=03692 F895CA BB tyx ; X=03693 F895CB 84 AC ?10: sty track ; format this track...3694 F895CD 86 AD ?11: stx head ; ...in this side3695 F895CF A9 05 lda #maxret3696 F895D1 85 BB sta retries ; retries count3697 F895D3 A0 00 ?12: ldy #0 ; fill buffer with data for current track/head3698 F895D5 A2 01 ldx #1 ; X=sector3699 F895D7 A5 AC ?14: lda track3700 F895D9 97 9E sta [bufp],y ; C=track3701 F895DB C8 iny3702 F895DC A5 AD lda head3703 F895DE 97 9E sta [bufp],y ; H=head3704 F895E0 C8 iny3705 F895E1 8A txa3706 F895E2 97 9E sta [bufp],y ; R=sector3707 F895E4 C8 iny3708 F895E5 A9 02 lda #23709 F895E7 97 9E sta [bufp],y ; N=size of sector3710 F895E9 C8 iny3711 F895EA E8 inx3712 F895EB E4 B0 cpx maxsect ; loop3713 F895ED 90 E8 bcc ?143714 F895EF 84 94 sty ncnt ; DMA count of bytes3715 F895F1 64 95 stz ncnt+13716 F895F3 20 32 98 jsr tstrdy ; test disk ready3717 F895F6 B0 4A bcs ?20 ; error - no disk or disk changed3718 F895F8 A9 4A lda #READTRASF ; read transfer3719 F895FA EB xba ; B=dma mode3720 F895FB A6 9E ldx bufp3721 F895FD A4 9F ldy bufp+13722 F895FF A5 A0 lda bufp+2Tue Jul 17 11:00:16 2018 Page 213723 F89601 20 7C 9A jsr dmaset3724 F89604 24 B6 bit fmtfg3725 F89606 10 13 bpl ?16 ; no callback3726 F89608 4B phk ; JSL simulation3727 F89609 F4 1A 96 pea #?16-1 ; return address3728 F8960C A5 B1 lda eot ; params for callback3729 F8960E EB xba ; B = sector/track3730 F8960F A5 B6 lda fmtfg3731 F89611 4A lsr a ; bit 0 -> carry -> 0 if first call3732 F89612 A5 AB lda drive ; A = drive3733 F89614 A4 AC ldy track ; Y = track3734 F89616 A6 AD ldx head ; X = head3735 F89618 DC A1 00 jmp [lpfn]3736 ?16: ; return from notify callback3737 F8961B A4 AC ldy track ; track seek3738 F8961D 20 C6 99 jsr seek3739 F89620 B0 20 bcs ?20 ; seek error3740 F89622 20 07 97 jsr fdftcmd ; format track3741 F89625 90 06 bcc ?18 ; no error3742 F89627 C6 BB dec retries3743 F89629 D0 A8 bne ?12 ; try again3744 F8962B 80 15 bra ?203745 F8962D A9 01 ?18: lda #$013746 F8962F 04 B6 tsb fmtfg ; bit 0 = 1 -> for callback3747 F89631 A6 AD ldx head ; next side3748 F89633 E8 inx3749 F89634 E0 02 cpx #23750 F89636 90 95 bcc ?11 ; format same track in next side3751 F89638 A2 00 ldx #0 ; restart side=03752 F8963A A4 AC ldy track ; next track3753 F8963C C8 iny3754 F8963D C0 50 cpy #803755 F8963F 90 8A bcc ?10 ; format next track3756 F89641 18 clc ; format end without error3757 F89642 08 ?20: php ; save carry3758 F89643 FA plx ; save carry in X bit 03759 F89644 A0 4F ldy #79 ; restore buffer dma3760 F89646 B1 98 ?22: lda (ptmp),y3761 F89648 97 9E sta [bufp],y3762 F8964A 88 dey3763 F8964B 10 F9 bpl ?223764 F8964D ACC16CLC3765 F8964D C2 21 rep #(PMFLAG.OR.PCFLAG)3766 .LONGA on3767 .MNLIST3768 F8964F 3B tsc ; restore stack frame3769 F89650 69 50 00 adc #803770 F89653 1B tcs3771 F89654 ACC083772 F89654 E2 20 sep #PMFLAG3773 .LONGA off3774 .MNLIST3775 F89656 8A txa ; A = saved status3776 F89657 4A lsr a ; CF=1 if error3777 F89658 B0 0A bcs ?24 ; error3778 F8965A A5 44 lda fdcdrv ; set valid format3779 F8965C 29 7C and #01111100BTue Jul 17 11:00:16 2018 Page 223780 F8965E 05 B7 ora dskfmt ; update format in selected drive3781 F89660 09 80 ora #$80 ; current valid format (but not trust bit)3782 F89662 85 44 sta fdcdrv3783 F89664 4C 6F 95 ?24: jmp done ; stop motor - reset controller if error37843785 ; verify low level format of floppy disk3786 ; out: CF=1 if error, fdcerr hold error code3787 F89667 fdverf:3788 F89667 24 46 bit fdcctl ; drive attached?3789 F89669 30 06 bmi ?02 ; yes3790 F8966B A9 0E lda #FDC_NODRIVE3791 F8966D 85 48 sta fdcerr3792 F8966F 38 sec3793 F89670 60 rts3794 F89671 64 44 ?02: stz fdcdrv ; get disk format - invalidate current format3795 F89673 20 3F 98 jsr chkfmt ; try to check format3796 F89676 90 03 bcc ?063797 F89678 4C 77 95 ?04: jmp stop ; error3798 F8967B A9 00 ?06: lda #03799 F8967D AA tax3800 F8967E 85 9E sta bufp ; set dma buffer at $0300003801 F89680 85 9F sta bufp+1 ; fake transfer3802 F89682 1A inc a3803 F89683 85 AE sta sector ; sector = 13804 F89685 1A inc a3805 F89686 1A inc a3806 F89687 85 A0 sta bufp+23807 F89689 CA dex3808 F8968A 86 9B stx dtlstp ; DTL/STP = $FF3809 F8968C A6 B7 ldx dskfmt3810 F8968E BF A1 A0 F8 lda >MAXSECT,x3811 F89692 85 B0 sta maxsect ; max. numbers of sectors/track + 13812 F89694 3A dec a3813 F89695 85 AF sta sectnum ; sectors/track3814 F89697 85 B1 sta eot ; end of track3815 F89699 0A asl a ; num. of bytes3816 F8969A 85 95 sta ncnt+13817 F8969C 64 94 stz ncnt3818 F8969E A0 00 ldy #0 ; Y=03819 F896A0 BB tyx ; X=03820 F896A1 84 AC ?10: sty track ; check this track...3821 F896A3 86 AD ?11: stx head ; ...in this side3822 F896A5 A9 05 lda #maxret3823 F896A7 85 BB sta retries ; retries count3824 F896A9 20 32 98 ?12: jsr tstrdy ; test disk3825 F896AC B0 CA bcs ?04 ; error - no disk or disk changed3826 F896AE A9 42 lda #VERFTRASF ; fake transfer, only check track3827 F896B0 EB xba ; B=dma mode3828 F896B1 A6 9E ldx bufp ; buffer pointer3829 F896B3 A4 9F ldy bufp+13830 F896B5 A5 A0 lda bufp+23831 F896B7 20 7C 9A jsr dmaset3832 F896BA 24 B6 bit fmtfg3833 F896BC 10 13 bpl ?14 ; no callback3834 F896BE 4B phk ; JSL simulation3835 F896BF F4 D0 96 pea #?14-1 ; return address3836 F896C2 A5 B7 lda dskfmtTue Jul 17 11:00:16 2018 Page 233837 F896C4 EB xba ; B = sector/track3838 F896C5 A5 B6 lda fmtfg3839 F896C7 4A lsr a ; bit 0 -> carry -> 0 if first call3840 F896C8 A5 AB lda drive ; A = drive3841 F896CA A4 AC ldy track ; Y = track3842 F896CC A6 AD ldx head3843 F896CE DC A1 00 jmp [lpfn]3844 ?14: ; return from notify callback3845 F896D1 A4 AC ldy track ; track seek3846 F896D3 20 C6 99 jsr seek3847 F896D6 B0 A0 bcs ?04 ; seek error3848 F896D8 A9 66 lda #CMDREAD ; fake read whole track in current side3849 F896DA 20 6F 97 jsr fdcmd3850 F896DD 90 06 bcc ?183851 F896DF C6 BB dec retries3852 F896E1 D0 C6 bne ?123853 F896E3 80 1F bra ?203854 F896E5 A9 01 ?18: lda #$013855 F896E7 04 B6 tsb fmtfg ; bit 0 = 1 -> for callback3856 F896E9 A6 AD ldx head ; next side3857 F896EB E8 inx3858 F896EC E0 02 cpx #23859 F896EE 90 B3 bcc ?11 ; same track, side=13860 F896F0 A2 00 ldx #0 ; clear head3861 F896F2 A4 AC ldy track ; next track3862 F896F4 C8 iny3863 F896F5 C0 50 cpy #803864 F896F7 90 A8 bcc ?10 ; next track, side=03865 F896F9 A5 44 lda fdcdrv ; set valid format3866 F896FB 29 7C and #01111100B3867 F896FD 05 B7 ora dskfmt ; update format (but not trut bit)3868 F896FF 09 80 ora #$80 ; current valid format3869 F89701 85 44 sta fdcdrv3870 F89703 18 clc3871 F89704 4C 6F 95 ?20: jmp done38723873 ;---------------------------------------------------------------------------3874 ; fdc basic read/write/format command's3875 ;---------------------------------------------------------------------------38763877 ; fd format track command3878 ; out: CF=1 if error, A=error code3879 ; A,X,Y destroyed3880 F89707 fdftcmd:3881 F89707 64 96 stz ntrsf ; clear numbers of transferred bytes3882 F89709 64 97 stz ntrsf+13883 F8970B A5 B7 lda dskfmt3884 F8970D 29 03 and #$03 ; disk format [0..2]3885 F8970F AA tax ; X=format3886 F89710 BF A9 A0 F8 lda >FGPLTBL,x ; GAP 3 length3887 F89714 85 B2 sta gap33888 F89716 BF AD A0 F8 lda >HEADTBL,x ; head inversion for CBM format3889 F8971A 45 AD eor head3890 F8971C 0A asl a ; head -> bit 23891 F8971D 0A asl a3892 F8971E 85 9A sta drvhead ; head + drive (=0)3893 F89720 A9 4D lda #CMDFMT ; format track commandTue Jul 17 11:00:16 2018 Page 243894 F89722 20 9A 9B jsr sendto3895 F89725 A5 9A lda drvhead ; head + drive3896 F89727 20 9A 9B jsr sendto3897 F8972A A9 02 lda #2 ; sector size = 512 bytes3898 F8972C 20 9A 9B jsr sendto3899 F8972F A5 B1 lda eot ; SC = sector/track3900 F89731 20 9A 9B jsr sendto3901 F89734 A5 B2 lda gap3 ; GPL 3 length3902 F89736 20 9A 9B jsr sendto3903 F89739 A5 B8 lda fmtfill ; D = fill byte3904 F8973B 20 9A 9B jsr sendto3905 F8973E 2C 00 FD bit VIA0+VIAPRB ; clear CB1 flag3906 F89741 A9 02 lda #$02 ; enable DMA bus3907 F89743 1C 0F FD trb VIA0+VIAPRANH ; PA1 -> /DME = 03908 F89746 20 5F 99 jsr chkres ; wait result3909 F89749 20 BC 97 jsr chkdma3910 F8974C B0 20 bcs ?10 ; error in phase result3911 F8974E 24 B6 bit fmtfg ; verf track ?3912 F89750 50 1C bvc ?10 ; no3913 F89752 A5 B1 lda eot3914 F89754 0A asl a ; number of bytes3915 F89755 85 95 sta ncnt+13916 F89757 64 94 stz ncnt3917 F89759 64 96 stz ntrsf ; clear numbers of transferred bytes3918 F8975B 64 97 stz ntrsf+13919 F8975D A9 42 lda #VERFTRASF ; fake transfer, just check track3920 F8975F EB xba ; B=dma mode3921 F89760 A6 9E ldx bufp ; buffer pointer3922 F89762 A4 9F ldy bufp+13923 F89764 A5 A0 lda bufp+23924 F89766 20 7C 9A jsr dmaset3925 F89769 A9 66 lda #CMDREAD ; fake read whole track in current side3926 F8976B 20 6F 97 jsr fdcmd3927 F8976E 60 ?10: rts39283929 ; fd read/write/verf command3930 ; in: A=command3931 ; out: CF=1 if error, A=error code3932 ; A,X,Y destroyed3933 F8976F fdcmd:3934 ;stz ntrsf ; clear numbers of transferred bytes3935 ;stz ntrsf+13936 F8976F A8 tay ; Y=command3937 F89770 A5 B7 lda dskfmt3938 F89772 29 03 and #$03 ; disk format [0..2]3939 F89774 AA tax ; X=format3940 F89775 BF A5 A0 F8 lda >RWGPLTBL,x ; GAP 3 length for required format3941 F89779 85 B2 sta gap33942 F8977B BF AD A0 F8 lda >HEADTBL,x ; head inversion for CBM format3943 F8977F 45 AD eor head3944 F89781 0A asl a ; head -> bit 23945 F89782 0A asl a3946 F89783 85 9A sta drvhead ; head + drive (=0)3947 F89785 98 tya ; A=command3948 F89786 20 9A 9B jsr sendto3949 F89789 A5 9A lda drvhead ; head + drive3950 F8978B 20 9A 9B jsr sendtoTue Jul 17 11:00:16 2018 Page 253951 F8978E A5 AC lda track ; track3952 F89790 20 9A 9B jsr sendto3953 F89793 A5 AD lda head ; head3954 F89795 20 9A 9B jsr sendto3955 F89798 A5 AE lda sector ; sector3956 F8979A 20 9A 9B jsr sendto3957 F8979D A9 02 lda #2 ; sector size = 512 bytes3958 F8979F 20 9A 9B jsr sendto3959 F897A2 A5 B1 lda eot ; EOT (last sector)3960 F897A4 20 9A 9B jsr sendto3961 F897A7 A5 B2 lda gap3 ; GPL 3 length3962 F897A9 20 9A 9B jsr sendto3963 F897AC A5 9B lda dtlstp ; DTL/STP3964 F897AE 20 9A 9B jsr sendto3965 F897B1 2C 00 FD bit VIA0+VIAPRB ; clear CB1 flag (FDC interrupt)3966 F897B4 A9 02 lda #$02 ; enable DMA bus control3967 F897B6 1C 0F FD trb VIA0+VIAPRANH ; PA1 -> /DME = 03968 ;jsr chkres3 ; wait for transfer ending and CPU bus enable3969 F897B93970 F897B9 20 5F 99 jsr chkres ; wait for transfer ending and CPU bus enable39713972 ; read from dma count the effective transferred bytes count3973 F897BC chkdma:3974 F897BC 48 pha ; save error code if any3975 F897BD 08 php ; save carry for pending error3976 F897BE AF 98 FD 00 lda >DMASR ; save DMA status & clear status reg3977 F897C2 85 B3 sta dmast3978 F897C4 85 EE sta <$ee39793980 F897C6 8E 9C FD stx .ABS.DMAWCLRFF3981 F897C9 AE 95 FD ldx .ABS.DMAC+DMACNT23982 F897CC 86 E8 stx <$e83983 F897CE AE 95 FD ldx .ABS.DMAC+DMACNT23984 F897D1 86 E9 stx <$e93985 F897D3 8E 9C FD stx .ABS.DMAWCLRFF3986 F897D6 AE 94 FD ldx .ABS.DMAC+DMAADDR23987 F897D9 86 EA stx <$ea3988 F897DB EA nop3989 F897DC EA nop3990 F897DD EA nop3991 F897DE EA nop3992 F897DF AE 94 FD ldx .ABS.DMAC+DMAADDR23993 F897E2 86 EB stx <$eb3994 F897E4 64 EF stz <$ef3995 F897E6 90 04 bcc ?103996 F897E8 C6 EF dec <$ef3997 F897EA B0 43 bcs ?30 ; error pending3998 F897EC 8D 9C FD ?10: sta !DMAWCLRFF ; loop for read dma reg.3999 F897EF EA nop4000 F897F0 EA nop4001 F897F1 AD 95 FD lda !DMAC+DMACNT2 ; low count DMA residue4002 F897F4 EB xba4003 F897F5 EA nop4004 F897F6 AD 95 FD lda !DMAC+DMACNT2 ; high count DMA residue4005 F897F9 EB xba4006 F897FA EA nop4007 F897FB 8D 9C FD sta !DMAWCLRFFTue Jul 17 11:00:16 2018 Page 264008 F897FE CD 95 FD cmp !DMAC+DMACNT24009 F89801 EA nop4010 F89802 D0 E8 bne ?104011 F89804 EB xba4012 F89805 EA nop4013 F89806 CD 95 FD cmp !DMAC+DMACNT24014 F89809 EA nop4015 F8980A D0 E0 bne ?104016 F8980C EB xba ; C = residual bytes #4017 F8980D ACC164018 F8980D C2 20 rep #PMFLAG4019 .LONGA on4020 .MNLIST4021 F8980F 1A inc a ; DMA count residue4022 F89810 85 96 sta ntrsf4023 F89812 38 sec4024 F89813 A5 94 lda ncnt ; # transferred bytes4025 F89815 E5 96 sbc ntrsf4026 ;sta ntrsf4027 F89817 C5 94 cmp ncnt4028 F89819 ACC084029 F89819 E2 20 sep #PMFLAG4030 .LONGA off4031 .MNLIST4032 F8981B D0 06 bne ?20 ; error: no match4033 F8981D A5 B3 lda dmast ; check dma status4034 F8981F 89 04 bit #$04 ; premature cycle ending?4035 F89821 D0 0C bne ?30 ; no4036 F89823 A3 01 ?20: lda $01,s ; set CF in saved status4037 F89825 09 01 ora #PCFLAG ; set error flag4038 F89827 83 01 sta $01,s4039 F89829 A9 08 lda #FDC_DLOSS ; data loss error4040 F8982B4041 F8982B 09 80 ora #$8040424043 F8982D 83 02 sta $02,s ; report error4044 F8982F 28 ?30: plp ; return CF4045 F89830 68 pla ; return error code4046 F89831 60 rts40474048 ;---------------------------------------------------------------------------4049 ; disk check routines4050 ;---------------------------------------------------------------------------40514052 ; test if disk ready while motor is spinning4053 ; out: CF=0 if disk ready4054 ; CF=1 if disk not ready or changed, A=FDC_NOTREADY4055 ; A destroyed, X&Y preserved4056 F89832 tstrdy:4057 F89832 18 clc4058 F89833 AF DF FD 00 lda >FDCDIR ; read disk change line4059 F89837 29 80 and #$80 ; bit 7 will be 04060 F89839 F0 03 beq ?10 ; ready - exit with CF = 04061 F8983B A9 10 lda #FDC_NOTREADY ; not ready4062 F8983D 38 sec ; error4063 F8983E 60 ?10: rts4064Tue Jul 17 11:00:16 2018 Page 274065 ; check disk format - if the actual disk was not never checked it will be4066 ; tested for the format4067 ; out: CF=1 if error, A=error code4068 ; A&Y destroyed, X preserved4069 F8983F chkfmt:4070 F8983F 20 D7 98 jsr chkdsk ; start motor and check if disk ready4071 F89842 90 04 bcc ?06 ; disk ready and not changed4072 F89844 50 3F bvc ?20 ; not ready - exit with CF = 14073 F89846 64 48 stz fdcerr ; disk changed4074 F89848 24 44 ?06: bit fdcdrv ; need to call seek0 double step?4075 F8984A 70 05 bvs ?08 ; no4076 F8984C 20 95 99 jsr seek0 ; double step seek track 04077 F8984F B0 34 bcs ?20 ; error4078 F89851 A5 44 ?08: lda fdcdrv ; bit 7 -> know format ?4079 F89853 30 31 bmi ?30 ; yes, so check and compare4080 F89855 A9 02 lda #$02 ; start with H.D.4081 F89857 85 B7 ?10: sta dskfmt4082 F89859 20 BB 9C jsr setrate ; setup rate4083 F8985C 20 C2 98 jsr ?50 ; little delay4084 F8985F 20 48 99 jsr readid ; read ID track=0 head=04085 F89862 90 08 bcc ?12 ; ok4086 F89864 A5 B7 lda dskfmt4087 F89866 F0 14 beq ?16 ; error - unrecognized format4088 F89868 A9 00 lda #0 ; try D.D. rate4089 F8986A 80 EB bra ?104090 F8986C 20 76 98 ?12: jsr ?14 ; check track & head4091 F8986F B0 14 bcs ?204092 F89871 A9 80 lda #$804093 F89873 04 44 tsb fdcdrv ; set know format bit4094 F89875 60 rts4095 F89876 A5 A7 ?14: lda fdcres+3 ; check track4096 F89878 C5 47 cmp fdctrk4097 F8987A F0 04 beq ?18 ; will be the same4098 F8987C A9 0D ?16: lda #FDC_BADFMT ; unknow format4099 F8987E 38 ?17: sec4100 F8987F 60 rts4101 F89880 A5 A8 ?18: lda fdcres+4 ; head is inverted if CBM format4102 F89882 04 B7 tsb dskfmt ; this set eventually bit 0 for CBM format4103 F89884 18 clc4104 F89885 60 ?20: rts4105 F89886 89 20 ?30: bit #$20 ; trust format?4106 F89888 D0 32 bne ?34 ; yes4107 F8988A 29 02 and #$02 ; mask rate4108 F8988C 85 B7 sta dskfmt ; here bit 0 = 04109 F8988E A8 tay4110 F8988F 45 46 eor fdcctl ; compare with current rate4111 F89891 29 02 and #$024112 F89893 F0 07 beq ?31 ; same rate4113 F89895 98 tya4114 F89896 20 BB 9C jsr setrate4115 F89899 20 C2 98 jsr ?50 ; little delay4116 F8989C A9 80 ?31: lda #$804117 F8989E 14 44 trb fdcdrv ; clear know format bit4118 F898A0 20 48 99 jsr readid ; read first ID in current track4119 F898A3 B0 E0 bcs ?20 ; error4120 F898A5 20 76 98 jsr ?14 ; check track & head4121 F898A8 B0 DB bcs ?20 ; errorTue Jul 17 11:00:16 2018 Page 284122 F898AA A5 44 lda fdcdrv4123 F898AC 45 B7 eor dskfmt ; compare computed format with the stored one4124 F898AE 29 03 and #$03 ; will be 04125 F898B0 F0 04 beq ?324126 F898B2 A9 0F lda #FDC_FMT ; mismatch format4127 F898B4 80 C8 bra ?174128 F898B6 A9 80 ?32: lda #$804129 F898B8 04 44 tsb fdcdrv ; set know format bit4130 F898BA 18 clc4131 F898BB 60 rts4132 F898BC 29 03 ?34: and #$03 ; trust format4133 F898BE 85 B7 sta dskfmt4134 F898C0 18 clc4135 F898C1 60 rts41364137 ; 1ms delay4138 F898C2 A9 20 ?50: lda #$20 ; T2 count PHI2 pulses4139 F898C4 1C 0B FD trb VIA0+VIAACR4140 F898C7 A9 10 lda #T1MS4141 F898C9 9C 08 FD stz VIA0+VIAT2CL4142 F898CC 8D 09 FD sta VIA0+VIAT2CH4143 F898CF AD 0D FD ?55: lda VIA0+VIAIFR4144 F898D2 89 20 bit #T2IFRB4145 F898D4 F0 F9 beq ?554146 F898D6 60 rts41474148 ; check disk in drive - if disk is changed reset controller and recalibrate4149 ; drive & move head in track 0 & aquire wp status on disk4150 ; out: CF=0 if disk ready4151 ; CF=1 if disk not ready or changed4152 ; VF=1 if disk changed else VF=0 if not ready4153 ; A=error code FDC_NOTREADY or FDC_CHANGE or others4154 ; A destroyed, X&Y preserved4155 F898D7 chkdsk:4156 F898D7 5A phy4157 F898D8 64 48 stz fdcerr4158 F898DA 20 CE 9C jsr startmtr ; start motor4159 F898DD 18 clc4160 F898DE AF DF FD 00 lda >FDCDIR ; read disk change line4161 F898E2 29 80 and #$80 ; bit 7 will be 04162 F898E4 F0 21 beq ?20 ; ready so aquire wp status4163 F898E6 A9 01 lda #$01 ; clear ready bit4164 F898E8 14 46 trb fdcctl4165 F898EA 20 3A 9B jsr fdcrst ; aquire new disk change line status4166 F898ED B0 1F bcs ?30 ; error4167 F898EF 20 95 99 jsr seek0 ; recalibrate after reset and seek track 04168 F898F2 B0 1A bcs ?30 ; error4169 F898F4 A0 11 ldy #FDC_CHANGE ; disk change?4170 F898F6 E2 40 sep #PVFLAG ; VF = 1 if disk change4171 F898F8 AF DF FD 00 lda >FDCDIR ; read line4172 F898FC 29 80 and #$80 ; bit 7 = 0 if disk inserted into drive4173 F898FE F0 03 beq ?10 ; so disk changed4174 F89900 A0 10 ldy #FDC_NOTREADY ; not ready4175 F89902 B8 clv ; VF flag = 0 if not ready4176 F89903 38 ?10: sec ; error4177 F89904 98 tya ; A=error code4178 F89905 50 07 bvc ?30 ; not readyTue Jul 17 11:00:16 2018 Page 294179 F89907 08 ?20: php ; save CF&VF4180 F89908 48 pha ; save error code if any4181 F89909 20 10 99 jsr chkwp ; aquire wp disk status4182 F8990C 68 pla4183 F8990D 28 plp4184 F8990E 7A ?30: ply4185 F8990F 60 rts41864187 ; set write protect on bit and disk ready bit4188 F89910 chkwp:4189 F89910 A9 10 lda #$104190 F89912 14 44 trb fdcdrv ; clear wp on bit4191 F89914 A9 01 lda #$01 ; set ready bit4192 F89916 04 46 tsb fdcctl4193 F89918 A9 04 lda #CMDSENSEST ; sense status4194 F8991A 20 9A 9B jsr sendto4195 F8991D A9 00 lda #0 ; drive4196 F8991F 20 9A 9B jsr sendto4197 F89922 20 D0 9B jsr waitres ; get result4198 F89925 24 A4 bit fdcres ; ST3 bit 6 is wp on bit4199 F89927 50 04 bvc ?10 ; no wp4200 F89929 A9 10 lda #$104201 F8992B 04 44 tsb fdcdrv ; set bit 4: wp on4202 F8992D 60 ?10: rts42034204 ; sense phisycal drive #0 status4205 ; out: A=ST3 status if no error4206 ; CF=1 if error, fdcerr=error code4207 F8992E drvst:4208 F8992E 20 CE 9C jsr startmtr4209 F89931 20 37 99 jsr ?204210 F89934 4C 77 95 jmp stop42114212 F89937 A9 04 ?20: lda #CMDSENSEST ; sense status4213 F89939 20 9A 9B jsr sendto4214 F8993C A9 00 lda #0 ; drive4215 F8993E 20 9A 9B jsr sendto4216 F89941 20 D0 9B jsr waitres ; get result4217 F89944 A5 A4 lda fdcres ; get ST34218 F89946 18 clc4219 F89947 60 rts42204221 ; read first valid ID in current track, head = 04222 ; if current track is not valid ($FF) seek to track 04223 ; out: CF=1 if error, A=error code4224 ; A&Y destroyed, X preserved4225 F89948 readid:4226 F89948 A5 47 lda fdctrk4227 F8994A C9 FF cmp #$FF4228 F8994C D0 07 bne ?024229 F8994E A0 00 ldy #04230 F89950 20 C6 99 jsr seek4231 F89953 B0 3F bcs chk4232 F89955 A9 4A ?02: lda #CMDREADID4233 F89957 20 9A 9B jsr sendto4234 F8995A A9 00 lda #0 ; head + drive (head = 0)4235 F8995C 20 9A 9B jsr sendtoTue Jul 17 11:00:16 2018 Page 304236 F8995F4237 ; wait phase result after read/write/format/read ID and check result4238 ; out: CF=1 if error, A=error code4239 ; A&Y destroyed, X preserved4240 F8995F chkres:4241 F8995F 20 20 9C jsr waitint ; wait interrupt4242 F89962 chkres2:4243 F89962 20 D0 9B jsr waitres ; get result4244 F89965 A5 A4 lda fdcres ; test ST04245 F89967 29 C0 and #11000000B4246 F89969 F0 29 beq chk ; here CF = 0 - result ok4247 F8996B C9 40 cmp #01000000B4248 F8996D D0 21 bne ?10 ; bad controller4249 F8996F 18 clc ; no error4250 F89970 A5 A5 lda fdcres+1 ; test ST14251 F89972 30 20 bmi chk ; 7 -> end of track, no error4252 F89974 0A asl a ; skip bit 74253 F89975 0A asl a ; 6 -> skip4254 F89976 0A asl a4255 F89977 A0 09 ldy #FDC_DATACRC4256 F89979 B0 18 bcs ?20 ; 5 -> CRC error4257 F8997B 0A asl a4258 F8997C A0 08 ldy #FDC_DLOSS4259 F8997E B0 13 bcs ?20 ; 4 -> data loss4260 F89980 0A asl a4261 F89981 0A asl a4262 F89982 A0 0A ldy #FDC_NOID4263 F89984 B0 0D bcs ?20 ; 2 -> ID not found4264 F89986 0A asl a4265 F89987 A0 0B ldy #FDC_WP4266 F89989 B0 08 bcs ?20 ; 1 -> write protect4267 F8998B 0A asl a4268 F8998C A0 0C ldy #FDC_MARK4269 F8998E B0 03 bcs ?20 ; 0 -> mark address4270 F89990 A0 01 ?10: ldy #FDC_BAD ; bad controller4271 F89992 38 sec4272 F89993 98 ?20: tya ; A=error code4273 F89994 60 chk: rts42744275 ;---------------------------------------------------------------------------4276 ; drive seek routines4277 ;---------------------------------------------------------------------------42784279 ; recalibrate drive if need and move head in track 0 with a double step seek4280 ; this routine should be called if bit 6 of fdcdrv is 0 as after a reset4281 ; out: CF=1 if error, A=error code4282 ; A&Y destroyed, X preserved4283 F89995 seek0:4284 ;jsr restore4285 ;bcs ?204286 ;stz fdctrk ; store current track (=0)4287 ;lda #$404288 ;trb fdcctl ; reset flag restore: done4289 F89995 A0 01 ldy #1 ; seek track 14290 F89997 20 C6 99 jsr seek ; and recalibrate if need4291 F8999A B0 0B bcs ?10 ; error4292 F8999C A0 00 ldy #0 ; seek track 0Tue Jul 17 11:00:16 2018 Page 314293 F8999E 20 C6 99 jsr seek4294 F899A1 B0 04 bcs ?104295 F899A3 A9 40 lda #$40 ; set bit 6 of fdcdrv4296 F899A5 04 44 tsb fdcdrv4297 F899A7 60 ?10: rts4298 F899A8 A2 00 ?20: ldx #04299 F899AA A4 47 ldy fdctrk4300 F899AC A5 FF lda $ff4301 F899AE 00 00 brk4302 F899B0 EA nop4303 F899B1 EA nop4304 F899B2 A2 01 ?30: ldx #14305 F899B4 A4 47 ldy fdctrk4306 F899B6 A5 FF lda $ff4307 F899B8 00 00 brk4308 F899BA EA nop4309 F899BB EA nop4310 F899BC A2 02 ?40: ldx #24311 F899BE A4 47 ldy fdctrk4312 F899C0 A5 FF lda $ff4313 F899C2 00 00 brk4314 F899C4 EA nop4315 F899C5 EA nop4316 F899C64317 ; move head in track Y & recalibrate drive if need4318 ; in: Y=track4319 ; A destroyed, X&Y preserved4320 F899C6 seek:4321 ;bit $FD2a4322 ;bpl ?004323 ;lda !FDCDATA43244325 F899C6 ?00:43264327 F899C6 24 46 bit fdcctl ; test bit 6: need restore?4328 F899C8 50 0F bvc ?04 ; no4329 F899CA 20 31 9A jsr restore ; recalibrate drive4330 F899CD B0 31 bcs ?10 ; error - exit4331 F899CF 64 47 stz fdctrk ; store current track (=0)4332 F899D1 A9 40 lda #$404333 F899D3 14 46 trb fdcctl ; reset flag restore: done4334 F899D5 C0 00 cpy #0 ; requested track=0 ?4335 F899D7 F0 21 beq ?06 ; yes, exit after a while4336 F899D9 C4 47 ?04: cpy fdctrk ; already in the desidered track ?4337 F899DB F0 1D beq ?06 ; yes, exit4338 F899DD A9 0F lda #CMDSEEK ; send seek command4339 F899DF 20 96 9B jsr sndto24340 F899E2 B0 17 bcs ?084341 F899E4 A9 00 lda #0 ; drive4342 F899E6 20 96 9B jsr sndto24343 F899E9 B0 10 bcs ?084344 F899EB 98 tya ; track4345 F899EC 85 47 sta fdctrk4346 F899EE 20 96 9B jsr sndto24347 F899F1 B0 08 bcs ?084348 F899F3 A9 07 lda #FDC_SEEK ; error seek ?4349 F899F5 20 46 9A jsr wseek ; wait resultTue Jul 17 11:00:16 2018 Page 324350 F899F8 B0 01 bcs ?084351 F899FA 18 ?06: clc4352 F899FB 20 09 9A ?08: jsr ?204353 F899FE 90 08 bcc ?124354 F89A00 85 B9 ?10: sta tmpa4355 F89A02 A9 FF lda #$FF ; invalidate current track4356 F89A04 85 47 sta fdctrk4357 F89A06 A5 B9 lda tmpa4358 F89A08 60 ?12: rts43594360 ; 10ms delay4361 F89A09 08 ?20: php4362 F89A0A 48 pha4363 F89A0B A9 20 lda #$20 ; T2 count PHI2 pulses4364 F89A0D 1C 0B FD trb VIA0+VIAACR4365 F89A10 A9 40 lda #<T10MS4366 F89A12 8D 08 FD sta VIA0+VIAT2CL4367 F89A15 A9 9C lda #>T10MS4368 F89A17 8D 09 FD sta VIA0+VIAT2CH4369 F89A1A ?22: TASKSW4370 F89A1A 02 00 cop FN_TASKSW4371 F89A1C 00 .DB $004372 .MNLIST4373 F89A1D AD 0D FD lda VIA0+VIAIFR4374 F89A20 89 20 bit #T2IFRB4375 F89A22 F0 F6 beq ?224376 F89A24 68 pla4377 F89A25 28 plp4378 F89A26 60 rts43794380 F89A27 A2 FF ?40: ldx #$FF4381 F89A29 A5 FF lda $ff4382 F89A2B A4 47 ldy fdctrk4383 F89A2D 00 00 brk4384 F89A2F EA nop4385 F89A30 EA nop4386 F89A314387 ; causes the read/write head within the FDD to retract in the track 0 position4388 ; out: CF=1 if error, A=error code4389 ; A destroyed, X&Y preserved4390 F89A31 restore:4391 F89A31 20 36 9A jsr ?10 ; ricalibrate: first step4392 F89A34 90 45 bcc wsk ; no double step need4393 ; if error, need one step more4394 F89A36 A9 07 ?10: lda #CMDRECAL ; ricalibrate command4395 F89A38 20 96 9B jsr sndto24396 F89A3B B0 3E bcs wsk ; error4397 F89A3D A9 00 lda #0 ; drive4398 F89A3F 20 96 9B jsr sndto24399 F89A42 B0 37 bcs wsk ; error4400 F89A44 A9 06 lda #FDC_FAULT ; restore error ?44014402 ; wait result phase after seek/recalibrate command4403 ; in: A=error code FDC_FAULT or FDC_SEEK4404 ; out: CF=1 if error, A=error code4405 ; A,X,Y preserved4406 F89A46 wseek:Tue Jul 17 11:00:16 2018 Page 334407 F89A46 85 B9 sta tmpa ; save error code4408 F89A48 20 6E 9A jsr ?20 ; sense interrupt4409 F89A4B B0 2E bcs wsk ; return pending error4410 F89A4D A5 A4 ?01: lda fdcres ; test result status4411 F89A4F 85 FF sta $FF4412 F89A51 C9 80 cmp #$804413 F89A53 F0 0B beq ?304414 F89A55 29 60 and #01100000B4415 F89A57 C9 60 cmp #01100000B4416 F89A59 38 sec4417 F89A5A F0 01 beq ?10 ; restore/seek error4418 F89A5C 18 clc ; no error4419 F89A5D A5 B9 ?10: lda tmpa4420 F89A5F 60 rts44214422 F89A60 AD 2A FD ?30: lda !$FD2A4423 F89A63 85 FD sta $fd4424 F89A65 10 F9 bpl ?304425 F89A67 20 71 9A jsr ?214426 F89A6A B0 0F bcs wsk4427 ;lda !VIA0+VIAPRB4428 F89A6C 80 DF bra ?014429 F89A6E4430 ; wait result phase after sensing interrupt4431 F89A6E 20 20 9C ?20: jsr waitint ; wait interrupt within timeout4432 F89A71 A9 08 ?21: lda #CMDSENSEINT ; sense interrupt4433 F89A73 20 9A 9B jsr sendto4434 F89A76 64 A4 stz fdcres4435 F89A78 20 D0 9B jsr waitres ; wait result phase4436 F89A7B 60 wsk: rts44374438 ;---------------------------------------------------------------------------4439 ; low level controller routines4440 ;---------------------------------------------------------------------------44414442 ; dma setup on channel 2 for a transfer cycle4443 ; in: X=transfer buffer low pointer4444 ; Y=transfer buffer high pointer4445 ; A=transfer buffer bank4446 ; B=dma mode transfer4447 ; ncnt=bytes to transfer count #4448 F89A7C dmaset:4449 F89A7C 48 pha4450 F89A7D 64 F0 stz <$f04451 F89A7F 64 F1 stz <$f14452 F89A81 A9 01 lda #$014453 F89A83 1C 0F FD trb VIA0+VIAPRANH ; DMA X16=0 (bank 2)4454 F89A86 A9 02 lda #24455 F89A88 0C 00 FD tsb VIA0+VIAPRB4456 F89A8B 68 pla4457 F89A8C 29 01 and #$01 ; mask bit 04458 F89A8E F0 05 beq ?02 ; transfer buffer is in bank 24459 F89A90 A9 01 lda #$014460 F89A92 0C 0F FD tsb VIA0+VIAPRANH ; DMA X16=1 (bank 3)4461 F89A95 ?02:4462 F89A95 A9 07 lda #$074463 F89A97 1C CF FD trb VIA3+VIAPRANHTue Jul 17 11:00:16 2018 Page 344464 F89A9A4465 ;lda #01011000B4466 F89A9A A9 00 lda #04467 F89A9C 8D C0 FD sta !VIA3+VIAPRB44684469 F89A9F 78 sei4470 F89AA0 8F 9D FD 00 sta >DMAWMCLR4471 F89AA4 EA nop4472 F89AA5 EA nop4473 F89AA6 EA nop4474 F89AA7 EA nop4475 F89AA8 AF 98 FD 00 lda >DMASR ; clear status flag4476 F89AAC EA nop4477 F89AAD EA nop4478 F89AAE A9 00 lda #$004479 F89AB0 8F 98 FD 00 sta >DMAWCMD4480 F89AB4 EA nop4481 F89AB5 EA nop4482 F89AB6 8F 9D FD 00 sta >DMAWMCLR4483 F89ABA EA nop4484 F89ABB EA nop4485 F89ABC A9 06 lda #$064486 F89ABE EA nop4487 F89ABF 8F 9A FD 00 sta >DMAWMSKB ; mask off bit channel 24488 F89AC3 EA nop4489 F89AC4 EB xba ; A=transfer mode4490 F89AC5 8F 9B FD 00 sta >DMAMODE ; set DMA transfer mode4491 F89AC9 85 F2 sta <$f24492 F89ACB4493 F89ACB EA nop4494 F89ACC 8F 9C FD 00 ?06: sta >DMAWCLRFF ; clear F/F4495 F89AD0 E6 F0 inc <$f04496 F89AD2 EA nop4497 F89AD3 EA nop4498 F89AD4 8A txa4499 F89AD5 8F 94 FD 00 sta >DMAC+DMAADDR2 ; store low buffer address4500 F89AD9 EA nop4501 F89ADA EA nop4502 F89ADB 98 tya4503 F89ADC 8F 94 FD 00 sta >DMAC+DMAADDR2 ; store high buffer address4504 F89AE0 EA nop4505 F89AE1 8F 9C FD 00 sta >DMAWCLRFF ; clear F/F4506 F89AE5 EA nop4507 F89AE6 EA nop4508 F89AE7 8A txa4509 F89AE8 CF 94 FD 00 cmp >DMAC+DMAADDR2 ; cmp low buffer address4510 F89AEC D0 DE bne ?064511 F89AEE 98 tya4512 F89AEF CF 94 FD 00 cmp >DMAC+DMAADDR2 ; cmp high buffer address4513 F89AF3 D0 D7 bne ?064514 F89AF5 ACC164515 F89AF5 C2 20 rep #PMFLAG4516 .LONGA on4517 .MNLIST4518 F89AF7 A5 94 lda ncnt4519 F89AF9 3A dec a ; DMA count=ncnt-14520 F89AFA 48 phaTue Jul 17 11:00:16 2018 Page 354521 F89AFB ACC084522 F89AFB E2 20 sep #PMFLAG4523 .LONGA off4524 .MNLIST4525 F89AFD FA plx ; X=low count4526 F89AFE 7A ply ; Y=high count4527 F89AFF 8F 9C FD 00 ?08: sta >DMAWCLRFF ; clear F/F4528 F89B03 E6 F1 inc <$f14529 F89B05 EA nop4530 F89B06 EA nop4531 F89B07 8A txa4532 F89B08 8F 95 FD 00 sta >DMAC+DMACNT2 ; store low count4533 F89B0C EA nop4534 F89B0D EA nop4535 F89B0E 98 tya4536 F89B0F 8F 95 FD 00 sta >DMAC+DMACNT2 ; store high count4537 F89B13 EA nop4538 F89B14 8F 9C FD 00 sta >DMAWCLRFF ; clear F/F4539 F89B18 EA nop4540 F89B19 EA nop4541 F89B1A 8A txa4542 F89B1B CF 95 FD 00 cmp >DMAC+DMACNT2 ; cmp low count4543 F89B1F D0 DE bne ?084544 F89B21 98 tya4545 F89B22 CF 95 FD 00 cmp >DMAC+DMACNT2 ; cmp high count4546 F89B26 D0 D7 bne ?084547 F89B28 8F 9C FD 00 sta >DMAWCLRFF ; clear F/F4548 F89B2C A9 02 lda #$024549 F89B2E EA nop4550 F89B2F EA nop4551 F89B30 8F 9A FD 00 sta >DMAWMSKB ; un-mask bit channel 24552 F89B34 A9 08 lda #$084553 F89B36 04 46 tsb fdcctl ; set bit 34554 F89B38 58 cli4555 F89B39 60 rts45564557 ; reset controller FDC after boot or for recovering after error4558 ; motor status as in current fdcctl bit 44559 ; after reset restore flag (bit 6) in fdcctl are set4560 ; and drive status will be cleared4561 ; out: CF=1 if error, A=error code4562 ; fdcctl<6:5> set/reset4563 ; registers: A&Y destroyed, X preserved4564 F89B3A fdcrst:4565 F89B3A 08 php ; save I status4566 F89B3B 78 sei ; disable interrupt4567 F89B3C 2C 00 FD bit VIA0+VIAPRB ; reset flag CB14568 F89B3F 64 48 stz fdcerr4569 F89B41 A9 20 lda #$204570 F89B43 14 46 trb fdcctl ; reset flag FDC4571 F89B45 A9 40 lda #$404572 F89B47 04 46 tsb fdcctl ; force restore4573 F89B49 64 44 stz fdcdrv ; invalidate drive4574 F89B4B A5 46 lda fdcctl4575 F89B4D 29 10 and #00010000B ; mask on motor bit4576 F89B4F 09 08 ora #00001000B ; enable FDC interrupt&dma, reset FDC4577 F89B51 8F DA FD 00 sta >FDCDOR ; reset controllerTue Jul 17 11:00:16 2018 Page 364578 F89B55 EA nop4579 F89B56 EA nop4580 F89B57 EA nop4581 F89B58 EA nop4582 F89B59 2C 00 FD bit VIA0+VIAPRB ; reset flag CB14583 F89B5C EA nop4584 F89B5D EA nop4585 F89B5E EA nop4586 F89B5F EA nop4587 F89B60 09 0C ora #00001100B ; enable controller4588 F89B62 8F DA FD 00 sta >FDCDOR ; this write cause interrupt from FDC4589 F89B66 28 plp ; restore I flag4590 F89B67 20 20 9C jsr waitint ; wait interrupt within timeout4591 F89B6A4592 ; controller reply to sense interrupt command4593 ; with 4 status bytes: $C0, $C1, $C2, $C34594 F89B6A4595 F89B6A A0 C0 ldy #$C0 ; first expected status4596 F89B6C A9 08 ?01: lda #CMDSENSEINT4597 F89B6E 20 9A 9B jsr sendto ; sense interrupt4598 F89B71 20 D0 9B jsr waitres ; result phase (normally 2 bytes)4599 F89B74 C4 A4 cpy fdcres ; check first byte result4600 F89B76 F0 04 beq ?03 ; ok, as expected4601 F89B78 38 sec ; controller error4602 F89B79 A9 01 lda #FDC_BAD ; bad controller error4603 F89B7B 60 rts4604 F89B7C C8 ?03: iny4605 F89B7D C0 C4 cpy #$C4 ; last expected result is $C34606 F89B7F 90 EB bcc ?01 ; loop4607 F89B81 A9 20 lda #$204608 F89B83 04 46 tsb fdcctl ; flag controller FDC OK4609 F89B85 A5 46 lda fdcctl4610 F89B87 20 BB 9C jsr setrate ; select current rate4611 F89B8A A9 03 lda #CMDSPECIFY4612 F89B8C 20 9A 9B jsr sendto ; setup standard controller4613 F89B8F A9 DF lda #UM_SRTHUT4614 F89B91 20 9A 9B jsr sendto4615 F89B94 A9 02 lda #UM_HLTND ; send command to FDC46164617 ; like sendto but always return to the caller, even if error4618 F89B96 sndto2:4619 F89B96 20 9A 9B jsr sendto4620 F89B99 60 rts46214622 ; send command to controller within SNDTMO timeout4623 ; in: A=command4624 ; out: CF=1 if error, A=error code4625 ; A,X,Y preserved (if error A will be destroyed)4626 ; if error, return address from stack will be pulled out and discarded4627 F89B9A sendto:4628 F89B9A 85 B9 sta tmpa4629 F89B9C 20 E8 9D jsr wait16us ; 16uS delay safety4630 F89B9F A9 20 lda #$20 ; T2 count PB6 pulses (1ms)4631 F89BA1 0C 0B FD tsb VIA0+VIAACR4632 F89BA4 A9 D0 lda #<SNDTMO ; timeout send byte4633 F89BA6 8D 08 FD sta !VIA0+VIAT2CL4634 F89BA9 A9 07 lda #>SNDTMOTue Jul 17 11:00:16 2018 Page 374635 F89BAB 8D 09 FD sta !VIA0+VIAT2CH4636 F89BAE AF DC FD 00 ?02: lda >FDCMSR ; read FDC status4637 F89BB2 29 C0 and #$C0 ; mask bit 7,64638 F89BB4 C9 80 cmp #$80 ; bit 6 will be 04639 F89BB6 F0 0D beq ?03 ; FDCcan accept data within timeout4640 F89BB8 A9 20 lda #T2IFRB4641 F89BBA 2C 0D FD bit VIA0+VIAIFR ; test timeout4642 F89BBD F0 EF beq ?02 ; no timeout4643 F89BBF 68 pla ; pull out return address...4644 F89BC0 68 pla ; ...and discard it4645 F89BC1 A9 02 lda #FDC_SNDTOUT ; timeout error4646 F89BC3 38 sec ; error4647 F89BC4 60 rts4648 F89BC5 20 E8 9D ?03: jsr wait16us ; 16uS delay before to access data register4649 F89BC8 A5 B9 lda tmpa4650 F89BCA 8F DD FD 00 sta >FDCDATA ; send byte to controller4651 F89BCE 18 clc4652 F89BCF 60 rts4653 F89BD04654 ; wait result phase from FDC within RESTMO timeout4655 ; out: CF=1 if result phase error, A=error code4656 ; A destroyed, X&Y preserved4657 ; if error, return address from stack will be pulled out and discarded4658 F89BD0 waitres:4659 F89BD0 86 BA stx tmpx ; save X4660 F89BD2 20 E8 9D jsr wait16us ; safety delay of 16uS4661 F89BD5 A2 00 ldx #0 ; index for store 7 bytes of result4662 F89BD7 A9 20 lda #$20 ; T2 count PB6 pulses (1ms)4663 F89BD9 0C 0B FD tsb VIA0+VIAACR4664 F89BDC A9 C4 ?00: lda #<RESTMO ; setup result phase timeout4665 F89BDE 8D 08 FD sta !VIA0+VIAT2CL4666 F89BE1 A9 09 lda #>RESTMO4667 F89BE3 8D 09 FD sta !VIA0+VIAT2CH4668 F89BE6 AF DC FD 00 ?01: lda >FDCMSR ; read status reg. of FDC4669 F89BEA 29 C0 and #$C0 ; mask bit 7,64670 F89BEC C9 C0 cmp #$C0 ; bit 6 will be 1 when CPU can read FDC4671 F89BEE F0 0F beq ?03 ; data ready within timeout4672 F89BF0 A9 20 lda #T2IFRB4673 F89BF2 2C 0D FD bit VIA0+VIAIFR ; test timeout4674 F89BF5 F0 EF beq ?01 ; no timeout4675 F89BF7 A9 03 lda #FDC_RESTOUT ; set timeout result phase error4676 F89BF9 FA ?02: plx ; pull out return address...4677 F89BFA FA plx ; ...and discard it4678 F89BFB A6 BA ldx tmpx ; restore X4679 F89BFD 38 sec ; error4680 F89BFE 60 rts ; exit4681 F89BFF 20 E8 9D ?03: jsr wait16us ; 16uS delay before to read data register4682 F89C02 AF DD FD 00 lda >FDCDATA ; read FDC data register4683 F89C06 95 A4 sta fdcres,x ; store byte4684 F89C08 20 E8 9D jsr wait16us ; 16uS delay before to read status register4685 F89C0B AF DC FD 00 lda >FDCMSR ; test bit 4 (busy)4686 F89C0F 89 10 bit #00010000B4687 F89C11 F0 09 beq ?05 ; no more bytes4688 F89C13 E8 inx4689 F89C14 E0 07 cpx #7 ; max. 7 bytes in result phase4690 F89C16 90 C4 bcc ?00 ; loop next byte4691 F89C18 A9 05 lda #FDC_BADRES ; too many bytesTue Jul 17 11:00:16 2018 Page 384692 F89C1A D0 DD bne ?02 ; error4693 F89C1C A6 BA ?05: ldx tmpx4694 F89C1E 18 clc ; OK4695 F89C1F 60 rts46964697 ; wait interrupt from UM8388 within INTTMO timeout4698 ; out: CF=1 if timeout error, A=error code4699 ; A destroyed, X&Y preserved4700 ; if error, return address from stack will be pulled out and discarded4701 F89C20 waitint:4702 F89C20 A9 20 lda #$20 ; T2 count PB6 pulses (1ms)4703 F89C22 0C 0B FD tsb VIA0+VIAACR4704 F89C25 A9 C4 lda #<INTTMO ; interrupt timeout4705 F89C27 8D 08 FD sta !VIA0+VIAT2CL4706 F89C2A A9 09 lda #>INTTMO4707 F89C2C 8D 09 FD sta !VIA0+VIAT2CH4708 F89C2F AF 0D FD 00 ?02: lda >VIA0+VIAIFR4709 F89C33 89 10 bit #CB1IFRB ; CB1 -> positive edge INT from FDC4710 F89C35 D0 0C bne ?04 ; INT within timeout47114712 F89C37 89 20 bit #T2IFRB ; test timeout4713 F89C39 F0 F4 beq ?02 ; no timeout4714 F89C3B 38 sec ; error4715 F89C3C 68 pla ; pull out return address...4716 F89C3D 68 pla ; ...and discard it4717 F89C3E A9 04 lda #FDC_INTTOUT ; set timeout error4718 F89C40 85 FE sta $fe4719 F89C424720 F89C42 60 rts4721 F89C43 2C 00 FD ?04: bit VIA0+VIAPRB ; clear flag CB14722 F89C46 A9 02 lda #$02 ; enable CPU bus4723 F89C48 0C 0F FD tsb VIA0+VIAPRANH ; PA1 -> /DME = 14724 F89C4B A9 08 lda #$084725 F89C4D 14 46 trb fdcctl ; reset dma active bit4726 F89C4F 18 clc ; no error4727 F89C504728 F89C50 60 rts47294730 F89C51 chkres3:4731 F89C51 20 57 9C jsr waitint34732 F89C54 4C 62 99 jmp chkres247334734 F89C57 waitint3:4735 F89C57 A9 10 lda #CB1IFRB4736 F89C59 8D CD FD sta !VIA3+VIAIFR4737 F89C5C 64 F4 stz <$f44738 F89C5E 64 F5 stz <$f54739 F89C60 64 F6 stz <$f64740 F89C62 64 F7 stz <$f74741 F89C64 A2 00 ldx #04742 F89C66 9B txy4743 F89C67 A9 10 lda #$104744 F89C69 0C CC FD tsb VIA3+VIAPCR4745 F89C6C 78 sei4746 F89C6D INDEX164747 F89C6D C2 10 rep #PXFLAG4748 .LONGI onTue Jul 17 11:00:16 2018 Page 394749 .MNLIST4750 F89C6F ?02:4751 F89C6F A9 10 lda #CB1IFRB4752 F89C71 ?03:4753 F89C71 2C CD FD bit !VIA3+VIAIFR4754 F89C74 F0 04 beq ?044755 F89C76 2C C0 FD bit !VIA3+VIAPRB4756 F89C79 C8 iny47574758 F89C7A ?04:4759 F89C7A 2C 0D FD bit !VIA0+VIAIFR4760 ;bit #CB1IFRB ; CB1 -> positive edge INT from FDC4761 F89C7D F0 F2 beq ?0347624763 ;bne ?10 ; INT within timeout47644765 ;bit !VIA3+VIAIFR4766 ;beq ?034767 ;bit !VIA3+VIAPRB4768 ;iny4769 ;bra ?0347704771 F89C7F 2C 00 FD ?10: bit VIA0+VIAPRB ; clear flag CB147724773 F89C82 A2 00 00 ldx #$004774 F89C85 ?11:4775 F89C85 2C CD FD bit !VIA3+VIAIFR4776 F89C88 F0 04 beq ?11a4777 F89C8A 2C C0 FD bit !VIA3+VIAPRB4778 F89C8D C8 iny47794780 F89C8E ?11a:4781 F89C8E CA dex4782 F89C8F D0 F4 bne ?1147834784 F89C91 A2 00 00 ldx #$004785 F89C94 ?11c:4786 F89C94 2C CD FD bit !VIA3+VIAIFR4787 F89C97 F0 04 beq ?11d4788 F89C99 2C C0 FD bit !VIA3+VIAPRB4789 F89C9C C8 iny47904791 F89C9D ?11d:4792 F89C9D CA dex4793 F89C9E D0 F4 bne ?11c4794 F89CA04795 F89CA0 A9 02 lda #$02 ; enable CPU bus4796 F89CA2 0C 0F FD tsb VIA0+VIAPRANH ; PA1 -> /DME = 14797 F89CA5 A9 08 lda #$084798 F89CA7 14 46 trb fdcctl ; reset dma active bit4799 F89CA9 18 clc ; no error48004801 F89CAA 2C CD FD bit !VIA3+VIAIFR4802 F89CAD F0 04 beq ?124803 F89CAF 2C C0 FD bit !VIA3+VIAPRB4804 F89CB2 C8 iny4805 F89CB3 ?12:Tue Jul 17 11:00:16 2018 Page 404806 F89CB34807 F89CB3 86 F4 stx <$f44808 F89CB5 84 F6 sty <$f64809 F89CB7 INDEX084810 F89CB7 E2 10 sep #PXFLAG4811 .LONGI off4812 .MNLIST4813 F89CB9 58 cli4814 F89CBA 60 rts48154816 ; setup clock rate in controller4817 ; in: A=$00(DD),=$02(HD)4818 ; A destroyed, X&Y preserved4819 F89CBB setrate:4820 F89CBB 29 02 and #00000010B ; mask bit 14821 F89CBD F0 06 beq ?02 ; select DD4822 F89CBF 04 46 tsb fdcctl ; select HD4823 F89CC1 A9 00 lda #0 ; rate 500Kb/s4824 F89CC3 F0 04 beq ?04 ; set rate4825 F89CC5 A9 02 ?02: lda #00000010B ; rate 250Kb/s4826 F89CC7 14 46 trb fdcctl4827 F89CC9 8F DF FD 00 ?04: sta >FDCCCR ; set rate4828 F89CCD 60 rts48294830 ; enable motor and wait for spin-up timer expiration4831 ; A destroyed, X&Y preserved4832 F89CCE startmtr:4833 F89CCE 78 sei ; disable IRQ4834 F89CCF A9 30 lda #00110000B ; CNT0 mode 0 - 2 bytes4835 F89CD1 8D 4B FD sta !CTC0+CTCCTRL ; CTC 0 stopped4836 F89CD4 A9 08 lda #CB2IFRB ; spin-down timer stopped4837 F89CD6 8D 0E FD sta VIA0+VIAIER ; clear IRQ CB2 (TMF0) from CNT0 CTC4838 F89CD9 8D 0D FD sta VIA0+VIAIFR ; clear flag CB24839 F89CDC A9 10 lda #00010000B ; motor already on?4840 F89CDE 24 46 bit fdcctl4841 F89CE0 F0 02 beq ?04 ; no, put on4842 F89CE2 58 cli ; yes - exit4843 F89CE3 60 rts4844 F89CE4 04 46 ?04: tsb fdcctl ; flag motor on4845 F89CE6 09 0C ora #00001100B ; enable controller,IRQ,DMA,drive04846 F89CE8 8F DA FD 00 sta >FDCDOR ; select drive and motor4847 F89CEC 58 cli4848 F89CED A9 20 lda #$20 ; T2 count PB6 pulses (1ms)4849 F89CEF 0C 0B FD tsb VIA0+VIAACR4850 F89CF2 A9 B6 lda #<MOTACL ; spin-up delay4851 F89CF4 8D 08 FD sta !VIA0+VIAT2CL4852 F89CF7 A9 03 lda #>MOTACL4853 F89CF9 8D 09 FD sta !VIA0+VIAT2CH4854 F89CFC ?06: TASKSW ; task switch while wait timer expiration4855 F89CFC 02 00 cop FN_TASKSW4856 F89CFE 00 .DB $004857 .MNLIST4858 F89CFF AD 0D FD lda !VIA0+VIAIFR ; loop spin-up4859 F89D02 89 20 bit #T2IFRB4860 F89D04 F0 F6 beq ?064861 F89D06 60 rts4862 F89D07Tue Jul 17 11:00:16 2018 Page 414863 ; set up motor spin-down timer4864 ; this routine preserve CF4865 ; A&X&Y preserved4866 F89D07 stopmtr:4867 F89D07 78 sei ; disable IRQ4868 F89D08 A5 46 lda fdcctl4869 F89D0A 89 10 bit #00010000B ; motor bit4870 F89D0C F0 1C beq ?10 ; motor already off4871 ; motor on -> setup spin-down timer4872 F89D0E A9 30 lda #00110000B ; CNT0 mode 0 - 2 bytes4873 F89D10 8D 4B FD sta !CTC0+CTCCTRL ; CTC 0 stopped4874 F89D13 A9 08 lda #CB2IFRB4875 F89D15 8D 0E FD sta !VIA0+VIAIER ; clear IRQ CB2 (TMF0) from CNT04876 F89D18 8D 0D FD sta !VIA0+VIAIFR ; clear flag CB24877 F89D1B A9 28 lda #<MOTDCL ; setup spin-down timer4878 F89D1D 8D 48 FD sta !CTC0 ; CNT04879 F89D20 A9 0A lda #>MOTDCL4880 F89D22 8D 48 FD sta !CTC04881 F89D25 A9 88 lda #(CB2IFRB.OR.$80)4882 F89D27 8D 0E FD sta !VIA0+VIAIER ; enable interrupt on CB24883 F89D2A 58 ?10: cli4884 F89D2B 60 rts48854886 ; move dma buffer to safe area while verify data4887 F89D2C savebuf:4888 F89D2C A5 A3 lda verfp+2 ; the source bank4889 F89D2E 8F 3F 9D F8 sta ?10+2 ; store source bank for mvn istruction4890 F89D32 8B phb ; save data bank4891 F89D33 CPU164892 F89D33 C2 30 rep #(PMFLAG.OR.PXFLAG)4893 .LONGA on4894 .LONGI on4895 .MNLIST4896 F89D35 A5 94 lda ncnt4897 F89D37 3A dec a ; count #4898 F89D38 A6 A1 ldx verfp ; source address4899 F89D3A A0 00 40 ldy #!DMASAVE ; dest address4900 F89D3D 54 01 00 ?10: mvn #0,#1 ; move to bank 14901 F89D40 CPU084902 F89D40 E2 30 sep #(PMFLAG.OR.PXFLAG)4903 .LONGA off4904 .LONGI off4905 .MNLIST4906 F89D42 AB plb ; restore data bank4907 F89D43 60 rts49084909 ; restore dma buffer from safe area4910 F89D44 restbuf:4911 F89D44 08 php ; save carry4912 F89D45 48 pha ; save error code if any4913 F89D46 A5 A3 lda verfp+2 ; the source bank4914 F89D48 8F 58 9D F8 sta ?10+1 ; store dest bank for mvn istruction4915 F89D4C 8B phb ; save data bank4916 F89D4D CPU164917 F89D4D C2 30 rep #(PMFLAG.OR.PXFLAG)4918 .LONGA on4919 .LONGI onTue Jul 17 11:00:16 2018 Page 424920 .MNLIST4921 F89D4F A5 94 lda ncnt4922 F89D51 3A dec a ; count #4923 F89D52 A2 00 40 ldx #!DMASAVE ; source address4924 F89D55 A4 A1 ldy verfp ; dest address4925 F89D57 54 00 01 ?10: mvn #1,#0 ; move from bank 14926 F89D5A CPU084927 F89D5A E2 30 sep #(PMFLAG.OR.PXFLAG)4928 .LONGA off4929 .LONGI off4930 .MNLIST4931 F89D5C AB plb ; restore data bank4932 F89D5D 68 pla4933 F89D5E 28 plp4934 F89D5F 60 rts49354936 ; check params for read/write4937 ; out: CF=1 if error, A=error code4938 F89D60 chkparms:4939 F89D60 64 9E stz bufp ; always aligned at 512 bytes4940 F89D62 64 A1 stz verfp4941 F89D64 A9 FF lda #$FF4942 F89D66 85 9B sta dtlstp ; standard for disk r/w4943 F89D68 A6 B4 ldx fdop ; operation index4944 F89D6A BF B7 A0 F8 lda >VDOPTAB,x4945 F89D6E 85 B5 sta vdop ; ram disk operation4946 F89D70 30 04 bmi ?02 ; write operation4947 F89D72 A9 80 lda #$804948 F89D74 14 B6 trb opfg ; no verify for read4949 F89D76 A6 B7 ?02: ldx dskfmt4950 F89D78 BF A1 A0 F8 lda >MAXSECT,x4951 F89D7C 85 B0 sta maxsect ; max. number of sectors/track + 14952 F89D7E A5 B6 lda opfg ; test required format4953 F89D80 45 B7 eor dskfmt ; compare bit 04954 F89D82 29 01 and #$01 ; they will be the same4955 F89D84 D0 56 bne ?20 ; mismatch format4956 F89D86 24 B6 bit opfg ; test MT operation4957 F89D88 50 0B bvc ?04 ; no MT4958 F89D8A 64 AD stz head ; MT -> start head = 04959 F89D8C A2 01 ldx #1 ; MT -> start sector = 14960 F89D8E 86 AE stx sector4961 F89D90 A6 B0 ldx maxsect ; MT -> SectNum = max. sectors4962 F89D92 CA dex4963 F89D93 86 AF stx sectnum4964 F89D95 A5 AE ?04: lda sector ; start sector will be < MaxSect4965 F89D97 C5 B0 cmp maxsect4966 F89D99 B0 45 bcs ?224967 F89D9B A5 AF lda sectnum ; here CF = 04968 F89D9D A8 tay4969 F89D9E 3A dec a ; SectNum - 14970 F89D9F 65 AE adc sector ; EOT = end of track4971 F89DA1 B0 3D bcs ?22 ; overflow4972 F89DA3 C5 B0 cmp maxsect4973 F89DA5 B0 39 bcs ?22 ; EOT > (MaxSect - 1)4974 F89DA7 85 B1 sta eot ; end of track4975 F89DA9 98 tya ; number of sectors4976 F89DAA 24 B6 bit opfgTue Jul 17 11:00:16 2018 Page 434977 F89DAC 50 02 bvc ?08 ; no MT4978 F89DAE 0A asl a ; MT -> double number of sectors4979 F89DAF A8 tay4980 F89DB0 0A ?08: asl a ; number of pages of 256 bytes - here CF = 04981 F89DB1 85 95 sta ncnt+1 ; number of bytes to be trasferred4982 F89DB3 64 94 stz ncnt4983 F89DB5 84 9D sty bufcnt ; number of required dma buffers4984 F89DB7 A5 9C lda dmabuf ; test buffer dma4985 F89DB9 A8 tay4986 F89DBA 29 7F and #$7F ; mask off bit 74987 F89DBC AA tax4988 F89DBD 65 9D adc bufcnt ; here never carry4989 F89DBF C9 81 cmp #$81 ; over the limit of the bank?4990 F89DC1 B0 21 bcs ?24 ; yes4991 F89DC3 8A txa4992 F89DC4 0A asl a ; high byte of address of the buffer4993 F89DC5 85 9F sta bufp+1 ; verfp and bufp equal but in opposite bank4994 F89DC7 85 A2 sta verfp+14995 F89DC9 A2 02 ldx #BUFDSK1 ; bank of buffer #0..#1274996 F89DCB 98 tya4997 F89DCC 10 01 bpl ?124998 F89DCE E8 inx ; bank of buffer #128..#2554999 F89DCF 86 A0 ?12: stx bufp+25000 F89DD1 A0 02 ldy #BUFDSK1 ; bank of verify buffer5001 F89DD3 E0 03 cpx #BUFDSK2 ; always different from other buffer5002 F89DD5 F0 01 beq ?165003 F89DD7 C8 iny5004 F89DD8 84 A3 ?16: sty verfp+25005 F89DDA 18 clc5006 F89DDB 60 rts5007 F89DDC A9 0F ?20: lda #FDC_FMT ; format mismatch5008 F89DDE 38 sec5009 F89DDF 60 rts5010 F89DE0 A9 14 ?22: lda #FDC_PARAMS ; invalid params5011 F89DE2 38 sec5012 F89DE3 60 rts5013 F89DE4 A9 13 ?24: lda #FDC_BADBUF ; invalid buffer5014 F89DE6 38 sec5015 F89DE7 60 rts50165017 ; 16us delay for safe access to FDC register's5018 F89DE8 wait16us:50195020 [01] .IF PHI2 = 45021 000009 ??CNT .EQU 95022 [01] .ELSE5023 ??CNT .EQU 55024 [00] .ENDIF50255026 ; #cycles = 5*N + 13 + M(2 * nop) = 64/32 cycles5027 ; 4MHz -> N = 9, M = 65028 ; 2MHz -> N = 5, M = 450295030 F89DE8 A9 09 lda #??CNT5031 F89DEA 3A ?01: dec a5032 F89DEB D0 FD bne ?015033 [01] .IF PHI2 = 4Tue Jul 17 11:00:16 2018 Page 445034 F89DED EA nop5035 [00] .ENDIF5036 F89DEE EA nop5037 F89DEF EA nop5038 F89DF0 60 rts50395040 ;---------------------------------------------------------------------------5041 ; ram disk managment5042 ;---------------------------------------------------------------------------50435044 ; ram disk format whole disk (X = drive)5045 ; always return CF=05046 ; any time ram disk is formatted, change disk bit (bit 6) is set5047 F89DF1 vdfmt:5048 F89DF1 A5 45 lda vdrive5049 F89DF3 89 10 bit #$10 ; ram disk write protect on?5050 F89DF5 F0 06 beq ?01 ; no5051 F89DF7 A9 0B lda #FDC_WP ; wp on error5052 F89DF9 85 48 sta fdcerr5053 F89DFB 38 sec5054 F89DFC 60 rts5055 F89DFD 29 7C ?01: and #01111100B ; reset format5056 F89DFF 85 45 sta vdrive5057 F89E01 A9 01 lda #$01 ; reset bit 05058 F89E03 14 B6 trb fmtfg ; for first call to callback5059 F89E05 A9 01 lda #XMBANK ; bank that old X mem5060 F89E07 85 A0 sta bufp+25061 F89E09 AE 0A FC ldx CRXME ; save X mem setting5062 F89E0C DA phx5063 F89E0D 8D 0B FC sta !CRXMEON ; enable X mem in window $012000 - $013FFF5064 F89E10 A0 00 ldy #0 ; start track5065 F89E12 BB tyx ; start head5066 F89E13 84 AC ?02: sty track ; format this track...5067 F89E15 86 AD ?04: stx head ; ...in this side5068 F89E17 20 72 9F jsr getlba ; set ram disk address5069 F89E1A 8D 28 FD sta !PIA0+PIAPRA ; set ram disk bank5070 F89E1D 24 B6 bit fmtfg5071 F89E1F 10 13 bpl ?06 ; no callback5072 F89E21 4B phk ; JSL simulation5073 F89E22 F4 33 9E pea #?06-1 ; return address5074 F89E25 A5 B1 lda eot ; params for callback5075 F89E27 EB xba ; B = sector/track5076 F89E28 A5 B6 lda fmtfg5077 F89E2A 4A lsr a ; bit 0 -> carry -> 0 if first call5078 F89E2B A9 01 lda #1 ; A = drive5079 F89E2D A4 AC ldy track ; Y = track5080 F89E2F A6 AD ldx head ; X = head5081 F89E31 DC A1 00 jmp [lpfn]5082 ?06: ; return from callback5083 F89E34 A6 AF ldx sectnum ; number of sector per track5084 F89E36 INDEX165085 F89E36 C2 10 rep #PXFLAG5086 .LONGI on5087 .MNLIST5088 F89E38 A4 98 ldy xmstart ; start address of X mem5089 F89E3A 84 9E ?08: sty bufp ; sector's loop5090 F89E3C A5 B8 lda fmtfill ; fill byteTue Jul 17 11:00:16 2018 Page 455091 F89E3E A0 FF 01 ldy #$01FF ; size of sector5092 F89E41 97 9E ?10: sta [bufp],y ; fill one sector5093 F89E43 88 dey5094 F89E44 10 FB bpl ?105095 F89E46 CA dex5096 F89E47 F0 17 beq ?12 ; end sector's loop5097 F89E49 CPU16CLC5098 F89E49 C2 31 rep #(PMFLAG.OR.PXFLAG.OR.PCFLAG)5099 .LONGA on5100 .LONGI on5101 .MNLIST5102 F89E4B A5 9E lda bufp5103 F89E4D 69 00 02 adc #$0200 ; next sector pointer5104 F89E50 A8 tay5105 F89E51 ACC085106 F89E51 E2 20 sep #PMFLAG5107 .LONGA off5108 .MNLIST5109 F89E53 C0 00 40 cpy #XMSTOP ; end of X mem5110 F89E56 90 E2 bcc ?08 ; fill next block5111 F89E58 EE 28 FD inc !PIA0+PIAPRA ; increment X mem bank5112 F89E5B A0 00 20 ldy #XMSTART ; start address of X mem5113 F89E5E 80 DA bra ?08 ; fill next block5114 F89E60 ?12: INDEX085115 F89E60 E2 10 sep #PXFLAG5116 .LONGI off5117 .MNLIST5118 F89E62 A9 01 lda #$015119 F89E64 04 B6 tsb fmtfg ; bit 0 = 1 -> for callback5120 F89E66 A6 AD ldx head ; next side5121 F89E68 E8 inx5122 F89E69 E0 02 cpx #25123 F89E6B 90 A8 bcc ?04 ; same track, next side5124 F89E6D A2 00 ldx #0 ; clear head5125 F89E6F A4 AC ldy track ; next track5126 F89E71 C8 iny5127 F89E72 C0 50 cpy #805128 F89E74 90 9D bcc ?02 ; next track, side=05129 F89E76 A5 45 lda vdrive ; set valid format5130 F89E78 29 7C and #01111100B5131 F89E7A 05 B7 ora dskfmt ; update format in selected drive5132 F89E7C 09 C0 ora #$C0 ; current valid format5133 F89E7E 85 45 sta vdrive ; set bit 6: change disk5134 F89E80 FA plx ; restore X mem setting5135 F89E81 9D 0A FC sta !CRXME,x5136 F89E84 A2 3E ldx #RTCRDFG ; validate ram disk configuration5137 F89E86 8E 4C FD stx RTCALE5138 F89E89 A9 55 lda #$555139 F89E8B 8D 4D FD sta RTCDATA5140 F89E8E E8 inx ; save configuration in RTC ram5141 F89E8F 8E 4C FD stx RTCALE5142 F89E92 A5 45 lda vdrive5143 F89E94 8D 4D FD sta RTCDATA ; save ram disk5144 F89E97 18 clc5145 F89E98 60 rts51465147 ; execute read/write on ram diskTue Jul 17 11:00:16 2018 Page 465148 ; in: vdop=command ($00=read, $80=write, $40=fake verify)5149 ; opfg<7>=1 if read verify buffer5150 ; out: CF=1 if error (just verify error in ram disk)5151 ; A,X,Y destroyed5152 F89E99 vdrw:5153 F89E99 20 60 9D jsr chkparms ; check params5154 F89E9C 90 03 bcc ?02 ; ok5155 F89E9E 85 48 ?01: sta fdcerr5156 F89EA0 60 rts ; return error5157 F89EA1 24 B5 ?02: bit vdop ; write operation?5158 F89EA3 10 0B bpl ?04 ; no5159 F89EA5 A9 10 lda #$105160 F89EA7 24 45 bit vdrive ; write protect?5161 F89EA9 F0 05 beq ?04 ; no5162 F89EAB A9 0B lda #FDC_WP ; yes...5163 F89EAD 38 sec ; ...error5164 F89EAE 80 EE bra ?015165 F89EB0 24 B6 ?04: bit opfg ; verify buffer?5166 F89EB2 10 03 bpl ?06 ; no5167 F89EB4 20 2C 9D jsr savebuf ; save verify buffer5168 F89EB7 20 72 9F ?06: jsr getlba ; set ram disk address5169 F89EBA 8D 28 FD sta !PIA0+PIAPRA ; set ram disk bank5170 F89EBD 64 B2 stz buftst ; now using bufp buffer5171 F89EBF 20 EE 9E jsr vdcmd ; execute command (here always CF = 0)5172 F89EC2 A5 B6 lda opfg5173 F89EC4 10 27 bpl ?20 ; no verify, exit5174 F89EC6 85 B2 sta buftst ; now using verfp buffer5175 F89EC8 64 B5 stz vdop ; read for verify5176 F89ECA A5 BB lda xmbank5177 F89ECC 8D 28 FD sta !PIA0+PIAPRA ; set ram disk bank5178 F89ECF 20 EE 9E jsr vdcmd ; execute command5179 F89ED2 A0 00 ldy #0 ; verify data5180 F89ED4 INDEX165181 F89ED4 C2 10 rep #PXFLAG5182 .LONGI on5183 .MNLIST5184 F89ED6 B7 9E ?08: lda [bufp],y5185 F89ED8 D7 A1 cmp [verfp],y5186 F89EDA D0 05 bne ?10 ; unmatch: ZF=05187 F89EDC C8 iny5188 F89EDD C4 94 cpy ncnt5189 F89EDF 90 F5 bcc ?08 ; when finish ZF=15190 F89EE1 ?10: INDEX08 ; here ZF=1 if match5191 F89EE1 E2 10 sep #PXFLAG5192 .LONGI off5193 .MNLIST5194 F89EE3 18 clc ; assume no error5195 F89EE4 F0 04 beq ?125196 F89EE6 A9 12 lda #FDC_VER ; verify error5197 F89EE8 85 48 sta fdcerr5198 F89EEA 20 44 9D ?12: jsr restbuf ; restore verify buffer5199 F89EED 60 ?20: rts52005201 ; ram disk read/write command5202 ; in: vdop=command ($00=read, $80=write, $40=fake verify)5203 ; buftst=0 if using bufp, =$80 if using verfp5204 ; out: CF=0 alwaysTue Jul 17 11:00:16 2018 Page 475205 ; A,X,Y destroyed5206 F89EEE vdcmd:5207 F89EEE AE 0A FC ldx .ABS.CRXME ; save X mem setting5208 F89EF1 DA phx5209 F89EF2 8D 0B FC sta !CRXMEON ; enable X mem in window $012000 - $013FFF5210 F89EF5 INDEX165211 F89EF5 C2 10 rep #PXFLAG5212 .LONGI on5213 .MNLIST5214 F89EF7 A4 94 ldy ncnt5215 F89EF9 24 B5 bit vdop ; fake verify operation?5216 F89EFB 70 6B bvs ?24 ; yes, no operation in ram disk5217 F89EFD A6 9E ldx bufp ; buffer start for read/write5218 F89EFF A5 A0 lda bufp+25219 F89F01 24 B2 bit buftst ; read verify buffer?5220 F89F03 10 04 bpl ?02 ; no, so use bufp buffer5221 F89F05 A6 A1 ldx verfp ; yes, so use verfp verify buffer5222 F89F07 A5 A3 lda verfp+25223 F89F09 86 9A ?02: stx bufstart ; set start buffer for ram disk access5224 F89F0B 85 B9 sta tmpa ; source or dest bank5225 F89F0D ACC16CLC ; calc end of transfer buffer5226 F89F0D C2 21 rep #(PMFLAG.OR.PCFLAG)5227 .LONGA on5228 .MNLIST5229 F89F0F 98 tya ; count #5230 F89F10 65 9A adc bufstart5231 F89F12 85 9C sta bufend ; end address of transfer5232 F89F14 ACC085233 F89F14 E2 20 sep #PMFLAG5234 .LONGA off5235 .MNLIST5236 F89F16 A9 FF lda #$FF5237 F89F18 EB xba ; B = $FF5238 F89F19 24 B5 bit vdop ; check read/write flag5239 F89F1B 10 24 bpl ?14 ; read operation5240 ; write operation5241 F89F1D A5 B9 lda tmpa ; the source bank5242 F89F1F 8F 2D 9F F8 sta ?10+2 ; store source bank for mvn istruction5243 F89F23 A6 9A ldx bufstart ; start address of source block5244 F89F25 8B phb ; save current danta bank5245 F89F26 A4 98 ldy xmstart ; start address of current h&t&&s5246 F89F28 A9 01 ?08: lda #$01 ; size of block - 1 (512 bytes)5247 F89F2A EB xba ; before B = $FF, A = $01 -> C = $01FF5248 F89F2B 54 01 00 ?10: mvn #0,#1 ; move sector from bank 2 or 3 to bank 15249 F89F2E E4 9C cpx bufend ; X point past the last moved byte5250 F89F30 B0 33 bcs ?22 ; end of move5251 F89F32 C0 00 40 cpy #XMSTOP ; end of X mem?5252 F89F35 90 F1 bcc ?08 ; no, move next block5253 F89F37 AB plb ; restore data bank5254 F89F38 EE 28 FD inc PIA0+PIAPRA ; increment X mem bank5255 F89F3B 8B phb ; save current danta bank5256 F89F3C A0 00 20 ldy #XMSTART ; start address from beginning of X mem5257 F89F3F 80 E7 bra ?08 ; move next block5258 ?14: ; read operation5259 F89F41 A5 B9 lda tmpa ; dest bank5260 F89F43 A4 9A ldy bufstart ; start address of dest. block5261 F89F45 8F 50 9F F8 sta ?20+1 ; store dest. bank for mvn istructionTue Jul 17 11:00:16 2018 Page 485262 F89F49 8B phb ; save current danta bank5263 F89F4A A6 98 ldx xmstart ; start address of current h&t&s5264 F89F4C A9 01 ?18: lda #$01 ; size of block - 1 (512 bytes)5265 F89F4E EB xba ; before B = $FF, A = $01 -> C = $01FF5266 F89F4F 54 00 01 ?20: mvn #1,#0 ; move sector from bank 1 to bank 2 or 35267 F89F52 C4 9C cpy bufend ; Y point past the last moved byte5268 F89F54 B0 0F bcs ?22 ; end of move5269 F89F56 E0 00 40 cpx #XMSTOP ; end of X mem?5270 F89F59 90 F1 bcc ?18 ; no, move next block5271 F89F5B AB plb ; restore data bank5272 F89F5C EE 28 FD inc PIA0+PIAPRA ; increment X mem bank5273 F89F5F 8B phb5274 F89F60 A2 00 20 ldx #XMSTART ; start address from beginning of X mem5275 F89F63 80 E7 bra ?18 ; move next block5276 F89F65 AB ?22: plb ; restore data bank5277 F89F66 A4 94 ldy ncnt5278 F89F68 84 96 ?24: sty ntrsf ; store numbers of moved bytes5279 F89F6A INDEX085280 F89F6A E2 10 sep #PXFLAG5281 .LONGI off5282 .MNLIST5283 F89F6C FA plx ; restore X mem setting5284 F89F6D 9D 0A FC sta !CRXME,x5285 F89F70 18 clc5286 F89F71 60 rts5287 F89F725288 ; translate the tuplet (T,H,S) into LBA (Linear Block Address)5289 ; LBA = [(2*track + head)]*P + sector - 15290 ; where P = sectors/track5291 F89F72 getlba:5292 F89F72 20 96 9F jsr lbabase ; get LBA base5293 F89F75 A6 AE ldx sector5294 F89F77 86 B9 stx mcand1 ; store S in word5295 F89F79 64 BA stz mcand25296 F89F7B ACC16CLC ; A/M 16 bit + CLC5297 F89F7B C2 21 rep #(PMFLAG.OR.PCFLAG)5298 .LONGA on5299 .MNLIST5300 F89F7D 65 B9 adc mcand15301 F89F7F 3A dec a ; LBA5302 F89F80 6A ror a ; divide by 16 to get xmem bank5303 F89F81 6A ror a5304 F89F82 6A ror a5305 F89F83 6A ror a5306 F89F84 ACC085307 F89F84 E2 20 sep #PMFLAG5308 .LONGA off5309 .MNLIST5310 F89F86 85 BB sta xmbank ; ram disk bank5311 F89F88 EB xba ; B = bank, A = modulus5312 F89F89 6A ror a ; shift in last carry5313 F89F8A 4A lsr a ; calc the modulo5314 F89F8B 4A lsr a5315 F89F8C 4A lsr a ; MSB of xmem5316 F89F8D 18 clc5317 F89F8E 69 20 adc #>XMSTART ; add the physical start of xmem5318 F89F90 85 99 sta xmstart+1Tue Jul 17 11:00:16 2018 Page 495319 F89F92 64 98 stz xmstart5320 F89F94 EB xba ; return in A the ram disk bank5321 F89F95 60 rts5322 F89F965323 ; get base of Linear Block Address (LBA)5324 ; LBA = [(2*track + head)]*P + sector - 15325 ; where P = sectors/track5326 ; this function calc the LBA base = [(2*track + head)]*P5327 ; the result is stored in C5328 F89F96 lbabase:5329 F89F96 A5 B0 lda maxsect5330 F89F98 3A dec a5331 F89F99 85 B9 sta mcand1 ; multiplicand #15332 F89F9B A5 AC lda track5333 F89F9D 0A asl a ; 2*track (here always CF = 0)5334 F89F9E 65 AD adc head5335 F89FA0 85 BA sta mcand2 ; 2*track + head5336 F89FA2 A9 00 lda #0 ; MSB result of (macnd1 * mcand2)5337 F89FA4 A2 09 ldx #9 ; loop 9 bit5338 F89FA6 18 clc5339 F89FA7 6A ?02: ror a5340 F89FA8 66 B9 ror mcand1 ; LSB result of multiplication5341 F89FAA 90 03 bcc ?045342 F89FAC 18 clc5343 F89FAD 65 BA adc mcand25344 F89FAF CA ?04: dex5345 F89FB0 D0 F5 bne ?025346 F89FB2 EB xba ; B = MSB of result5347 F89FB3 A5 B9 lda mcand1 ; A = LSB of result5348 F89FB5 60 rts ; C = 16 bit result53495350 ;---------------------------------------------------------------------------5351 ; POST routine5352 ;---------------------------------------------------------------------------53535354 ; this routine is invoked within boot phase5355 F89FB6 fdinit:5356 F89FB6 A9 FB lda #11111011B5357 F89FB8 14 46 trb fdcctl ; reset all bit's but not dma flag5358 F89FBA A9 02 lda #00000010B5359 F89FBC 04 46 tsb fdcctl ; select HD rte at beginning5360 F89FBE 20 CE 9C jsr startmtr ; start motor5361 F89FC1 20 3A 9B jsr fdcrst ; reset FDC controller5362 F89FC4 A9 20 lda #$20 ; test bit 55363 F89FC6 24 46 bit fdcctl5364 F89FC8 F0 37 beq ?100 ; FDC controller fault5365 F89FCA 20 31 A0 jsr ?1105366 F89FCD 64 48 stz fdcerr5367 F89FCF 20 CE 9C jsr startmtr ; start motor5368 F89FD2 20 95 99 jsr seek0 ; recalibrate after reset and seek track 05369 F89FD5 B0 1B bcs ?30 ; fail5370 F89FD7 A9 80 lda #$80 ; set flag drive ok5371 F89FD9 04 46 tsb fdcctl5372 F89FDB5373 F89FDB SCNPRINT5374 F89FDB 02 01 cop $015375 .MNLISTTue Jul 17 11:00:16 2018 Page 505376 F89FDD 70 61 73 73 2E .DB 'pass.', $0D, $000D 005377 F89FE45378 F89FE4 AF DF FD 00 lda >FDCDIR ; read disk change line5379 F89FE8 29 80 and #$80 ; bit 7 will be 0 if disk ready5380 F89FEA D0 03 bne ?20 ; not ready5381 F89FEC 20 10 99 jsr chkwp ; aquire wp status5382 F89FEF 18 ?20: clc5383 F89FF0 80 0C bra ?325384 F89FF2 ?30: SCNPRINT5385 F89FF2 02 01 cop $015386 .MNLIST5387 F89FF4 66 61 69 6C 2E .DB 'fail.', $0D, $000D 005388 F89FFB 38 sec5389 F89FFC 85 48 sta fdcerr5390 F89FFE 4C 07 9D ?32: jmp stopmtr5391 F8A0015392 F8A001 ?100: SCNPRINT5393 F8A001 02 01 cop $015394 .MNLIST5395 F8A003 45 52 52 4F 52 .DB 'ERROR: diskette controller UM8388 fail', $0D, $003A 20 64 69 736B 65 74 74 6520 63 6F 6E 7472 6F 6C 6C 6572 20 55 4D 3833 38 38 20 6661 69 6C 0D 005396 F8A02B TASKSW5397 F8A02B 02 00 cop FN_TASKSW5398 F8A02D 00 .DB $005399 .MNLIST5400 F8A02E 4C 07 9D jmp stopmtr ; exit5401 F8A0315402 F8A031 ?110: SCNPRINT5403 F8A031 02 01 cop $015404 .MNLIST5405 F8A033 64 72 69 76 65 .DB 'drive #0...', $0020 23 30 2E 2E2E 005406 F8A03F 60 rts5407 F8A0405408 ; POST routine for initial ram disk configuration5409 F8A040 vdinit:5410 F8A040 20 66 A0 jsr ?1005411 F8A043 A9 40 lda #$405412 F8A045 85 45 sta vdrive ; reset unformatted ram disk (disk changed)5413 F8A047 20 75 A0 jsr ?1105414 F8A04A 24 0C bit Bnk0Flag ; <6> -> warm reset flag5415 F8A04C 50 17 bvc ?10 ; cold reset - unformatted5416 F8A04E A2 3E ldx #RTCRDFG ; resume saved configuration5417 F8A050 8E 4C FD stx RTCALE ; from RTC RAM in bank 0 & 15418 F8A053 AD 4D FD lda RTCDATA ; valid ram disk configuration?5419 F8A056 C9 55 cmp #$555420 F8A058 D0 0B bne ?10 ; no -- make default ram disk5421 F8A05A E8 inxTue Jul 17 11:00:16 2018 Page 515422 F8A05B 8E 4C FD stx RTCALE5423 F8A05E AD 4D FD lda RTCDATA ; get ram disk 0 configuration5424 F8A061 09 40 ora #$40 ; always disk ghanged at startup5425 F8A063 85 45 sta vdrive5426 F8A065 60 ?10: rts54275428 F8A066 ?100: SCNPRINT5429 F8A066 02 01 cop $015430 .MNLIST5431 F8A068 64 72 69 76 65 .DB 'drive #1...', $0020 23 31 2E 2E2E 005432 F8A074 60 rts54335434 F8A075 ?110: SCNPRINT5435 F8A075 02 01 cop $015436 .MNLIST5437 F8A077 76 69 72 74 75 .DB 'virtual drive (ram disk).', $0D, $0061 6C 20 64 7269 76 65 20 2872 61 6D 20 6469 73 6B 29 2E0D 005438 F8A092 60 rts54395440 ;---------------------------------------------------------------------------5441 ; Tables5442 ;---------------------------------------------------------------------------54435444 ; ctl function's table5445 F8A093 CTLFN:5446 F8A093 3594 3B94 3E94 .DW ctl_fn0, ctl_fn1, ctl_fn2, ctl_fn3, ctl_fn45D94 7B945447 F8A09D B194 BD94 .DW ctl_fn5, ctl_fn654485449 000007 MXCTLFN .EQU ($-CTLFN)/254505451 ; max. number of secors/track5452 F8A0A1 MAXSECT5453 F8A0A1 0A 0B 13 15 .DB 10, 11, 19, 2154545455 ; GAP 3 lenght for rd/wr command5456 F8A0A5 RWGPLTBL:5457 F8A0A5 1B 10 36 14 .DB RWGPL3DD, RWGPL3DDA, RWGPL3HD, RWGPL3HDA54585459 ; GAP 3 lenght while format track5460 F8A0A9 FGPLTBL:5461 F8A0A9 54 24 6C 32 .DB FMGPL3DD, FMGPL3DDA, FMGPL3HD, FMGPL3HDA5462 F8A0AD5463 ; head inversion for MSDOS/CBM format5464 F8A0AD HEADTBL:5465 F8A0AD 00 01 00 01 .DB $00, $01, $00, $0154665467 ; commands for UM83885468 F8A0B1 CMDTAB:5469 F8A0B1 66 66 45 .DB CMDREAD, CMDREAD, CMDWRITE5470 F8A0B4Tue Jul 17 11:00:16 2018 Page 525471 ; transfer command for DMA5472 F8A0B4 DMATAB:5473 F8A0B4 46 42 4A .DB WRITETRASF, VERFTRASF, READTRASF5474 F8A0B75475 ; disk operation flag (read, verify, write)5476 F8A0B7 VDOPTAB:5477 F8A0B7 00 40 80 .DB $00, $40, $80547854795480 F8A0BA testdma:5481 F8A0BA A2 44 ldx #$445482 F8A0BC A0 CC ldy #$CC5483 F8A0BE 64 F0 stz <$f05484 F8A0C0 64 F1 stz <$f15485 F8A0C2 64 F2 stz <$f25486 F8A0C4 64 F3 stz <$f35487 F8A0C6 64 F4 stz <$f45488 F8A0C8 64 F5 stz <$f55489 F8A0CA 64 F6 stz <$f65490 F8A0CC 64 F7 stz <$f75491 F8A0CE5492 F8A0CE 8D 9C FD ?06: sta !DMAWCLRFF ; clear F/F5493 F8A0D1 E6 F0 inc <$f05494 F8A0D3 EA nop5495 F8A0D4 EA nop5496 F8A0D5 8A txa5497 F8A0D6 8D 90 FD sta !DMAC+DMAADDR0 ; store low buffer address5498 F8A0D9 EA nop5499 F8A0DA EA nop5500 F8A0DB 98 tya5501 F8A0DC 8D 90 FD sta !DMAC+DMAADDR0 ; store high buffer address5502 F8A0DF EA nop5503 F8A0E0 8D 9C FD sta !DMAWCLRFF ; clear F/F5504 F8A0E3 EA nop5505 F8A0E4 EA nop5506 F8A0E5 8A txa5507 F8A0E6 CD 90 FD cmp !DMAC+DMAADDR0 ; cmp low buffer address5508 F8A0E9 D0 E3 bne ?065509 F8A0EB 98 tya5510 F8A0EC CD 90 FD cmp !DMAC+DMAADDR0 ; cmp high buffer address5511 F8A0EF D0 DD bne ?065512 F8A0F1 A2 5D ldx #$5D ; X=low count5513 F8A0F3 A0 BF ldy #$BF ; Y=high count5514 F8A0F5 8D 9C FD ?08: sta !DMAWCLRFF ; clear F/F5515 F8A0F8 E6 F1 inc <$f15516 F8A0FA EA nop5517 F8A0FB EA nop5518 F8A0FC 8A txa5519 F8A0FD 8D 91 FD sta !DMAC+DMACNT0 ; store low count5520 F8A100 EA nop5521 F8A101 EA nop5522 F8A102 98 tya5523 F8A103 8D 91 FD sta !DMAC+DMACNT0 ; store high count5524 F8A106 EA nop5525 F8A107 8D 9C FD sta !DMAWCLRFF ; clear F/F5526 F8A10A EA nop5527 F8A10B EA nopTue Jul 17 11:00:16 2018 Page 535528 F8A10C 8A txa5529 F8A10D CD 91 FD cmp !DMAC+DMACNT0 ; cmp low count5530 F8A110 D0 E3 bne ?085531 F8A112 98 tya5532 F8A113 CD 91 FD cmp !DMAC+DMACNT0 ; cmp high count5533 F8A116 D0 DD bne ?085534 F8A118 8D 9C FD sta !DMAWCLRFF ; clear F/F55355536 F8A11B 8D 9C FD ?06a: sta !DMAWCLRFF ; clear F/F5537 F8A11E E6 F2 inc <$f25538 F8A120 EA nop5539 F8A121 EA nop5540 F8A122 8A txa5541 F8A123 8D 92 FD sta !DMAC+DMAADDR1 ; store low buffer address5542 F8A126 EA nop5543 F8A127 EA nop5544 F8A128 98 tya5545 F8A129 8D 92 FD sta !DMAC+DMAADDR1 ; store high buffer address5546 F8A12C EA nop5547 F8A12D 8D 9C FD sta !DMAWCLRFF ; clear F/F5548 F8A130 EA nop5549 F8A131 EA nop5550 F8A132 8A txa5551 F8A133 CD 92 FD cmp !DMAC+DMAADDR1 ; cmp low buffer address5552 F8A136 D0 E3 bne ?06a5553 F8A138 98 tya5554 F8A139 CD 92 FD cmp !DMAC+DMAADDR1 ; cmp high buffer address5555 F8A13C D0 DD bne ?06a5556 F8A13E A2 5D ldx #$5D ; X=low count5557 F8A140 A0 BF ldy #$BF ; Y=high count5558 F8A142 8D 9C FD ?08a: sta !DMAWCLRFF ; clear F/F5559 F8A145 E6 F3 inc <$f35560 F8A147 EA nop5561 F8A148 EA nop5562 F8A149 8A txa5563 F8A14A 8D 93 FD sta !DMAC+DMACNT1 ; store low count5564 F8A14D EA nop5565 F8A14E EA nop5566 F8A14F 98 tya5567 F8A150 8D 93 FD sta !DMAC+DMACNT1 ; store high count5568 F8A153 EA nop5569 F8A154 8D 9C FD sta !DMAWCLRFF ; clear F/F5570 F8A157 EA nop5571 F8A158 EA nop5572 F8A159 8A txa5573 F8A15A CD 93 FD cmp !DMAC+DMACNT1 ; cmp low count5574 F8A15D D0 E3 bne ?08a5575 F8A15F 98 tya5576 F8A160 CD 93 FD cmp !DMAC+DMACNT1 ; cmp high count5577 F8A163 D0 DD bne ?08a5578 F8A165 8D 9C FD sta !DMAWCLRFF ; clear F/F55795580 F8A168 8D 9C FD ?06b: sta !DMAWCLRFF ; clear F/F5581 F8A16B E6 F4 inc <$f45582 F8A16D EA nop5583 F8A16E EA nop5584 F8A16F 8A txaTue Jul 17 11:00:16 2018 Page 545585 F8A170 8D 94 FD sta !DMAC+DMAADDR2 ; store low buffer address5586 F8A173 EA nop5587 F8A174 EA nop5588 F8A175 98 tya5589 F8A176 8D 94 FD sta !DMAC+DMAADDR2 ; store high buffer address5590 F8A179 EA nop5591 F8A17A 8D 9C FD sta !DMAWCLRFF ; clear F/F5592 F8A17D EA nop5593 F8A17E EA nop5594 F8A17F 8A txa5595 F8A180 CD 94 FD cmp !DMAC+DMAADDR2 ; cmp low buffer address5596 F8A183 D0 E3 bne ?06b5597 F8A185 98 tya5598 F8A186 CD 94 FD cmp !DMAC+DMAADDR2 ; cmp high buffer address5599 F8A189 D0 DD bne ?06b5600 F8A18B A2 5D ldx #$5D ; X=low count5601 F8A18D A0 BF ldy #$BF ; Y=high count5602 F8A18F 8D 9C FD ?08b: sta !DMAWCLRFF ; clear F/F5603 F8A192 E6 F5 inc <$f55604 F8A194 EA nop5605 F8A195 EA nop5606 F8A196 8A txa5607 F8A197 8D 95 FD sta !DMAC+DMACNT2 ; store low count5608 F8A19A EA nop5609 F8A19B EA nop5610 F8A19C 98 tya5611 F8A19D 8D 95 FD sta !DMAC+DMACNT2 ; store high count5612 F8A1A0 EA nop5613 F8A1A1 8D 9C FD sta !DMAWCLRFF ; clear F/F5614 F8A1A4 EA nop5615 F8A1A5 EA nop5616 F8A1A6 8A txa5617 F8A1A7 CD 95 FD cmp !DMAC+DMACNT2 ; cmp low count5618 F8A1AA D0 E3 bne ?08b5619 F8A1AC 98 tya5620 F8A1AD CD 95 FD cmp !DMAC+DMACNT2 ; cmp high count5621 F8A1B0 D0 DD bne ?08b5622 F8A1B2 8D 9C FD sta !DMAWCLRFF ; clear F/F56235624 F8A1B5 8D 9C FD ?06c: sta !DMAWCLRFF ; clear F/F5625 F8A1B8 E6 F6 inc <$f65626 F8A1BA EA nop5627 F8A1BB EA nop5628 F8A1BC 8A txa5629 F8A1BD 8D 96 FD sta !DMAC+DMAADDR3 ; store low buffer address5630 F8A1C0 EA nop5631 F8A1C1 EA nop5632 F8A1C2 98 tya5633 F8A1C3 8D 96 FD sta !DMAC+DMAADDR3 ; store high buffer address5634 F8A1C6 EA nop5635 F8A1C7 8D 9C FD sta !DMAWCLRFF ; clear F/F5636 F8A1CA EA nop5637 F8A1CB EA nop5638 F8A1CC 8A txa5639 F8A1CD CD 96 FD cmp !DMAC+DMAADDR3 ; cmp low buffer address5640 F8A1D0 D0 E3 bne ?06c5641 F8A1D2 98 tyaTue Jul 17 11:00:16 2018 Page 555642 F8A1D3 CD 96 FD cmp !DMAC+DMAADDR3 ; cmp high buffer address5643 F8A1D6 D0 DD bne ?06c5644 F8A1D8 A2 5D ldx #$5D ; X=low count5645 F8A1DA A0 BF ldy #$BF ; Y=high count5646 F8A1DC 8D 9C FD ?08c: sta !DMAWCLRFF ; clear F/F5647 F8A1DF E6 F7 inc <$f75648 F8A1E1 EA nop5649 F8A1E2 EA nop5650 F8A1E3 8A txa5651 F8A1E4 8D 97 FD sta !DMAC+DMACNT3 ; store low count5652 F8A1E7 EA nop5653 F8A1E8 EA nop5654 F8A1E9 98 tya5655 F8A1EA 8D 97 FD sta !DMAC+DMACNT3 ; store high count5656 F8A1ED EA nop5657 F8A1EE 8D 9C FD sta !DMAWCLRFF ; clear F/F5658 F8A1F1 EA nop5659 F8A1F2 EA nop5660 F8A1F3 8A txa5661 F8A1F4 CD 97 FD cmp !DMAC+DMACNT3 ; cmp low count5662 F8A1F7 D0 E3 bne ?08c5663 F8A1F9 98 tya5664 F8A1FA CD 97 FD cmp !DMAC+DMACNT3 ; cmp high count5665 F8A1FD D0 DD bne ?08c5666 F8A1FF 8D 9C FD sta !DMAWCLRFF ; clear F/F5667 F8A202 EA nop5668 F8A203 00 00 brk5669 F8A205 00 00 brk5670 F8A2075671 ;---------------------------------------------------------------------------5672 ; end of file5673 ;---------------------------------------------------------------------------Lines Assembled : 5506 Errors : 0