c4235b8fff
git-svn-id: https://svn.code.sf.net/p/freedos/svn/kernel/trunk@676 6ac86273-5f31-0410-b378-82cca8765d1b
259 lines
7.2 KiB
NASM
259 lines
7.2 KiB
NASM
;
|
|
; File:
|
|
; floppy.asm
|
|
; Description:
|
|
; floppy disk driver primitives
|
|
;
|
|
; Copyright (c) 1995
|
|
; Pasquale J. Villani
|
|
; All Rights Reserved
|
|
;
|
|
; This file is part of DOS-C.
|
|
;
|
|
; DOS-C is free software; you can redistribute it and/or
|
|
; modify it under the terms of the GNU General Public License
|
|
; as published by the Free Software Foundation; either version
|
|
; 2, or (at your option) any later version.
|
|
;
|
|
; DOS-C is distributed in the hope that it will be useful, but
|
|
; WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See
|
|
; the GNU General Public License for more details.
|
|
;
|
|
; You should have received a copy of the GNU General Public
|
|
; License along with DOS-C; see the file COPYING. If not,
|
|
; write to the Free Software Foundation, 675 Mass Ave,
|
|
; Cambridge, MA 02139, USA.
|
|
;
|
|
; $Id$
|
|
;
|
|
|
|
%ifndef SYS
|
|
%include "../kernel/segs.inc"
|
|
segment HMA_TEXT
|
|
%else
|
|
segment _TEXT class=CODE
|
|
%endif
|
|
;
|
|
;
|
|
; Reset both the diskette and hard disk system
|
|
;
|
|
; BOOL fl_reset(WORD drive)
|
|
;
|
|
; returns TRUE if successful
|
|
;
|
|
|
|
global _fl_reset
|
|
_fl_reset:
|
|
mov bx,sp
|
|
mov ah,0 ; BIOS reset disketter & fixed disk
|
|
mov dl,[bx+2]
|
|
int 13h
|
|
|
|
jc fl_rst1 ; cy==1 is error
|
|
mov ax,1 ; TRUE on success
|
|
ret
|
|
|
|
fl_rst1: xor ax,ax ; FALSE on error
|
|
ret
|
|
|
|
|
|
;
|
|
;
|
|
; Read disk change line status
|
|
;
|
|
; COUNT fl_diskchanged(WORD drive)
|
|
;
|
|
; returns 1 if disk has changed, 0 if not, 0xFF if error
|
|
;
|
|
|
|
global _fl_diskchanged
|
|
_fl_diskchanged:
|
|
push bp ; C entry
|
|
mov bp,sp
|
|
|
|
mov dl,[bp+4] ; get the drive number
|
|
mov ah,16h ; read change status type
|
|
int 13h
|
|
|
|
jc fl_dchanged1 ; cy==1 is error or disk has changed
|
|
xor ax,ax ; disk has not changed
|
|
pop bp ; C exit
|
|
ret
|
|
|
|
fl_dchanged1: cmp ah,6
|
|
jne fl_dc_error
|
|
mov ax,1
|
|
pop bp ; C exit
|
|
ret
|
|
|
|
fl_dc_error: mov ax,0FFh ; 0xFF on error
|
|
pop bp ; C exit
|
|
ret
|
|
|
|
|
|
;
|
|
; Format Sectors
|
|
;
|
|
; COUNT fl_format(WORD drive, WORD head, WORD track, WORD sector, WORD count, BYTE FAR *buffer);
|
|
;
|
|
; Formats one or more tracks, sector should be 0.
|
|
;
|
|
; Returns 0 if successful, error code otherwise.
|
|
global _fl_format
|
|
_fl_format:
|
|
mov ah, 5
|
|
jmp short fl_common
|
|
;
|
|
; Read Sectors
|
|
;
|
|
; COUNT fl_read(WORD drive, WORD head, WORD track, WORD sector, WORD count, BYTE FAR *buffer);
|
|
;
|
|
; Reads one or more sectors.
|
|
;
|
|
; Returns 0 if successful, error code otherwise.
|
|
;
|
|
;
|
|
; Write Sectors
|
|
;
|
|
; COUNT fl_write(WORD drive, WORD head, WORD track, WORD sector, WORD count, BYTE FAR *buffer);
|
|
;
|
|
; Writes one or more sectors.
|
|
;
|
|
; Returns 0 if successful, error code otherwise.
|
|
;
|
|
global _fl_read
|
|
_fl_read:
|
|
mov ah,2 ; cmd READ
|
|
jmp short fl_common
|
|
|
|
global _fl_verify
|
|
_fl_verify:
|
|
mov ah,4 ; cmd verify
|
|
jmp short fl_common
|
|
|
|
global _fl_write
|
|
_fl_write:
|
|
mov ah,3 ; cmd WRITE
|
|
|
|
fl_common:
|
|
push bp ; C entry
|
|
mov bp,sp
|
|
|
|
mov dl,[bp+4] ; get the drive (if or'ed 80h its
|
|
; hard drive.
|
|
mov dh,[bp+6] ; get the head number
|
|
mov bx,[bp+8] ; cylinder number (lo only if hard)
|
|
|
|
mov al,1 ; this should be an error code
|
|
cmp bx,3ffh ; this code can't write above 3ff=1023
|
|
ja fl_error
|
|
|
|
mov ch,bl ; low 8 bits of cyl number
|
|
|
|
xor bl,bl ; extract bits 8+9 to cl
|
|
shr bx,1
|
|
shr bx,1
|
|
|
|
|
|
mov cl,[bp+0Ah] ; sector number
|
|
and cl,03fh ; mask to sector field bits 5-0
|
|
or cl,bl ; or in bits 7-6
|
|
|
|
mov al,[bp+0Ch] ; count to read/write
|
|
les bx,[bp+0Eh] ; Load 32 bit buffer ptr
|
|
|
|
int 13h ; write sectors from mem es:bx
|
|
|
|
mov al,ah
|
|
jc fl_wr1 ; error, return error code
|
|
xor al,al ; Zero transfer count
|
|
fl_wr1:
|
|
fl_error:
|
|
xor ah,ah ; force into < 255 count
|
|
pop bp
|
|
ret
|
|
|
|
|
|
; COUNT fl_lba_ReadWrite(BYTE drive, UWORD mode, VOID FAR *dap_p)
|
|
;
|
|
; Returns 0 if successful, error code otherwise.
|
|
;
|
|
global _fl_lba_ReadWrite
|
|
_fl_lba_ReadWrite:
|
|
push bp ; C entry
|
|
mov bp,sp
|
|
|
|
push ds
|
|
push si ; wasn't in kernel < KE2024Bo6!!
|
|
|
|
mov dl,[bp+4] ; get the drive (if or'ed 80h its
|
|
mov ax,[bp+6] ; get the command
|
|
lds si,[bp+8] ; get far dap pointer
|
|
int 13h ; read from/write to drive
|
|
|
|
mov al,ah ; place any error code into al
|
|
|
|
xor ah,ah ; zero out ah
|
|
|
|
pop si
|
|
pop ds
|
|
|
|
pop bp
|
|
ret
|
|
|
|
global _fl_readkey
|
|
_fl_readkey: xor ah, ah
|
|
int 16h
|
|
ret
|
|
|
|
global _fl_setdisktype
|
|
_fl_setdisktype:
|
|
push bp
|
|
mov bp, sp
|
|
mov dl,[bp+4] ; drive number
|
|
mov al,[bp+6] ; disk type
|
|
mov ah,17h
|
|
int 13h
|
|
mov al,ah
|
|
xor ah,ah
|
|
pop bp
|
|
ret
|
|
|
|
global _fl_setmediatype
|
|
_fl_setmediatype:
|
|
push bp
|
|
mov bp, sp
|
|
push di
|
|
|
|
mov dl,[bp+4] ; drive number
|
|
mov bx,[bp+6] ; number of tracks
|
|
dec bx ; should be highest track
|
|
mov ch,bl ; low 8 bits of cyl number
|
|
|
|
xor bl,bl ; extract bits 8+9 to cl
|
|
shr bx,1
|
|
shr bx,1
|
|
|
|
mov cl,[bp+8] ; sectors/track
|
|
and cl,03fh ; mask to sector field bits 5-0
|
|
or cl,bl ; or in bits 7-6
|
|
|
|
mov ah,18h
|
|
int 13h
|
|
mov al,ah
|
|
mov ah,0
|
|
jc skipint1e
|
|
mov bx,es
|
|
xor dx,dx
|
|
mov es,dx
|
|
cli
|
|
mov [es:0x1e*4 ], di
|
|
mov [es:0x1e*4+2], bx ; set int 0x1e table to es:di (bx:di)
|
|
sti
|
|
skipint1e:
|
|
pop di
|
|
pop bp
|
|
ret
|
|
|