Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- ;MachinimaOS kernel pre-boot IDE driver
- ; Copyright (C) 2013 Jonathan Strobl ([email protected])
- ;This program 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 of the License, or
- ; (at your option) any later version.
- ;
- ; This program 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 this program; if not, write to the Free Software Foundation, Inc.,
- ; 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
- ;ASM-Merkmal für IDE, auskommentiert
- {
- option casemap:none ;Assembler Merkmal
- }
- BOOTMEDIUM_KERNEL_DRIVER:
- ;CONSTANTS
- ;Supported card type
- .CARD_TYPE: EQU 2
- ;Register addresses
- .ALTERNATE_STATUS_REG: EQU 140
- .DEVICE_CTRL_REG: EQU 140
- .DATA_REG_LOW: EQU 144
- .DATA_REG_HIGH: EQU 145
- .ERROR_REG: EQU 146
- .FEATURES_REG: EQU 146
- .SECTOR_COUNT_REG: EQU 148
- .SECTOR_NUMBER_REG: EQU 150
- .LBA_BITS_0_7_REG: EQU 150
- .CYLINDER_LOW_REG: EQU 152
- .LBA_BITS_8_15_REG: EQU 152
- .CYLINDER_HIGH_REG: EQU 154
- .LBA_BITS_16_23_REG: EQU 154
- .DEVICE_REG: EQU 156
- .LBA_BITS_24_27_REG: EQU 156
- .STATUS_REG: EQU 158
- .COMMAND_REG: EQU 158
- ;Bit masks
- .BMASK_BUSY: EQU 1000 0000b
- .BMASK_DRDY: EQU 0100 0000b
- .BMASK_DF: EQU 0010 0000b
- .BMASK_DSC: EQU 0001 0000b
- .BMASK_DRQ: EQU 0000 1000b
- .BMASK_CORR: EQU 0000 0100b
- .BMASK_IDX: EQU 0000 0010b
- .BMASK_ERR: EQU 0000 0001b
- ;Commands
- .CMD_IDENTIFY_DEVICE: EQU 0ECh
- .CMD_READ_SECTOR: EQU 20h
- .CMD_SEEK: EQU 70h
- .CMD_STANDBY: EQU 0E2h
- .CMD_WRITE_SECTOR: EQU 30h
- ;CODE
- .INIT:
- ;In: C (Slot)
- PUSH AF
- PUSH BC
- PUSH DE
- PUSH HL
- PUSH IY
- LD IY, _KRNL_out_string_std_RS232
- LD HL, .STR1
- RST 10h
- LD A, C
- LD (.drvprop_deviceslot), A
- PUSH BC
- LD IY, _KRNL_getDeviceType
- RST 10h
- LD A, C
- CP A, .CARD_TYPE
- JP Z, .INIT_type_correct
- LD A, 0
- LD (.drvprop_deviceslot), A
- .INIT_type_correct:
- POP BC
- LD IY, _KRNL_out_string_std_RS232
- LD HL, .STR2
- RST 10h
- ;Identify Device ausführen
- LD C, .CMD_IDENTIFY_DEVICE
- CALL .SEND_COMMAND
- LD IY, _KRNL_out_string_std_RS232
- LD HL, .STR3
- RST 10h
- ; LD HL, .DBuffer
- ; CALL .READDATA
- ; LD BC, .DBuffer
- ; SCF
- ; CCF
- ; SBC HL, BC
- ;
- ; LD C, H
- ; LD B, L
- ; LD IY, _KRNL_byte_to_str_hex
- ; LD HL, .tempmem
- ; RST 10h
- ; DEC HL
- ; LD IY, _KRNL_byte_to_str_hex
- ; LD C, B
- ; RST 10h
- ; LD IY, _KRNL_out_string_std_RS232
- ; LD HL, .tempmem
- ; RST 10h
- LD IY, _KRNL_out_string_std_RS232
- LD HL, .STR4
- RST 10h
- POP IY
- POP HL
- POP DE
- POP BC
- POP AF
- RET
- .READ_REGISTER:
- ;In: C (Adr)
- ;Out: D (Data)
- PUSH AF
- PUSH BC
- LD A, (.drvprop_deviceslot)
- CP A, 0
- JP Z, .READ_REGISTER_uninit
- LD B, C
- LD A, (.drvprop_deviceslot)
- LD C, A
- IN D, (C)
- .READ_REGISTER_uninit:
- POP BC
- POP AF
- RET
- .WRITE_REGISTER:
- ;In: C (Adr), D (Data)
- PUSH AF
- PUSH BC
- LD A, (.drvprop_deviceslot)
- CP A, 0
- JP Z, .WRITE_REGISTER_uninit
- LD B, C
- LD A, (.drvprop_deviceslot)
- LD C, A
- OUT (C), D
- .WRITE_REGISTER_uninit:
- POP BC
- POP AF
- RET
- .READDATA:
- ;In: HL (dest adr)
- ;Out: HL (ptr to end of data)
- PUSH AF
- PUSH BC
- PUSH DE
- LD A, (.drvprop_deviceslot)
- CP A, 0
- JP Z, .READDATA_uninit
- .READDATA_readloop:
- ;Auf weitere Daten prüfen
- .READDATA_check_for_data_loop:
- LD C, .STATUS_REG
- CALL .READ_REGISTER
- LD A, .BMASK_BUSY
- AND A, D
- JP NZ, .READDATA_check_for_data_loop
- LD A, .BMASK_ERR
- AND A, D
- JP NZ, .READDATA_finish
- LD A, .BMASK_DRQ
- AND A, D
- JP Z, .READDATA_finish
- ;Daten lesen
- ;Lesen vom Low-Register triggert 16-Bit-Read des Controllers,
- ;High-Byte bleibt im Puffer des Controllers
- LD C, .DATA_REG_LOW
- CALL .READ_REGISTER
- LD (HL), D
- INC HL
- ;High-Byte aus dem Controller-Puffer lesen
- LD C, .DATA_REG_HIGH
- CALL .READ_REGISTER
- LD (HL), D
- INC HL
- JP .READDATA_readloop
- .READDATA_finish:
- .READDATA_uninit:
- POP DE
- POP BC
- POP AF
- RET
- .SEND_COMMAND:
- ;In: C (command)
- PUSH AF
- PUSH BC
- PUSH DE
- LD A, (.drvprop_deviceslot)
- CP A, 0
- JP Z, .SEND_COMMAND_uninit
- LD E, C
- ;Auf DRDY warten
- .SEND_COMMAND_DRDY_wait:
- LD C, .STATUS_REG
- CALL .READ_REGISTER
- LD A, .BMASK_BUSY
- AND A, D
- JP NZ, .SEND_COMMAND_DRDY_wait
- LD A, .BMASK_DRDY
- AND A, D
- JP Z, .SEND_COMMAND_DRDY_wait
- ;Command schreiben
- LD D, E
- LD C, .COMMAND_REG
- CALL .WRITE_REGISTER
- .SEND_COMMAND_uninit:
- POP DE
- POP BC
- POP AF
- RET
- ;DATA
- .drvprop_deviceslot: DB 0
- .DBuffer: DS 512, 0
- .tempmem: DS 16, 0
- .STR1: DB "Driver initializing...", 13, 0
- .STR2: DB "Port set.", 13, 0
- .STR3: DB "Sent ID command.", 13, 0
- .STR4: DB "Done! We did survive that.", 13, 0
Advertisement
Add Comment
Please, Sign In to add comment