SDHCI_driver_for_Kolibrios/sdhc_disk.inc

; Functions for this driver

;×òîáû íå ñòàâèòü ïàðíûå push/pop ïðè âõîäå è âûõîäå èç ôóíêöèè, ìîæíî ïèñàòü òàê:
;proc GET_SDSC_SIZE uses ecx edx
;proc GET_SDSC_SIZE uses ecx edx, _param1, _param2

proc    GET_SDSC_SIZE
        ;  memory capacity = BLOCKNR * BLOCK_LEN   ; shl BSF block_len
        ;  BLOCKNR = (C_SIZE + 1) * MULT           ; shl ecx, BSF (C_SIZE_MULT + 2)
        ;  MULT = 2^(C_SIZE_MULT + 2)
        ;  BLOCK_LEN = 2^LEN_BL_READ
        push    ecx edx
        mov     ecx, dword[esi + SDHCI_CONTROLLER.card_reg_csd + 4] ; C_SIZE_MULT
        shr     ecx, 7; 39 - 32 = 7
        and     ecx, 111b
        add     ecx, 2

        mov     edx, dword[esi + SDHCI_CONTROLLER.card_reg_csd + 6] ; C_SIZE    48/8
        shr     edx, 6 ; 48 + 6
        and     edx, 0xFFF ; data in 12 low bits
        inc     edx
        shl     edx, cl

        movzx   ecx, byte[esi + SDHCI_CONTROLLER.card_reg_csd + 9] ; LEN_BL_READ  72/8
        and     ecx, 0x0f
        shl     edx, cl
        ; get sectors = edx / 512 <- sectorsize for kernel
        shr     edx, BSF 512
        mov     dword[esi + SDHCI_CONTROLLER.sector_count], edx
        mov     dword[esi + SDHCI_CONTROLLER.sector_count + 4], 0
        pop     edx ecx
        ret
endp

proc    GET_SDHC_SIZE
        ; 22 bit  [40:61]
        ; ((C_SIZE + 1) * 512Kbyte ) / sectorsize
        push    ebx
        mov     ebx, dword[esi + SDHCI_CONTROLLER.card_reg_csd + 5]
        and     ebx, not 0xFFC00000  ; îáíóëÿåì ñòàðøèå áèòû
        mov     dword[esi + SDHCI_CONTROLLER.sector_count + 4], 0
        inc     edx ; C_SIZE + 1
        shl     ebx, 10 ; *512Kbyte / sectorsize(512)
        mov     dword[esi + SDHCI_CONTROLLER.sector_count], ebx
        ;bt      dword[esi + SDHCI_CONTROLLER.card_reg_csd + 4], 29 ; read 22 bit C_SIZE
        adc     dword[esi + SDHCI_CONTROLLER.sector_count + 4], 0
        pop     ebx
        ret
endp

proc    GET_SDUC_SIZE
        ; 28 bit   [40:67]  40bit=5*8bit
        ; ((C_SIZE + 1) * 512Kbyte ) / sectorsize
        push    ebx
        mov     ebx, dword[esi + SDHCI_CONTROLLER.card_reg_csd + 5]
        and     ebx, not 0xC0000000  ; îáíóëÿåì ñòàðøèå áèòû
        inc     edx
        mov     dword[esi + SDHCI_CONTROLLER.sector_count], ebx
        shr     ebx, 31-10 ; get hign LBA addr
        mov     dword[esi + SDHCI_CONTROLLER.card_reg_csd + 4], ebx
        shl     dword[esi + SDHCI_CONTROLLER.sector_count], 10
        pop     ebx
        ret
endp

proc    GET_MMC_SIZE
        ; òóò æóòü, â æ*ïó

        ret
endp


proc add_card_disk stdcall, hd_name:dword

        invoke  DiskAdd, sdhci_callbacks, [hd_name], esi, 0
        test    eax, eax
        jz      .disk_add_fail

        invoke  DiskMediaChanged, eax, 1 ; system will scan for partitions on disk
        ret
.disk_add_fail:
        DEBUGF  1, "Failed to add disk\n"
        ret
endp
proc del_card_disk

        ret
endp

