Blame | Last modification | View Log | Download | RSS feed
Tue Jul 17 11:00:18 2018 Page 12500 A.D. 65816 Macro Assembler #26960 - Version 5.02g-----------------------------------------------------Input Filename : src\F8\usbdsk.asmOutput Filename : obj\F8\usbdsk.objListing Has Been Relocated2583 .LIST on25842585 F8FFB1 .INCLUDE inc\dirp00.inc2586 ;----------------------------------------------------------2587 ; DIRP00.ASM2588 ; PROGETTO: B16012589 ;2590 ; Variabili in Direct Page $002591 ;----------------------------------------------------------25922593 ; sezione COMMON -- questo permette di includere il file in piu' file25942595 .LIST on25962597 DIRP00: .SECTION page0, ref_only, common ;Direct-Page 0025982599 000000 .ABSOLUTE ;; inizia sempre da $002600 000000 .ORG 0x002601 0000002602 000000 0000 JiffyClk .DW ; contatore 10ms 32 bit2603 000002 0000 .DW2604 000004 SysTmr .DS SYSTMRCNT ; system timer 0 (10ms)2605 000008 SysTMF .DS SYSTMRCNT ; flag timer (80 -> start)2606 00000C 00 Bnk0Flag .DB ; <7>: flag test RAM banco 0 ok2607 ; <6>: flag warm reset2608 00000D 00 RTCFlag .DB26092610 00000E diskstat .DS 2 ; flag device on ata bus #0 & #12611 ; <7>: device ready2612 ; <6>: compact flash device (C.F.)2613 ; <5>: device identification ok2614 ; <4>: MBR loaded2615 ; <3>: valid signature in MBR2616 ; <2>: first partition found&active2617 ; <1>:2618 ; <0>: valid partition flag26192620 ; <7>: device ready2621 ; <6>: USB device2622 ; <5>: compact flash device (C.F.)2623 ; <4>: device identification ok2624 ; <3>: MBR loaded2625 ; <2>: first partition found&active2626 ; <1>: always 12627 ; <0>: valid partition flag2628 000010Tue Jul 17 11:00:18 2018 Page 226292630 00000E atadev .EQU diskstat26312632 000010 usbdev .DS 2 ; flag flash disk on usb bus #02633 ; <7>: device plugged and ready2634 ; <6>: always 12635 ; <5>: device identification ok2636 ; <4>: MBR loaded2637 ; <3>: valid signature in MBR2638 ; <2>: first partition found&active2639 ; <1>:2640 ; <0>: valid partition flag26412642 000012 diskmax .DS 16 ; disk max. sector's2643 000012 atasec .EQU diskmax2644 00001A usbsec .EQU diskmax+8264526462647 000022 atambr .DS 8 ; data for first partition found in mbr2648 ; first 3 bytes for start sector of partition2649 ; last byte for partition type2650 00002A usbmbr .DS 826512652 000032 ataprt .DS 8 ; total sec's of first partition2653 00003A usbprt .DS 8 ; total sec's of first partition265426552656 000042 00 usb0ch .DB ; usb0 (ch375/ch376) flag2657 ; <7>: module on2658 ; <6>: ch376 flag2659 ; <5:0>: chip version26602661 000043 00 usb0st .DB ; usb0 status2662 ; <7>: usb0 host mode ok2663 ; <6>: flash disk attached flag2664 ; <5>: usb device attached26652666 000044 00 fdcdrv .DB ; phisycal drive status (drive #0)2667 ; <7>: disk format established in bit 0&12668 ; <6>: double step seek done2669 ; <5>: trust format bit's (set after ok r/w)2670 ; <4>: write protect bit (if disk in drive)2671 ; <3>: don't care2672 ; <2>: don't care2673 ; <1>: HD disk if set else DD disk2674 ; <0>: CBM format if set else IBM format26752676 000045 00 vdrive .DB ; virtual drive status (ram disk, drive #1)2677 ; <7>: disk format established in bit 0&12678 ; <6>: change disk simulation (after format)2679 ; <5>: don't care2680 ; <4>: write protect bit (under sw control)2681 ; <3>: don't care2682 ; <2>: don't care2683 ; <1>: HD disk if set else DD disk2684 ; <0>: CBM format if set else IBM format2685Tue Jul 17 11:00:18 2018 Page 32686 000046 00 fdcctl .DB ; fdc controller status2687 ; <7>: drive is attached2688 ; <6>: drive need recalibration (restore)2689 ; <5>: FDC controller ok2690 ; <4>: motor on2691 ; <3>: dma is active2692 ; <2>: dma chip ok (post routine)2693 ; <1>: clock rate (1=HD,0=DD)2694 ; <0>: disk ready26952696 000047 00 fdctrk .DB ; fd: current seek track2697 000048 00 fdcerr .DB ; fd: last error code2698 000049 00 ataerr .DB ; ata: last error code2699 00004A 00 ataxer .DB ; ata: last extended error code27002701 00004B 00 CtrlBrk .DB ; flag CTRL+BREAK (NMI)27022703 00004C 0000 MemTop .DW ; top memoria RAM2704 00004E 00 .DB ; banco top mem27052706 00004F 00 DflTxtIn .DB ; device di default text input2707 000050 00 DflTxtOut .DB ; device di default text output27082709 000051 COPPtr LP ; long pointer for COP decoding2710 000054 00 COPIdx .DB ; COP signature/index27112712 000055 00 BiosEnt .DB ; flag accesso a bios setup27132714 ; variabili utilizzate da ACIA2715 000056 spwrk .DS $3027162717 ; bios mem2718 000086 0000 nsize .DW ; dimensione blocco da allocare2719 ;bsize .DW ; dimensione vera blocco free2720 000088 0000 splitsz .DW ; dimensione blocco splittato2721 00008A 0000 bfree .DW ; puntatore blocco free2722 00008C 0000 hdrptr .DW ; puntatore header heap27232724 00008E 0000 pbrklv .DW ; current break level of current process2725 000090 0000 pbrkmin .DW ; minimum breal level of current process2726 000092 0000 pbrkmax .DW ; maximum breal level of current process2727 0000942728 ; bios temp. work area2729 000094 bwrktmp .DS $2827302731 0000BC 00 coptmp .DB ; temp. used while cop27322733 0000BD 00 tstser .DB ; check ser/usb test board post2734 ; <7>: VIA2 ok2735 ; <6>: PICRAM ok2736 ; <1>: UART 16C550 ok2737 ; <0>: R65C51 ok273827392740 ;crc16 .DW27412742 0000BD .RELATIVETue Jul 17 11:00:18 2018 Page 427432744 .ENDS27452746 [01] .IFDEF _ACIA_INC_2747 .INCLUDE INC\SP.INC2748 [00] .ENDIF27492758 .LIST on2759 ;---------------------------------------------------------------------------2760 ; Logical Drive Table (LDT) -- page 0 offset's2761 ;---------------------------------------------------------------------------27622763 F8FFB1 STRUCT LDT2764 _LDT .SECTION page0,common,ref_only,offset 0 ;LDT Struct2765 ;.ABSOLUTE2766 ;.ORG 02767 .MNLIST2768 000000 00 ldt_fg1 .DB ; logical volume flag's2769 ; <7>: device ready (fdc drive or ata device)2770 ; <6>: if=1->HD/CF else->FD2771 ; <1:0>: phisycal device number27722773 000001 00 ldt_fg2 .DB ; <7>: valid volume (fat volume or cbm disk)2774 ; <6>: if=1->FAT else->CBM (FD only)2775 ; <5>: disk format checked2776 ; <1:0>: disk format (fdc only)27772778 000002 0000 ldt_root .DW ; lba of root dir2779 000004 0000 ldt_fat1 .DW ; lba of fat1 table2780 000006 0000 ldt_fat2 .DW ; lba of fat2 table2781 000008 0000 ldt_cls .DW ; lba of first data cluster2782 00000A 0000 ldt_max .DW ; max usable cluster + 12783 00000C 0000 ldt_rent .DW ; root dir. max. entries2784 00000E 0000 ldt_cent .DW ; max. entries in dir. cluster2785 000010 0000 ldt_eoc .DW ; end of cluster chain marker2786 000012 0000 ldt_free .DW ; count of free cluster's2787 000014 0000 ldt_nxt .DW ; next free cluster2788 000016 0000 ldt_fsiz .DW ; fat table size27892790 000018 00 ldt_csiz .DB ; cluster size (1,2,4,8,16,32,64)2791 000019 00 ldt_cshf .DB ; cluster shift (0,1,2,3,4,5,6)2792 00001A 00 ldt_rsiz .DB ; root dir. size (sector's)2793 00001B 00 ldt_mcls .DB ; mask for clust. module: 00,01,03,07,0F,1F,3F2794 00001C 0000 ldt_cdlp .DW ; current working dir list pointer2795 00001E 0000 ldt_cdcls .DW ; current working dir start cluster2796 000020 00 ldt_cdlvl .DB ; current working dir level count27972798 000021 00 ldt_ptype .DB2799 000022 0000 0000 ldt_pstart .LWORD2800 000026 0000 0000 ldt_psize .LWORD28012802 000022 ldt_fp .EQU ldt_pstart ; fat table buffer long pointer2803 000025 ldt_fbuf .EQU ldt_pstart+3 ; fat table: x-mem base bank/dma buffer28042805 000026 ldt_pbr .EQU ldt_psize ; long pointer to PBR cache buffer2806 000029 ldt_fmt .EQU ldt_psize+32807Tue Jul 17 11:00:18 2018 Page 52808 00002A ESTRUCT LDT2809 00002A LDTSIZE .DS 02810 ;.RELATIVE2811 .ENDS2812 .MNLIST28132814 [00] .ENDIF28152816 F8FFB12817 .LIST on28182819 ; page 0 local var's (declared in bios temp. work area)2820 _P0BTMP: .SECTION page0, ref_only, offset bwrktmp ; DP Tmp. BIOS2821 000094 USB0TMP_START .EQU $2822 000094 00 usbtmp .DB2823 000095 00 nretry .DB2824 000096 00 seccnt .DB2825 000097 00 pktcnt .DB2826 000098 lba .DS 42827 00009C 0000 bufndx .DW2828 00009E bufp LP2829 0000A1 tlp LP2830 0000A4 0000 fatsize .DW2831 0000A6 0000 wseccnt .DW2832 0000A8 0000 freecnt .DW2833 0000AA 0000 nxtfree .DW2834 0000AC 0000 cluster .DW2835 0000AE 0000 maxcls .DW2836 0000B0 00 clssiz .DB2837 0000B1 00 sec256 .DB2838 0000A4 usbbuf .EQU fatsize28392840 .EXTERN PAGE0 ldt428412842 00001E USB0TMP_SIZ .EQU ($-USB0TMP_START)2843 .ENDS28442845 ;---------------------------------------------------------------------------2846 ; code segment -- bank $F82847 ;---------------------------------------------------------------------------28482849 .CODEF82850 F8B2532851 .LONGA off2852 .LONGI off28532854 ; called by ISR after plug flash disk2855 F8B253 usbdskon:2856 .PUBLIC usbdskon28572858 F8B253 A9 08 lda #CB2IFRB2859 F8B255 8D CE FD sta !VIA3+VIAIER ; for now disable ch37x interrupt2860 F8B258 A9 0A lda #102861 F8B25A 85 95 sta nretry ; retries times2862 F8B25C A9 40 lda #$402863 F8B25E 04 43 tsb usb0st ; set bit <6>: plugged in2864 F8B260 24 42 bit usb0chTue Jul 17 11:00:18 2018 Page 62865 F8B262 50 03 bvc ?ch5 ; ch3752866 F8B264 4C F0 B2 jmp ?ch6 ; ch3762867 F8B2672868 ; ch375: first of all send command CMD_DISK_INIT2869 ;2870 F8B267 20 32 B7 ?ch5: jsr delay10ms ; delay2871 F8B26A A9 51 lda #CMD_DISK_INIT ; init usb disk on ch3752872 F8B26C 20 0A B4 jsr cmdwait2873 F8B26F 90 0F bcc ?nxt2874 F8B271 24 43 bit usb0st2875 F8B273 50 74 bvc ?off ; disconnected2876 F8B275 A5 43 lda usb0st2877 F8B277 4A lsr a2878 F8B278 90 68 bcc ?nod ; no flash disk2879 F8B27A C6 95 dec nretry2880 F8B27C D0 E9 bne ?ch5 ; try again2881 F8B27E 80 62 bra ?nod ; no chances2882 F8B280 A9 00 ?nxt: lda #02883 F8B282 85 95 sta nretry2884 F8B284 20 32 B7 ?ch51: jsr delay10ms2885 F8B287 A9 53 lda #CMD_DISK_SIZE ; get total sectors & sector size2886 F8B289 20 0A B4 jsr cmdwait2887 F8B28C 90 0F bcc ?nxt22888 F8B28E 24 43 bit usb0st2889 F8B290 50 57 bvc ?off ; disconnected2890 F8B292 A5 43 lda usb0st2891 F8B294 4A lsr a2892 F8B295 90 4B bcc ?nod ; no flash disk2893 F8B297 C6 95 ?dec: dec nretry2894 F8B299 D0 E9 bne ?ch51 ; try again2895 F8B29B F0 45 beq ?nod ; no chances2896 F8B29D A9 28 ?nxt2: lda #CMD_RD_USB_DATA2897 F8B29F 8D D1 FD sta !usb0cmd ; read 8 bytes2898 F8B2A2 EA nop2899 F8B2A3 EA nop2900 F8B2A4 EA nop2901 F8B2A5 EA nop29022903 ; expect 8 bytes: 32 bit for total sectors...2904 ; followed by 32 bit for sector size29052906 F8B2A6 AD D0 FD lda !usb0dat2907 F8B2A9 C9 08 cmp #$082908 F8B2AB D0 EA bne ?dec ; retry2909 F8B2AD2910 ; data are in big endian, so get in reverse order2911 F8B2AD A2 07 ldx #72912 F8B2AF AD D0 FD ?lp1: lda !usb0dat2913 F8B2B2 95 A4 sta usbbuf,x2914 F8B2B4 CA dex2915 F8B2B5 10 F8 bpl ?lp12916 F8B2B7 A5 A5 lda usbbuf+12917 F8B2B9 C9 02 cmp #$02 ; just 512 bytes per sec.2918 F8B2BB D0 25 bne ?nod ; unsupported sector size2919 F8B2BD A9 0B lda #CMD_PREFIX ; set packet size per sector2920 F8B2BF 8D D1 FD sta !usb0cmd2921 F8B2C2 EA nopTue Jul 17 11:00:18 2018 Page 72922 F8B2C3 EA nop2923 F8B2C4 EA nop2924 F8B2C5 A9 39 lda #PFX_SET_PKT_P_SEC2925 F8B2C7 8D D0 FD sta !usb0dat2926 F8B2CA EA nop2927 F8B2CB A9 08 lda #$08 ; one sector = 8 packets (1 pack = 64 bytes)2928 F8B2CD 8D D0 FD sta !usb0dat2929 F8B2D0 A5 A8 lda usbbuf+42930 F8B2D2 85 1A sta usbsec2931 F8B2D4 A5 A9 lda usbbuf+52932 F8B2D6 85 1B sta usbsec+12933 F8B2D8 A5 AA lda usbbuf+62934 F8B2DA 85 1C sta usbsec+22935 F8B2DC A5 AB lda usbbuf+72936 F8B2DE 85 1D sta usbsec+32937 F8B2E0 80 5F bra ?dev29382939 F8B2E2 A9 20 ?nod: lda #$202940 F8B2E4 04 43 tsb usb0st ; unknow device plugged2941 F8B2E6 4C 76 B3 jmp ?end2942 F8B2E92943 F8B2E9 A9 7F ?off: lda #$7F2944 F8B2EB 14 43 trb usb0st ; device unplugged2945 F8B2ED 4C 76 B3 jmp ?end29462947 ; handle flash disk plug on ch376 chip2948 F8B2F0 20 32 B7 ?ch6: jsr delay10ms ; delay2949 F8B2F3 A9 31 lda #CMD_DISK_MOUNT ; try to mount flash disk2950 F8B2F5 20 0A B4 jsr cmdwait2951 F8B2F8 90 0F bcc ?nxt32952 F8B2FA 24 43 bit usb0st2953 F8B2FC 50 EB bvc ?off ; disconnected2954 F8B2FE A5 43 lda usb0st2955 F8B300 4A lsr a2956 F8B301 90 DF bcc ?nod ; no flash disk2957 F8B303 C6 95 dec nretry2958 F8B305 F0 DB beq ?nod ; no chances2959 F8B307 D0 E7 bne ?ch6 ; try again2960 F8B309 64 95 ?nxt3: stz nretry2961 F8B30B 20 32 B7 ?nxt31: jsr delay10ms ; delay2962 F8B30E A9 3E lda #CMD_DISK_CAPACITY2963 F8B310 20 0A B4 jsr cmdwait2964 F8B313 90 0F bcc ?nxt42965 F8B315 24 43 bit usb0st2966 F8B317 50 D0 bvc ?off ; disconnected2967 F8B319 A5 43 lda usb0st2968 F8B31B 4A lsr a2969 F8B31C 90 C4 bcc ?nod ; no flash disk2970 F8B31E C6 95 ?dec1: dec nretry2971 F8B320 F0 C0 beq ?nod ; no chances2972 F8B322 D0 E7 bne ?nxt31 ; try again2973 F8B324 A9 28 ?nxt4: lda #CMD_RD_USB_DATA2974 F8B326 8D D1 FD sta !usb0cmd ; expect 4 bytes2975 F8B329 EA nop2976 F8B32A EA nop2977 F8B32B EA nop2978 F8B32C EA nopTue Jul 17 11:00:18 2018 Page 82979 F8B32D AD D0 FD lda !usb0dat2980 F8B330 C9 04 cmp #$042981 F8B332 D0 EA bne ?dec1 ; retry2982 F8B334 A0 04 ldy #42983 F8B336 A2 00 ldx #02984 F8B338 AD D0 FD ?lp2: lda !usb0dat2985 F8B33B 95 1A sta usbsec,x2986 F8B33D E8 inx2987 F8B33E 88 dey2988 F8B33F D0 F7 bne ?lp229892990 F8B341 A9 58 ?dev: lda #CMD_DISK_INQUIRY2991 F8B343 20 0A B4 jsr cmdwait2992 F8B346 90 06 bcc ?dev12993 F8B348 24 43 bit usb0st2994 F8B34A 50 9D bvc ?off ; disconnected2995 F8B34C 80 94 bra ?nod2996 F8B34E 20 E4 B3 ?dev1: jsr rddata2997 F8B351 8B phb2998 F8B352 A9 01 lda #^USBBUF2999 F8B354 48 pha3000 F8B355 AB plb3001 F8B356 A2 FF ldx #$FF3002 F8B358 E8 ?dev2: inx3003 F8B359 BD C4 9D lda !.LOW16.USBBUF+8,x3004 F8B35C C9 20 cmp #' ' ; skip beginning blanks3005 F8B35E F0 F8 beq ?dev23006 F8B360 A0 00 ldy #03007 F8B362 BD C4 9D ?dev3: lda !.LOW16.USBBUF+8,x3008 F8B365 99 80 9D sta USB0STR,y3009 F8B368 F0 04 beq ?dev43010 F8B36A E8 inx3011 F8B36B C8 iny3012 F8B36C 80 F4 bra ?dev33013 F8B36E AB ?dev4: plb3014 F8B36F A9 E0 lda #$E03015 F8B371 85 10 sta usbdev3016 F8B3733017 F8B373 20 81 B3 jsr getmbr30183019 F8B376 A9 08 ?end: lda #CB2IFRB3020 F8B378 8D CD FD sta !VIA3+VIAIFR3021 F8B37B A9 88 lda #CB2IFRB+$803022 F8B37D 8D CE FD sta !VIA3+VIAIER ; re-enable ch37x interrupt3023 F8B380 6B rtl30243025 F8B381 getmbr:3026 .EXTERN chkumbr3027 F8B3813028 F8B381 A9 01 lda #13029 F8B383 85 96 sta seccnt3030 F8B385 A9 00 lda #<MBR0USB3031 F8B387 85 9E sta bufp3032 F8B389 A9 94 lda #>MBR0USB3033 F8B38B 85 9F sta bufp+13034 F8B38D A9 01 lda #^MBR0USB3035 F8B38F 85 A0 sta bufp+2Tue Jul 17 11:00:18 2018 Page 93036 F8B391 64 98 stz lba3037 F8B393 64 99 stz lba+13038 F8B395 64 9A stz lba+23039 F8B397 64 9B stz lba+33040 F8B399 20 2D B5 jsr readsec3041 F8B39C B0 35 bcs ?end ; error3042 F8B39E A2 02 ldx #2 ; drive #23043 F8B3A0 20 5F 90 jsr chkumbr ; check mbr3044 F8B3A3 B0 2E bcs ?end ; error3045 F8B3A5 A5 10 lda usbdev3046 F8B3A7 C9 FD cmp #$FD3047 F8B3A9 38 sec3048 F8B3AA D0 27 bne ?end3049 F8B3AC A9 01 lda #13050 F8B3AE 85 96 sta seccnt3051 F8B3B0 A9 00 lda #<PBR0USB3052 F8B3B2 85 9E sta bufp3053 F8B3B4 A9 96 lda #>PBR0USB3054 F8B3B6 85 9F sta bufp+13055 F8B3B8 A9 01 lda #^PBR0USB3056 F8B3BA 85 A0 sta bufp+23057 F8B3BC A5 2A lda usbmbr3058 F8B3BE 85 98 sta lba3059 F8B3C0 A5 2B lda usbmbr+13060 F8B3C2 85 99 sta lba+13061 F8B3C4 A5 2C lda usbmbr+23062 F8B3C6 85 9A sta lba+23063 F8B3C8 64 9B stz lba+3 ; FAT16 only!!3064 F8B3CA 20 2D B5 jsr readsec3065 F8B3CD B0 04 bcs ?end3066 F8B3CF A9 02 lda #$023067 F8B3D1 04 10 tsb usbdev ; pbr ok3068 F8B3D33069 F8B3D3 08 ?end: php3070 F8B3D4 A5 55 lda BiosEnt3071 F8B3D6 4A lsr a3072 F8B3D7 B0 09 bcs ?done ; boot phase3073 F8B3D9 TXT_CR3074 F8B3D9 TXTPRCHAR3075 .MLIST3076 F8B3D9 02 08 cop $083077 .MNLIST3078 F8B3DB 0D .DB $0D3079 .MNLIST3080 F8B3DC 20 47 B6 jsr showusb03081 F8B3DF 20 D1 B6 jsr shusb0fat3082 F8B3E2 28 ?done: plp3083 F8B3E3 60 rts3084 F8B3E43085 ; read block data3086 F8B3E4 rddata:3087 F8B3E4 A9 28 lda #CMD_RD_USB_DATA3088 F8B3E6 8D D1 FD sta !usb0cmd3089 F8B3E9 EA nop3090 F8B3EA EA nop3091 F8B3EB EA nop3092 F8B3EC EA nopTue Jul 17 11:00:18 2018 Page 103093 F8B3ED AD D0 FD lda !usb0dat3094 F8B3F0 F0 17 beq ?end3095 F8B3F2 A8 tay3096 F8B3F3 A2 00 ldx #03097 F8B3F5 84 94 sty usbtmp3098 F8B3F7 AD D0 FD ?lp: lda !usb0dat3099 F8B3FA 9F BC 9D 01 sta >USBBUF,x3100 F8B3FE E8 inx3101 F8B3FF 88 dey3102 F8B400 D0 F5 bne ?lp3103 F8B402 98 tya3104 F8B403 9F BC 9D 01 sta >USBBUF,x3105 F8B407 A5 94 lda usbtmp3106 F8B409 60 ?end: rts31073108 ; send command and wait interrupt3109 F8B40A cmdwait:3110 F8B40A 8D D1 FD sta !usb0cmd3111 F8B40D A9 01 lda #$013112 F8B40F 14 43 trb usb0st ; clear retry flag: bit <0>3113 F8B411 A9 08 ?wi: lda #CB2IFRB3114 F8B413 2C CD FD bit !VIA3+VIAIFR3115 F8B416 F0 F9 beq ?wi ; wait interrupt3116 F8B418 8D CD FD sta !VIA3+VIAIFR ; clear flag3117 F8B41B A9 22 lda #CMD_GET_STATUS3118 F8B41D 8D D1 FD sta !usb0cmd3119 F8B420 EA nop ; 2uS3120 F8B421 EA nop3121 F8B422 EA nop3122 F8B423 EA nop3123 F8B424 AD D0 FD lda !usb0dat ; read interrupt code3124 F8B427 C9 14 cmp #USB_INT_SUCCESS3125 F8B429 F0 48 beq ?ok3126 F8B42B C9 16 cmp #USB_INT_DISCONNECT3127 F8B42D F0 46 beq ?off ; disconnected3128 F8B42F 24 42 bit usb0ch3129 F8B431 50 04 bvc ?chk ; ch375: skip next test3130 F8B433 C9 82 cmp #ERR_DISK_DISCON3131 F8B435 F0 3E beq ?off ; disconnected (ch376 only)3132 F8B437 C9 1F ?chk: cmp #USB_INT_DISK_ERR3133 F8B439 D0 3E bne ?nod ; no flash disk3134 F8B43B 24 42 bit usb0ch3135 F8B43D 50 0D bvc ?ch5 ; ch375 handle in different way3136 F8B43F A9 2B lda #VAR_DISK_STATUS3137 F8B441 20 7B B4 jsr readvar8 ; read internal status ch3763138 F8B444 F0 33 beq ?nod ; unknow device3139 F8B446 C9 03 cmp #DEF_DISK_MOUNTED3140 F8B448 90 2F bcc ?nod ; unknow device3141 F8B44A 80 21 bra ?ret ; set retry flag3142 F8B44C A9 5A ?ch5: lda #CMD_DISK_R_SENSE3143 F8B44E 8D D1 FD sta !usb0cmd3144 F8B451 A9 08 ?wi2: lda #CB2IFRB3145 F8B453 2C CD FD bit !VIA3+VIAIFR3146 F8B456 F0 F9 beq ?wi2 ; wait interrupt3147 F8B458 8D CD FD sta !VIA3+VIAIFR ; clear flag3148 F8B45B3149 F8B45B A9 22 lda #CMD_GET_STATUSTue Jul 17 11:00:18 2018 Page 113150 F8B45D 8D D1 FD sta !usb0cmd3151 F8B460 EA nop ; 2uS3152 F8B461 EA nop3153 F8B462 EA nop3154 F8B463 EA nop3155 F8B464 AD D0 FD lda !usb0dat ; read interrupt code3156 F8B467 85 FD sta $FD31573158 F8B469 C9 14 cmp #USB_INT_SUCCESS3159 F8B46B D0 0C bne ?nod ; unknow device3160 F8B46D A9 01 ?ret: lda #$013161 F8B46F 04 43 tsb usb0st ; set retry flag3162 F8B471 38 sec3163 F8B472 60 rts3164 F8B473 18 ?ok: clc3165 F8B474 60 rts3166 F8B475 A9 40 ?off: lda #$403167 F8B477 14 43 trb usb0st ; clear bit <6>3168 F8B479 38 ?nod: sec3169 F8B47A 60 rts3170 F8B47B3171 ; ch376 specific3172 ; A = var 83173 ; return A = var. value3174 F8B47B readvar8:3175 F8B47B EB xba3176 F8B47C A9 0A lda #CMD_READ_VAR83177 F8B47E 8D D1 FD sta !usb0cmd3178 F8B481 EA nop3179 F8B482 EA nop3180 F8B483 EA nop3181 F8B484 EB xba3182 F8B485 8D D0 FD sta !usb0dat3183 F8B488 EA nop3184 F8B489 EA nop3185 F8B48A EA nop3186 F8B48B EA nop3187 F8B48C AD D0 FD lda !usb0dat3188 F8B48F 60 rts31893190 ; scan fat table of usb #0 device3191 ; first 64K of dma buffer are reserved to cluster read/write3192 ; scan fat table reading 64 sectors at time3193 F8B490 scanufat:3194 F8B490 64 A1 stz tlp ; init dma buffer pointer3195 F8B492 64 A2 stz tlp+13196 F8B494 A9 02 lda #DMABNK3197 F8B496 85 A3 sta tlp+23198 F8B498 AD C0 40 lda !P0LDT+ldt4+ldt_csiz3199 F8B49B 85 B0 sta clssiz3200 F8B49D ACC163201 F8B49D C2 20 rep #PMFLAG3202 .LONGA on3203 .MNLIST3204 F8B49F AD AC 40 lda !P0LDT+ldt4+ldt_fat13205 F8B4A2 85 98 sta lba ; start sector of fat 1 table3206 F8B4A4 64 9A stz lba+2Tue Jul 17 11:00:18 2018 Page 123207 F8B4A6 64 A8 stz freecnt ; count of free clusters3208 F8B4A8 64 AA stz nxtfree ; free next cluster3209 F8B4AA 64 AC stz cluster ; cluster sequence3210 F8B4AC AD B2 40 lda !P0LDT+ldt4+ldt_max3211 F8B4AF 85 AE sta maxcls ; max. cluster number + 13212 F8B4B1 ACC083213 F8B4B1 E2 20 sep #PMFLAG3214 .LONGA off3215 .MNLIST3216 F8B4B3 A2 00 ldx #03217 F8B4B5 AD BE 40 lda !P0LDT+ldt4+ldt_fsiz3218 F8B4B8 85 A4 sta fatsize ; store fat table size3219 F8B4BA D0 01 bne ?st ; less than 256 sectors3220 F8B4BC E8 inx ; fat size = 256 sectors3221 F8B4BD 86 A5 ?st: stx fatsize+13222 F8B4BF 64 A7 stz wseccnt+13223 F8B4C13224 F8B4C1 ACC163225 F8B4C1 C2 20 rep #PMFLAG3226 .LONGA on3227 .MNLIST3228 F8B4C3 A5 A1 ?lp: lda tlp3229 F8B4C5 85 9E sta bufp3230 F8B4C7 A6 A3 ldx tlp+23231 F8B4C9 86 A0 stx bufp+23232 F8B4CB A5 A4 lda fatsize3233 F8B4CD C9 40 00 cmp #643234 F8B4D0 90 03 bcc ?less3235 F8B4D2 A9 40 00 lda #643236 F8B4D5 ?less: ACC083237 F8B4D5 E2 20 sep #PMFLAG3238 .LONGA off3239 .MNLIST3240 F8B4D7 85 96 sta seccnt ; sectors count #3241 F8B4D9 85 A6 sta wseccnt3242 F8B4DB 20 2D B5 jsr readsec ; read fat3243 F8B4DE B0 3E bcs ?err ; some errors3244 F8B4E0 A0 00 ldy #03245 F8B4E2 CPU163246 F8B4E2 C2 30 rep #(PMFLAG.OR.PXFLAG)3247 .LONGA on3248 .LONGI on3249 .MNLIST3250 F8B4E4 A5 A6 lda wseccnt3251 F8B4E6 EB xba3252 F8B4E7 0A asl a ; bytes count #3253 F8B4E8 85 9C sta bufndx3254 F8B4EA A6 AC ldx cluster3255 F8B4EC B7 A1 ?lpf: lda [tlp],y ; scan fat table3256 F8B4EE D0 08 bne ?nxt ; not free3257 F8B4F0 E6 A8 inc freecnt ; update free cluster's count3258 F8B4F2 A5 AA lda nxtfree ; already set?3259 F8B4F4 D0 02 bne ?nxt ; yes3260 F8B4F6 86 AA stx nxtfree ; set first free cluster3261 F8B4F8 E8 ?nxt: inx ; update cluster number3262 F8B4F9 C8 iny3263 F8B4FA C8 inyTue Jul 17 11:00:18 2018 Page 133264 F8B4FB E4 AE cpx maxcls ; end of table?3265 F8B4FD B0 1C bcs ?done ; yes3266 F8B4FF C4 9C cpy bufndx ; end of partial table?3267 F8B501 90 E9 bcc ?lpf ; no3268 F8B503 86 AC stx cluster ; save current cluster number3269 F8B505 INDEX083270 F8B505 E2 10 sep #PXFLAG3271 .LONGI off3272 .MNLIST3273 F8B507 A5 A4 lda fatsize3274 F8B509 38 sec3275 F8B50A E5 A6 sbc wseccnt3276 F8B50C F0 0D beq ?done ; end3277 F8B50E 85 A4 sta fatsize3278 F8B510 18 clc3279 F8B511 A5 98 lda lba3280 F8B513 65 A6 adc wseccnt3281 F8B515 90 AC bcc ?lp3282 F8B517 E6 9A inc lba+23283 F8B519 80 A8 bra ?lp3284 F8B51B ?done: CPU083285 F8B51B E2 30 sep #(PMFLAG.OR.PXFLAG)3286 .LONGA off3287 .LONGI off3288 .MNLIST3289 F8B51D 18 clc3290 F8B51E ?err: ACC163291 F8B51E C2 20 rep #PMFLAG3292 .LONGA on3293 .MNLIST3294 F8B520 A5 A8 lda freecnt3295 F8B522 8D BA 40 sta !P0LDT+ldt4+ldt_free3296 F8B525 A5 AA lda nxtfree3297 F8B527 8D BC 40 sta !P0LDT+ldt4+ldt_nxt3298 F8B52A ACC083299 F8B52A E2 20 sep #PMFLAG3300 .LONGA off3301 .MNLIST3302 F8B52C 60 rts3303 F8B52D3304 ; read sector(s)3305 F8B52D readsec:3306 F8B52D A9 08 lda #CB2IFRB3307 F8B52F 8D CE FD sta !VIA3+VIAIER ; disable ch37x interrupt3308 F8B532 A9 08 lda #CB2IFRB3309 F8B534 8D CD FD sta !VIA3+VIAIFR ; clear flag3310 F8B537 A9 54 lda #CMD_DISK_READ ; start to read sector(s)3311 F8B539 8D D1 FD sta !usb0cmd3312 F8B53C EA nop3313 F8B53D EA nop3314 F8B53E 64 B1 stz sec2563315 F8B540 A5 98 lda lba ; send starting lba3316 F8B542 8D D0 FD sta !usb0dat3317 F8B545 EA nop3318 F8B546 A5 99 lda lba+13319 F8B548 8D D0 FD sta !usb0dat3320 F8B54B EA nopTue Jul 17 11:00:18 2018 Page 143321 F8B54C A5 9A lda lba+23322 F8B54E 8D D0 FD sta !usb0dat3323 F8B551 EA nop3324 F8B552 A5 9B lda lba+33325 F8B554 8D D0 FD sta !usb0dat3326 F8B557 A5 96 lda seccnt ; sector(s) count #3327 F8B559 D0 05 bne ?go3328 F8B55B 3A dec a3329 F8B55C 85 B1 sta sec2563330 F8B55E 85 96 sta seccnt3331 F8B560 8D D0 FD ?go: sta !usb0dat3332 F8B5633333 F8B563 64 9C stz bufndx3334 F8B565 64 9D stz bufndx+13335 F8B567 A9 08 lda #$08 ; 8 packets per sector3336 F8B569 85 97 sta pktcnt3337 F8B56B 80 0B bra ?wi3338 F8B56D3339 F8B56D A9 08 ?sct: lda #$08 ; 8 packets per sector3340 F8B56F 85 97 sta pktcnt3341 F8B571 A9 55 ?pkt: lda #CMD_DISK_RD_GO ; read next packet3342 F8B573 8D D1 FD sta !usb0cmd3343 F8B576 EA nop3344 F8B577 EA nop3345 F8B578 20 30 B6 ?wi: jsr waitint ; wait ch interrupt3346 F8B57B C9 1D cmp #USB_INT_DISK_READ3347 F8B57D D0 38 bne ?done ; finish or error3348 F8B57F A9 28 lda #CMD_RD_USB_DATA3349 F8B581 8D D1 FD sta !usb0cmd ; read a packet (64 bytes)3350 F8B584 EA nop3351 F8B585 EA nop3352 F8B586 EA nop3353 F8B587 EA nop3354 F8B588 AE D0 FD ldx !usb0dat3355 F8B58B E0 40 cpx #$403356 F8B58D D0 65 bne ?err3357 F8B58F3358 F8B58F INDEX163359 F8B58F C2 10 rep #PXFLAG3360 .LONGI on3361 .MNLIST3362 F8B591 A4 9C ldy bufndx ; current buffer index3363 F8B593 AD D0 FD ?rdl: lda !usb0dat ; read & store loop3364 F8B596 97 9E sta [bufp],y3365 F8B598 C8 iny3366 F8B599 CA dex3367 F8B59A D0 F7 bne ?rdl3368 F8B59C 84 9C sty bufndx3369 F8B59E INDEX083370 F8B59E E2 10 sep #PXFLAG3371 .LONGI off3372 .MNLIST3373 F8B5A0 C6 97 dec pktcnt ; more packets to read?3374 F8B5A2 D0 CD bne ?pkt ; yes3375 F8B5A4 ACC16CLC3376 F8B5A4 C2 21 rep #(PMFLAG.OR.PCFLAG)3377 .LONGA onTue Jul 17 11:00:18 2018 Page 153378 .MNLIST3379 F8B5A6 A5 9F lda bufp+13380 F8B5A8 69 02 00 adc #$0002 ; update: add 5123381 F8B5AB 85 9F sta bufp+13382 F8B5AD 64 9C stz bufndx3383 F8B5AF ACC083384 F8B5AF E2 20 sep #PMFLAG3385 .LONGA off3386 .MNLIST3387 F8B5B1 C6 96 dec seccnt3388 F8B5B3 D0 B8 bne ?sct ; next sector if any3389 F8B5B5 80 BA bra ?pkt ; get last interrupt3390 F8B5B73391 F8B5B7 C9 14 ?done: cmp #USB_INT_SUCCESS3392 F8B5B9 D0 24 bne ?tst ; test error condition3393 F8B5BB A5 97 lda pktcnt ; pktcnt & seccnt must be both zero3394 F8B5BD 05 96 ora seccnt3395 F8B5BF D0 3C bne ?sec3396 F8B5C1 24 B1 bit sec2563397 F8B5C3 10 17 bpl ?ok ; finish3398 ; read one more sector3399 F8B5C5 ACC16CLC3400 F8B5C5 C2 21 rep #(PMFLAG.OR.PCFLAG)3401 .LONGA on3402 .MNLIST3403 F8B5C7 A5 98 lda lba3404 F8B5C9 69 FF 00 adc #2553405 F8B5CC 85 98 sta lba3406 F8B5CE A5 9A lda lba+23407 F8B5D0 69 00 00 adc #03408 F8B5D3 85 9A sta lba+23409 F8B5D5 ACC083410 F8B5D5 E2 20 sep #PMFLAG3411 .LONGA off3412 .MNLIST3413 F8B5D7 E6 96 inc seccnt3414 F8B5D9 4C 2D B5 jmp readsec3415 F8B5DC 18 ?ok: clc3416 F8B5DD 80 1F bra ?end3417 F8B5DF C9 16 ?tst: cmp #USB_INT_DISCONNECT34183419 F8B5E1 85 FF sta $ff3420 F8B5E33421 F8B5E3 F0 14 beq ?off ; device unplugged3422 F8B5E5 C9 17 cmp #USB_INT_BUF_OVER3423 F8B5E7 F0 0B beq ?err ; sense disk error3424 F8B5E9 C9 1F cmp #USB_INT_DISK_ERR3425 F8B5EB F0 07 beq ?err3426 F8B5ED 20 09 B6 jsr dskrdy3427 F8B5F0 B0 07 bcs ?off ; unplugged?3428 F8B5F2 80 09 bra ?sec3429 F8B5F4 20 19 B6 ?err: jsr dskerr3430 F8B5F7 80 04 bra ?sec3431 F8B5F9 A9 7F ?off: lda #$7F3432 F8B5FB 14 43 trb usb0st3433 F8B5FD 38 ?sec: sec ; error flag3434 F8B5FE A9 08 ?end: lda #CB2IFRB ; clear CB2 flagTue Jul 17 11:00:18 2018 Page 163435 F8B600 8D CD FD sta !VIA3+VIAIFR3436 F8B603 A9 88 lda #CB2IFRB+$803437 F8B605 8D CE FD sta !VIA3+VIAIER ; re-enable ch37x interrupt3438 F8B608 60 rts34393440 ; test disk ready3441 F8B609 dskrdy:3442 F8B609 A9 59 lda #CMD_DISK_READY3443 F8B60B 8D D1 FD sta !usb0cmd3444 F8B60E EA nop3445 F8B60F 20 30 B6 jsr waitint3446 F8B612 C9 14 cmp #USB_INT_SUCCESS3447 F8B614 18 clc3448 F8B615 F0 01 beq ?end3449 F8B617 38 sec3450 F8B618 60 ?end: rts34513452 ; sensing disk error3453 F8B619 dskerr:3454 F8B619 A9 5A lda #CMD_DISK_R_SENSE3455 F8B61B 8D D1 FD sta !usb0cmd3456 F8B61E EA nop3457 F8B61F 20 30 B6 jsr waitint3458 F8B622 C9 14 cmp #USB_INT_SUCCESS3459 F8B624 F0 02 beq ?get3460 F8B626 38 sec ; error3461 F8B627 60 rts3462 F8B628 20 60 B7 ?get: jsr delay5ms3463 F8B62B 20 E4 B3 jsr rddata ; get error string3464 F8B62E 18 clc3465 F8B62F 60 rts34663467 F8B630 waitint:3468 F8B630 A9 08 lda #CB2IFRB3469 F8B632 2C CD FD bit !VIA3+VIAIFR3470 F8B635 F0 F9 beq waitint ; wait interrupt3471 F8B637 8D CD FD sta !VIA3+VIAIFR ; clear flag3472 F8B63A A9 22 lda #CMD_GET_STATUS3473 F8B63C 8D D1 FD sta !usb0cmd3474 F8B63F EA nop ; 2uS3475 F8B640 EA nop3476 F8B641 EA nop3477 F8B642 EA nop3478 F8B643 AD D0 FD lda !usb0dat ; read interrupt code3479 F8B646 60 rts34803481 F8B647 showusb0:3482 .PUBLIC showusb034833484 F8B647 24 43 bit usb0st3485 F8B649 50 5A bvc ?end ; no device plugged3486 F8B64B 24 10 bit usbdev3487 F8B64D 10 28 bpl ?unkn ; unknow device3488 F8B64F ACC16CLC3489 F8B64F C2 21 rep #(PMFLAG.OR.PCFLAG)3490 .LONGA on3491 .MNLISTTue Jul 17 11:00:18 2018 Page 173492 F8B651 A5 1A lda usbsec3493 F8B653 85 98 sta lba3494 F8B655 A5 1C lda usbsec+23495 F8B657 A2 0B ldx #11 ; divide by 2048 (11 shift)...3496 F8B659 4A ?shr: lsr a ; ... and get rounded size in Mb3497 F8B65A 66 98 ror lba3498 F8B65C CA dex3499 F8B65D D0 FA bne ?shr3500 F8B65F 85 9A sta lba+23501 F8B661 48 pha ; 23502 F8B662 A5 98 lda lba3503 F8B664 48 pha ; 23504 F8B665 ACC083505 F8B665 E2 20 sep #PMFLAG3506 .LONGA off3507 .MNLIST3508 F8B667 A9 01 lda #^USB0STR ; bank that hold device string3509 F8B669 48 pha3510 F8B66A F4 80 9D pea #USB0STR3511 F8B66D 4B phk ; format string3512 F8B66E F4 A6 B6 pea #?fstr3513 F8B671 A9 0B lda #113514 F8B673 48 pha3515 F8B674 BPRINTF3516 F8B674 02 11 cop $113517 .MNLIST3518 F8B676 60 rts3519 F8B6773520 F8B677 ?unkn: SCNPRINT3521 F8B677 02 01 cop $013522 .MNLIST3523 F8B679 75 73 62 20 20 .DB 'usb #0: unknow device (not flash disk).', $0D, $0020 23 30 3A 2020 75 6E 6B 6E6F 77 20 64 6576 69 63 65 2028 6E 6F 74 2066 6C 61 73 6820 64 69 73 6B29 2E 0D 003524 F8B6A5 60 ?end: rts35253526 F8B6A6 ?fstr:3527 ;.DB 'usb #0: flash disk: %-42.41s %,7u Mb', 13, 03528 F8B6A6 75 73 62 20 20 .DB 'usb #0: usb drive E: %-42.41s %,7u Mb', 13, 020 23 30 3A 2020 75 73 62 2064 72 69 76 6520 45 3A 20 2025 2D 34 32 2E34 31 73 20 252C 37 75 20 4D62 0D 0035293530 F8B6D1 shusb0fat:3531 .PUBLIC shusb0fat3532 .EXTERN lusbldtTue Jul 17 11:00:18 2018 Page 1835333534 F8B6D1 24 10 bit usbdev3535 F8B6D3 10 24 bpl ?end ; no disk device plugged3536 F8B6D5 22 05 03 F9 jsl lusbldt3537 F8B6D9 B0 1E bcs ?end3538 F8B6DB 20 90 B4 jsr scanufat3539 F8B6DE ACC16 ; print summary3540 F8B6DE C2 20 rep #PMFLAG3541 .LONGA on3542 .MNLIST3543 F8B6E0 A5 AE lda maxcls3544 F8B6E2 3A dec a3545 F8B6E3 3A dec a3546 F8B6E4 85 AE sta maxcls3547 F8B6E6 ACC083548 F8B6E6 E2 20 sep #PMFLAG3549 .LONGA off3550 .MNLIST3551 F8B6E8 A5 B0 lda clssiz3552 F8B6EA 48 pha3553 F8B6EB D4 A8 pei (freecnt)3554 F8B6ED D4 AE pei (maxcls)3555 F8B6EF 4B phk3556 F8B6F0 F4 FA B6 pea #!?fstr3557 F8B6F3 A9 09 lda #93558 F8B6F5 48 pha3559 F8B6F6 BPRINTF3560 F8B6F6 02 11 cop $113561 .MNLIST3562 F8B6F8 18 clc3563 F8B6F9 60 ?end: rts35643565 F8B6FA 25 2C 68 75 20 ?fstr: .DB '%,hu cluster(s) (free: %,hu, 1 cluster=%bu sector(s)).', 13, 063 6C 75 73 7465 72 28 73 2920 28 66 72 6565 3A 20 25 2C68 75 2C 20 3120 63 6C 75 7374 65 72 3D 2562 75 20 73 6563 74 6F 72 2873 29 29 2E 0D00356635673568 009C40 T10MS .EQU (10 * 1000 * PHI2)3569 F8B732 delay10ms:3570 F8B732 A9 20 lda #$20 ; T2 count PHI2 pulses3571 F8B734 1C 0B FD trb VIA0+VIAACR3572 F8B737 A9 40 lda #<T10MS3573 F8B739 8D 08 FD sta !VIA0+VIAT2CL3574 F8B73C A9 9C lda #>T10MS3575 F8B73E 8D 09 FD sta !VIA0+VIAT2CH3576 F8B741 AD 0D FD ?wl: lda !VIA0+VIAIFR3577 F8B744 89 20 bit #T2IFRB3578 F8B746 F0 F9 beq ?wlTue Jul 17 11:00:18 2018 Page 193579 F8B748 60 rts35803581 000FA0 T01MS .EQU (1000 * PHI2)3582 F8B749 delay1ms:3583 F8B749 A9 20 lda #$20 ; T2 count PHI2 pulses3584 F8B74B 1C 0B FD trb VIA0+VIAACR3585 F8B74E A9 A0 lda #<T01MS3586 F8B750 8D 08 FD sta !VIA0+VIAT2CL3587 F8B753 A9 0F lda #>T01MS3588 F8B755 8D 09 FD sta !VIA0+VIAT2CH3589 F8B758 AD 0D FD ?wl: lda !VIA0+VIAIFR3590 F8B75B 89 20 bit #T2IFRB3591 F8B75D F0 F9 beq ?wl3592 F8B75F 60 rts35933594 004E20 T05MS .EQU (5000 * PHI2)3595 F8B760 delay5ms:3596 F8B760 A9 20 lda #$20 ; T2 count PHI2 pulses3597 F8B762 1C 0B FD trb VIA0+VIAACR3598 F8B765 A9 20 lda #<T05MS3599 F8B767 8D 08 FD sta !VIA0+VIAT2CL3600 F8B76A A9 4E lda #>T05MS3601 F8B76C 8D 09 FD sta !VIA0+VIAT2CH3602 F8B76F AD 0D FD ?wl: lda !VIA0+VIAIFR3603 F8B772 89 20 bit #T2IFRB3604 F8B774 F0 F9 beq ?wl3605 F8B776 60 rts3606 F8B7773607 000080 T32US .EQU (32 * PHI2)36083609 F8B777 delay32us:3610 F8B777 A9 20 lda #$20 ; T2 count PHI2 pulses3611 F8B779 1C 0B FD trb VIA0+VIAACR3612 F8B77C A9 80 lda #T32US3613 F8B77E 8D 08 FD sta !VIA0+VIAT2CL3614 F8B781 9C 09 FD stz !VIA0+VIAT2CH3615 F8B784 AD 0D FD ?55: lda !VIA0+VIAIFR3616 F8B787 89 20 bit #T2IFRB3617 F8B789 F0 F9 beq ?553618 F8B78B 60 rtsLines Assembled : 3528 Errors : 0