StupidOS/kernel/dev/at/floppy.inc

104 lines
1.4 KiB
PHP

;; File: floppy.inc
;;
;; Usefull links:
;; - <https://wiki.osdev.org/Floppy_Disk_Controller>
;; - <datasheet at http://www.osdever.net/documents/82077AA_FloppyControllerDatasheet.pdf>
FLOPPY_BDEV_MAJOR = 0
FLOPPY_CDEV_MAJOR = 9
FLOPPY_NONE = 0x0
FLOPPY_360KB = 0x1
FLOPPY_1_2MB = 0x2
FLOPPY_720KB = 0x3
FLOPPY_1_44MB = 0x4
FLOPPY_2_88MB = 0x5
FLOPPY_MAX = 2
struc Floppy {
.active db ?
}
floppy_probe:
mov al, CMOS_FLOPPY_TYPE
out CMOS_COMMAND, al
in al, CMOS_DATA
mov ah, al
and al, 0x0F
and ah, 0xF0
or al, al
jz @f
push ax
mov esi, szMsgFloppy1Found
call klog
pop ax
@@:
or ah, ah
jz @f
mov esi, szMsgFloppy0Found
call klog
@@:
ret
floppy_init:
call floppy_probe
ret
floppy_strategy:
ret
floppy_open:
push ebp
mov ebp, esp
mov eax, [ebp+4]
cmp al, FLOPPY_MAX
jb @f
mov eax, ENXIO
jmp .end
@@:
xor eax, eax
.end:
pop ebp
ret
floppy_close:
xor eax, eax
ret
floppy_ioctl:
mov eax, ENODEV
ret
floppy_dump:
ret
floppy_psize:
ret
floppy_irq:
pusha
mov esi, szMsgFloppyIRQ
popa
iret
szMsgFloppyIRQ db 'Floppy: IRQ', 0
floppy_device:
db 'floppy', 0, 0
dd floppy_init
db FLOPPY_BDEV_MAJOR
db FLOPPY_CDEV_MAJOR
floppy_bdevsw:
dd floppy_open
dd floppy_strategy
dd floppy_ioctl
dd floppy_close
dd floppy_dump
dd floppy_psize
szMsgFloppy0Found db "floppy: fd0 found", 0
szMsgFloppy1Found db "floppy: fd1 found", 0