; Functions for kernel
; Ïîÿñíåíèå ê ðåàëèçàöèè ÷òåíèÿ/çàïèñè ñåêòîðîâ:
;   Ýòîò äðàéâåð äîëæåí îáðàáàòûâàòü SD êàðòû ðàçíûõ âåðñèé,
; SDIO êàðòû(â òîì ÷èñëå è ñîâìåù¸ííûå) è MMC(eMMC) êàðòû.
;   Âî âñåõ âàðèàíòàõ êàðò ÷òåíèå è çàïèñü ïðîèñõîäèòü ïðè ïîìîùè
; îäíèõ è òåõ æå êîìàíä(17,18,24,25), ïðè ÷¸ì ïîñëåäîâàòåëüíîñòü
; îñòàëüíûõ êîìàíä òàêæå ñõîæà.
;   Ïî ýòîìó ðàçëè÷àòüñÿ áóäóò òîëüêî ìåòîäû ðàáîòû ñ êîíòðîëëåðîì,
; ýòî ëèáî èñïîëüçîâàíèå SDMA èëè ADMA2 èëè, åñëè ýòîãî íåò, òî
; ðàáîòà ÷åðåç ïîðò áóôåðà
proc    sdhci_read stdcall pdata: dword, buffer: dword, startsector: qword, numsectors_ptr:dword
        pusha

        mov     esi, [pdata]
        mov     eax, [esi + SDHCI_CONTROLLER.base_reg_map]
        mov     ebx, dword[startsector]
        mov     edx, [numsectors_ptr]
        mov     edx, [edx]
        mov     edi, [buffer]
        DEBUGF  1,"SDHCI: read sector=%x num=%x \n", ebx, edx
        cmp     edx, 1
        ja      .multiple

        ; send CMD 17
        call    READ_SIGLE_BLOCK

        popa
        mov     eax, 0
        ret
.multiple:

        ; send CMD 18
        call    READ_MULTIPLE_BLOCK

        popa
        mov     eax, 0
        ret
endp
proc    sdhci_write stdcall pdata: dword, buffer: dword, startsector: qword, numsectors_ptr:dword
        pusha
        mov     esi, [pdata]
        mov     eax, [esi + SDHCI_CONTROLLER.base_reg_map]

        mov     ebx, dword[startsector]
        mov     edx, [numsectors_ptr]
        mov     edx, [edx]
        mov     edi, [buffer]
        DEBUGF  1,"SDHCI: write sector=%x num=%x \n", ebx, edx
        cmp     edx, 1
        ja      .multiple

        ; send CMD 24
        call    WRITE_BLOCK

        popa
        mov     eax, 0
        ret
.multiple:

        ; send CMD 25
        call    WRITE_MULTIPLE_BLOCK

        popa
        mov     eax, 0
        ret
endp

struct DISKMEDIAINFO
        Flags      dd ?
        SectorSize dd ?
        Capacity   dq ?
ends

proc   sdhci_querymedia stdcall, pdata, mediainfo
        push    ecx edx
        mov     eax, [mediainfo]
        mov     edx, [pdata]
        mov     [eax + DISKMEDIAINFO.Flags], 0
        mov     [eax + DISKMEDIAINFO.SectorSize], SD_BLOCK_SIZE
        mov     ecx, dword[edx + SDHCI_CONTROLLER.sector_count]
        mov     dword [eax + DISKMEDIAINFO.Capacity], ecx
        mov     ecx, dword[edx + SDHCI_CONTROLLER.sector_count + 4]
        mov     dword [eax + DISKMEDIAINFO.Capacity + 4], ecx
        pop     edx ecx
        xor     eax, eax
        ret
endp

proc    sdhci_close

        ret
endp

align 4
sdhci_callbacks:
    dd  sdhci_callbacks.end - sdhci_callbacks
    dd  0  ;sdhci_close       ; close function   -
    dd  0  ; closemedia function
    dd  sdhci_querymedia  ; +
    dd  sdhci_read        ; -
    dd  sdhci_write       ; -
    dd  0   ; no flush function
    dd  0   ; use default cache size
.end:

sdcard_disk_name:       db 'sdcard00',0
mmccard_disk_name:      db 'MMC00',0