Guest User

Z80 IDE Read-Only Driver

a guest
Oct 19th, 2013
101
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. ;MachinimaOS kernel pre-boot IDE driver
  2. ;    Copyright (C) 2013 Jonathan Strobl ([email protected])
  3.  
  4. ;This program is free software; you can redistribute it and/or modify
  5. ;    it under the terms of the GNU General Public License as published by
  6. ;    the Free Software Foundation; either version 2 of the License, or
  7. ;    (at your option) any later version.
  8. ;
  9. ;    This program is distributed in the hope that it will be useful,
  10. ;    but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. ;    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12. ;    GNU General Public License for more details.
  13. ;
  14. ;    You should have received a copy of the GNU General Public License along
  15. ;    with this program; if not, write to the Free Software Foundation, Inc.,
  16. ;    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  17.  
  18.  
  19.  
  20. ;ASM-Merkmal für IDE, auskommentiert
  21. {
  22. option casemap:none        ;Assembler Merkmal
  23. }
  24.  
  25.  
  26.  
  27. BOOTMEDIUM_KERNEL_DRIVER:
  28.  
  29. ;CONSTANTS
  30.  
  31. ;Supported card type
  32. .CARD_TYPE: EQU 2
  33.  
  34. ;Register addresses
  35. .ALTERNATE_STATUS_REG: EQU 140
  36. .DEVICE_CTRL_REG: EQU 140
  37. .DATA_REG_LOW: EQU 144
  38. .DATA_REG_HIGH: EQU 145
  39. .ERROR_REG: EQU 146
  40. .FEATURES_REG: EQU 146
  41. .SECTOR_COUNT_REG: EQU 148
  42. .SECTOR_NUMBER_REG: EQU 150
  43. .LBA_BITS_0_7_REG: EQU 150
  44. .CYLINDER_LOW_REG: EQU 152
  45. .LBA_BITS_8_15_REG: EQU 152
  46. .CYLINDER_HIGH_REG: EQU 154
  47. .LBA_BITS_16_23_REG: EQU 154
  48. .DEVICE_REG: EQU 156
  49. .LBA_BITS_24_27_REG: EQU 156
  50. .STATUS_REG: EQU 158
  51. .COMMAND_REG: EQU 158
  52.  
  53. ;Bit masks
  54. .BMASK_BUSY: EQU 1000 0000b
  55. .BMASK_DRDY: EQU 0100 0000b
  56. .BMASK_DF: EQU 0010 0000b
  57. .BMASK_DSC: EQU 0001 0000b
  58. .BMASK_DRQ: EQU 0000 1000b
  59. .BMASK_CORR: EQU 0000 0100b
  60. .BMASK_IDX: EQU 0000 0010b
  61. .BMASK_ERR: EQU 0000 0001b
  62.  
  63. ;Commands
  64. .CMD_IDENTIFY_DEVICE: EQU 0ECh
  65. .CMD_READ_SECTOR: EQU 20h
  66. .CMD_SEEK: EQU 70h
  67. .CMD_STANDBY: EQU 0E2h
  68. .CMD_WRITE_SECTOR: EQU 30h
  69.  
  70.  
  71. ;CODE
  72.  
  73. .INIT:
  74.   ;In: C (Slot)
  75.  
  76.   PUSH AF
  77.   PUSH BC
  78.   PUSH DE
  79.   PUSH HL
  80.   PUSH IY
  81.  
  82.   LD IY, _KRNL_out_string_std_RS232
  83.   LD HL, .STR1
  84.   RST 10h
  85.  
  86.   LD A, C
  87.   LD (.drvprop_deviceslot), A
  88.   PUSH BC
  89.     LD IY, _KRNL_getDeviceType
  90.     RST 10h
  91.     LD A, C
  92.     CP A, .CARD_TYPE
  93.     JP Z, .INIT_type_correct
  94.       LD A, 0
  95.       LD (.drvprop_deviceslot), A
  96.     .INIT_type_correct:
  97.   POP BC
  98.  
  99.   LD IY, _KRNL_out_string_std_RS232
  100.   LD HL, .STR2
  101.   RST 10h
  102.  
  103.   ;Identify Device ausführen
  104.   LD C, .CMD_IDENTIFY_DEVICE
  105.   CALL .SEND_COMMAND
  106.  
  107.   LD IY, _KRNL_out_string_std_RS232
  108.   LD HL, .STR3
  109.   RST 10h
  110.  
  111. ;  LD HL, .DBuffer
  112. ;  CALL .READDATA
  113. ;  LD BC, .DBuffer
  114. ;  SCF
  115. ;  CCF
  116. ;  SBC HL, BC
  117. ;  
  118. ;  LD C, H
  119. ;  LD B, L
  120. ;  LD IY, _KRNL_byte_to_str_hex
  121. ;  LD HL, .tempmem
  122. ;  RST 10h
  123. ;  DEC HL
  124. ;  LD IY, _KRNL_byte_to_str_hex
  125. ;  LD C, B
  126. ;  RST 10h
  127. ;  LD IY, _KRNL_out_string_std_RS232
  128. ;  LD HL, .tempmem
  129. ;  RST 10h
  130.  
  131.   LD IY, _KRNL_out_string_std_RS232
  132.   LD HL, .STR4
  133.   RST 10h
  134.  
  135.   POP IY
  136.   POP HL
  137.   POP DE
  138.   POP BC
  139.   POP AF
  140. RET
  141.  
  142. .READ_REGISTER:
  143.   ;In: C (Adr)
  144.   ;Out: D (Data)
  145.  
  146.   PUSH AF
  147.   PUSH BC
  148.  
  149.   LD A, (.drvprop_deviceslot)
  150.   CP A, 0
  151.   JP Z, .READ_REGISTER_uninit
  152.     LD B, C
  153.     LD A, (.drvprop_deviceslot)
  154.     LD C, A
  155.     IN D, (C)
  156.   .READ_REGISTER_uninit:
  157.  
  158.   POP BC
  159.   POP AF
  160. RET
  161.  
  162. .WRITE_REGISTER:
  163.   ;In: C (Adr), D (Data)
  164.  
  165.   PUSH AF
  166.   PUSH BC
  167.  
  168.   LD A, (.drvprop_deviceslot)
  169.   CP A, 0
  170.   JP Z, .WRITE_REGISTER_uninit
  171.     LD B, C
  172.     LD A, (.drvprop_deviceslot)
  173.     LD C, A
  174.     OUT (C), D
  175.   .WRITE_REGISTER_uninit:
  176.  
  177.   POP BC
  178.   POP AF
  179. RET
  180.  
  181. .READDATA:
  182.   ;In: HL (dest adr)
  183.   ;Out: HL (ptr to end of data)
  184.  
  185.   PUSH AF
  186.   PUSH BC
  187.   PUSH DE
  188.  
  189.   LD A, (.drvprop_deviceslot)
  190.   CP A, 0
  191.   JP Z, .READDATA_uninit
  192.     .READDATA_readloop:
  193.       ;Auf weitere Daten prüfen
  194.       .READDATA_check_for_data_loop:
  195.         LD C, .STATUS_REG
  196.         CALL .READ_REGISTER
  197.         LD A, .BMASK_BUSY
  198.         AND A, D
  199.         JP NZ, .READDATA_check_for_data_loop
  200.         LD A, .BMASK_ERR
  201.         AND A, D
  202.         JP NZ, .READDATA_finish
  203.         LD A, .BMASK_DRQ
  204.         AND A, D
  205.         JP Z, .READDATA_finish
  206.      
  207.       ;Daten lesen
  208.      
  209.       ;Lesen vom Low-Register triggert 16-Bit-Read des Controllers,
  210.       ;High-Byte bleibt im Puffer des Controllers
  211.       LD C, .DATA_REG_LOW
  212.       CALL .READ_REGISTER
  213.       LD (HL), D
  214.       INC HL
  215.      
  216.       ;High-Byte aus dem Controller-Puffer lesen
  217.       LD C, .DATA_REG_HIGH
  218.       CALL .READ_REGISTER
  219.       LD (HL), D
  220.       INC HL
  221.     JP .READDATA_readloop
  222.     .READDATA_finish:
  223.   .READDATA_uninit:
  224.  
  225.   POP DE
  226.   POP BC
  227.   POP AF
  228. RET
  229.  
  230. .SEND_COMMAND:
  231.   ;In: C (command)
  232.   PUSH AF
  233.   PUSH BC
  234.   PUSH DE
  235.  
  236.   LD A, (.drvprop_deviceslot)
  237.   CP A, 0
  238.   JP Z, .SEND_COMMAND_uninit
  239.     LD E, C
  240.     ;Auf DRDY warten
  241.     .SEND_COMMAND_DRDY_wait:
  242.       LD C, .STATUS_REG
  243.       CALL .READ_REGISTER
  244.       LD A, .BMASK_BUSY
  245.       AND A, D
  246.       JP NZ, .SEND_COMMAND_DRDY_wait
  247.       LD A, .BMASK_DRDY
  248.       AND A, D
  249.       JP Z, .SEND_COMMAND_DRDY_wait
  250.      
  251.     ;Command schreiben
  252.     LD D, E
  253.     LD C, .COMMAND_REG
  254.     CALL .WRITE_REGISTER
  255.   .SEND_COMMAND_uninit:
  256.  
  257.   POP DE
  258.   POP BC
  259.   POP AF
  260. RET
  261.  
  262.  
  263. ;DATA
  264.  
  265. .drvprop_deviceslot: DB 0
  266. .DBuffer: DS 512, 0
  267. .tempmem: DS 16, 0
  268. .STR1: DB "Driver initializing...", 13, 0
  269. .STR2: DB "Port set.", 13, 0
  270. .STR3: DB "Sent ID command.", 13, 0
  271. .STR4: DB "Done! We did survive that.", 13, 0
Advertisement
Add Comment
Please, Sign In to add comment