[3ae31e9] | 1 | ********************************************************************************
|
---|
| 2 | * *
|
---|
| 3 | * mtbios.s -- Multi-Tasking BIOS for the Buchla 700 *
|
---|
| 4 | * -------- ------------------------------------- *
|
---|
| 5 | * *
|
---|
| 6 | * See VM1,VM2 and VDATE for version and date *
|
---|
| 7 | * Written by D.N. Lynx Crowe *
|
---|
| 8 | * *
|
---|
| 9 | * Very loosely based on ideas from: *
|
---|
| 10 | * *
|
---|
| 11 | * "Atari ST Internals", by Abacus Software, *
|
---|
| 12 | * "A Hitchhiker's Guide to the BIOS", by Atari, *
|
---|
| 13 | * "DOS Technical Reference", by IBM, *
|
---|
| 14 | * "DOS/360", by IBM, *
|
---|
| 15 | * "CP/M (tm)" , by Digital Research, *
|
---|
| 16 | * "TIPMX (tm)", by Texas Instruments, and, of course, *
|
---|
| 17 | * "Unix (tm)", by AT&T, et al. *
|
---|
| 18 | * *
|
---|
| 19 | * After all, why re-invent the wheel? *
|
---|
| 20 | * *
|
---|
| 21 | * Some of the functions act the same as Atari's, but most are different, *
|
---|
| 22 | * and our I/O configuration is much different, so BEWARE! Make no *
|
---|
| 23 | * assumptions, and read the documentation and comments very carefully. *
|
---|
| 24 | * *
|
---|
| 25 | * Especially watch out for the extended BIOS functions. Most of them *
|
---|
| 26 | * are nothing at all like the Atari / GEMDOS extended bios functions, *
|
---|
| 27 | * and even the ones that are similar have different numbers. *
|
---|
| 28 | * *
|
---|
| 29 | * Note also that this version does multi-tasking and handles interrupts, *
|
---|
| 30 | * etc. quite differently from the Atari or the non-multi-tasking version. *
|
---|
| 31 | * *
|
---|
| 32 | * WARNING: to conserve PROM space we use xxx(a5) with a5 EQ 0 to refer to *
|
---|
| 33 | * some of the system RAM, notably in the floppy driver. This means that *
|
---|
| 34 | * all system RAM must reside in the first 64K of RAM ($00000000..$0000FFFF). *
|
---|
| 35 | * Note that this makes debugging a real pain, as we can't relocate a copy of *
|
---|
| 36 | * the bios RAM out of reach of the RAM clear done by the bios at reset. *
|
---|
| 37 | ********************************************************************************
|
---|
| 38 | *
|
---|
| 39 | * Version and date
|
---|
| 40 | * ----------------
|
---|
| 41 | VM1 .equ 20 * First part of version number
|
---|
| 42 | VM2 .equ 1 * Second part of version number
|
---|
| 43 | VDATE .equ $19880417 * Version date
|
---|
| 44 | *
|
---|
| 45 | *************************************************************************
|
---|
| 46 | *
|
---|
| 47 | .text
|
---|
| 48 | *
|
---|
| 49 | .page
|
---|
| 50 | *
|
---|
| 51 | * Error codes:
|
---|
| 52 | * ------------
|
---|
| 53 | ERR01 .equ -1 * All purpose error
|
---|
| 54 | ERR02 .equ -2 * Drive not ready
|
---|
| 55 | ERR03 .equ -3 * Unknown command
|
---|
| 56 | ERR04 .equ -4 * CRC Error
|
---|
| 57 | ERR05 .equ -5 * Invalid request
|
---|
| 58 | ERR06 .equ -6 * Seek error
|
---|
| 59 | ERR07 .equ -7 * Unknown media
|
---|
| 60 | ERR08 .equ -8 * Sector not found
|
---|
| 61 | ERR09 .equ -9 * End of media
|
---|
| 62 | ERR10 .equ -10 * Write fault
|
---|
| 63 | ERR11 .equ -11 * Read fault
|
---|
| 64 | ERR12 .equ -12 * General mishap
|
---|
| 65 | ERR13 .equ -13 * Write protected
|
---|
| 66 | ERR14 .equ -14 * Media changed
|
---|
| 67 | ERR15 .equ -15 * Unknown device
|
---|
| 68 | ERR16 .equ -16 * Bad sectors
|
---|
| 69 | ERR17 .equ -17 * Wrong disk
|
---|
| 70 | *
|
---|
| 71 | .page
|
---|
| 72 | *
|
---|
| 73 | * External definitions:
|
---|
| 74 | * ---------------------
|
---|
| 75 | *
|
---|
| 76 | .xdef __MTInt3 * Interrupt level 3 SLIH (panel)
|
---|
| 77 | .xdef __MTInt4 * Interrupt level 4 SLIH (timer)
|
---|
| 78 | .xdef __MTInt5 * Interrupt level 5 SLIH (serial I/O)
|
---|
| 79 | *
|
---|
| 80 | .xdef _MT_ITT * Interrupt TCB pointer table
|
---|
| 81 | .xdef mtdefs * Multi-Tasker interface block
|
---|
| 82 | *
|
---|
| 83 | .page
|
---|
| 84 | *
|
---|
| 85 | .xdef basepage * Pseudo base page for romp
|
---|
| 86 | .xdef resvec3 * Reserved vector for the FPU handler
|
---|
| 87 | .xdef resvec4 * Reserved vector for the VSDD handler
|
---|
| 88 | .xdef _rsflag * Register save area overflow flag
|
---|
| 89 | .xdef _hdvini * Disk init
|
---|
| 90 | .xdef _wzcrsh * ROMP crash flag
|
---|
| 91 | .xdef _crshvc * Crash vector
|
---|
| 92 | .xdef _crshsr * Crash SR
|
---|
| 93 | .xdef _crshpc * Crash PC
|
---|
| 94 | .xdef _crshsp * Crash SP
|
---|
| 95 | .xdef _crshus * Crash USP
|
---|
| 96 | .xdef _crshrg * Crash SP registers
|
---|
| 97 | .xdef _crshst * Crash top of stack
|
---|
| 98 | .xdef _hz_1k * 1 Khz clock counter
|
---|
| 99 | .xdef _hz_200 * 200 Hz clock counter
|
---|
| 100 | .xdef frclock * frame clock
|
---|
| 101 | .xdef seekrate * disk seek rate
|
---|
| 102 | .xdef retrycnt * disk retry count
|
---|
| 103 | .xdef cdev * current disk device
|
---|
| 104 | .xdef ctrack * current track
|
---|
| 105 | .xdef csect * current sector
|
---|
| 106 | .xdef cside * current side
|
---|
| 107 | .xdef ccount * current sector count
|
---|
| 108 | .xdef cdma * current I/O address
|
---|
| 109 | .xdef edma * final I/O address
|
---|
| 110 | .xdef tmpdma * temporary I/O address
|
---|
| 111 | .xdef rseed * random number seed
|
---|
| 112 | .xdef savptr * register save area pointer
|
---|
| 113 | .xdef biostop * top of the bios
|
---|
| 114 | *
|
---|
| 115 | .page
|
---|
| 116 | *
|
---|
| 117 | * External references:
|
---|
| 118 | * --------------------
|
---|
| 119 | *
|
---|
| 120 | .xref nullfpu * null FPU Third Level Interrupt Handler
|
---|
| 121 | *
|
---|
| 122 | .xref MTStruct * Multi-Tasker data structure
|
---|
| 123 | *
|
---|
| 124 | .xref _sr1_ior * Serial port 1 iorec
|
---|
| 125 | .xref _sr2_ior * Serial port 2 iorec
|
---|
| 126 | .xref _mc1_ior * MIDI port 1 iorec
|
---|
| 127 | .xref _mc2_ior * MIDI port 2 iorec
|
---|
| 128 | *
|
---|
| 129 | .xref MT_ITCB1 * Interrupt level 1 TCB
|
---|
| 130 | .xref MT_ITCB2 * Interrupt level 2 TCB
|
---|
| 131 | .xref MT_ITCB3 * Interrupt level 3 TCB
|
---|
| 132 | .xref MT_ITCB4 * Interrupt level 4 TCB
|
---|
| 133 | .xref MT_ITCB5 * Interrupt level 5 TCB
|
---|
| 134 | *
|
---|
| 135 | .xref MT_ISEM1 * Interrupt level 1 semaphore
|
---|
| 136 | .xref MT_ISEM2 * Interrupt level 2 semaphore
|
---|
| 137 | .xref MT_ISEM3 * Interrupt level 3 semaphore
|
---|
| 138 | .xref MT_ISEM4 * Interrupt level 4 semaphore
|
---|
| 139 | .xref MT_ISEM5 * Interrupt level 5 semaphore
|
---|
| 140 | *
|
---|
| 141 | .xref _SemTick * Timer semaphore (1MS ticks)
|
---|
| 142 | .xref _SemFCLK * Score frame clock semaphore
|
---|
| 143 | .xref _SemAPI * Analog FIFO not-empty semaphore
|
---|
| 144 | .xref _SemQuit * Terminate semaphore (for ROMP)
|
---|
| 145 | *
|
---|
| 146 | .xref _MSG_Vid * Video message queue
|
---|
| 147 | *
|
---|
| 148 | .xref start_ * ROMP C startup entry point
|
---|
| 149 | .xref __MT_Swp * MTSwap() TRAP handler
|
---|
| 150 | .xref __MT_Nxt * MTNext() TRAP handler
|
---|
| 151 | .xref SM_Sig * SM_Sig()
|
---|
| 152 | .xref SM_Wait * SM_Wait()
|
---|
| 153 | *
|
---|
| 154 | .xref MTInt1 * Interrupt level 1 FLIH (VSDD)
|
---|
| 155 | .xref MTInt2 * Interrupt level 2 FLIH (FPU)
|
---|
| 156 | .xref MTInt3 * Interrupt level 3 FLIH (panel)
|
---|
| 157 | .xref MTInt4 * Interrupt level 4 FLIH (timer)
|
---|
| 158 | .xref MTInt5 * Interrupt level 5 FLIH (serial I/O)
|
---|
| 159 | *
|
---|
| 160 | .xref _errno * Start of ROMP bss space
|
---|
| 161 | *
|
---|
| 162 | .page
|
---|
| 163 | *
|
---|
| 164 | * Some critical equates:
|
---|
| 165 | * ----------------------
|
---|
| 166 | * Interrupt masks
|
---|
| 167 | * ---------------
|
---|
| 168 | IPL3 .equ $0300 * IPL 3 value for sr
|
---|
| 169 | IPL7 .equ $0700 * IPL 7 value for sr
|
---|
| 170 | *
|
---|
| 171 | * Memory allocation
|
---|
| 172 | * -----------------
|
---|
| 173 | TPA .equ $010000 * Put TPA 64K up from the bottom
|
---|
| 174 | *
|
---|
| 175 | SSTACK .equ TPA * Put system stack just below TPA
|
---|
| 176 | *
|
---|
| 177 | p_bbase .equ $0018 * Basepage offset to bss base
|
---|
| 178 | p_blen .equ $001C * Basepage offset to bss length
|
---|
| 179 | *
|
---|
| 180 | * It's magic ...
|
---|
| 181 | * --------------
|
---|
| 182 | FMAGIC .equ $87654321 * Magic for formatting
|
---|
| 183 | RETRYIT .equ $00010000 * Magic for re-try from criterr
|
---|
| 184 | RSMAGIC .equ $78563412 * Magic for register save area OK
|
---|
| 185 | *
|
---|
| 186 | * Miscellaneous constants
|
---|
| 187 | * -----------------------
|
---|
| 188 | FSTIME .equ $3FFF * VSDD FRAMESTOP update delay count
|
---|
| 189 | FCMAX .equ $00FFFFFF * Maximum frame counter value (24 bits)
|
---|
| 190 | *
|
---|
| 191 | FL_SKR .equ $02 * Seek rate (WD1772, 5Ms/step)
|
---|
| 192 | *
|
---|
| 193 | RTCHI .equ $1F * RTC counter MS byte
|
---|
| 194 | RTCLO .equ $3F * RTC counter LS byte
|
---|
| 195 | *
|
---|
| 196 | .page
|
---|
| 197 | *
|
---|
| 198 | * TCB offsets
|
---|
| 199 | * -----------
|
---|
| 200 | NEXT .equ 0 * LONG - next TCB in queue
|
---|
| 201 | FWD .equ NEXT+4 * LONG - next TCB in chain
|
---|
| 202 | TID .equ FWD+4 * WORD - task ID
|
---|
| 203 | PRI .equ TID+2 * WORD - task priority
|
---|
| 204 | SLICE .equ PRI+2 * LONG - slice time limit
|
---|
| 205 | REGS .equ SLICE+4 * LONG[16] - registers
|
---|
| 206 | TCB_SP .equ REGS+64 * LONG - stack pointer
|
---|
| 207 | TCB_PC .equ TCB_SP+4 * LONG - program counter
|
---|
| 208 | TCB_SR .equ TCB_PC+4 * WORD - status register
|
---|
| 209 | FLAGS .equ TCB_SR+2 * WORD - task flags
|
---|
| 210 | TOS .equ FLAGS+2 * LONG - top of stack
|
---|
| 211 | *
|
---|
| 212 | TCB_A6 .equ REGS+56 * LONG - task a6 image
|
---|
| 213 | TCB_A7 .equ REGS+60 * LONG - task a7 image
|
---|
| 214 | *
|
---|
| 215 | TCBLEN .equ TOS+4 * length of TCB (bytes)
|
---|
| 216 | *
|
---|
| 217 | * TCB flags
|
---|
| 218 | * ---------
|
---|
| 219 | MTF_RDY .equ $0001 * 'ready' bit
|
---|
| 220 | NOT_RDY .equ $FFFE * 'ready' bit complement
|
---|
| 221 | MTF_SWT .equ $0002 * 'wait' bit
|
---|
| 222 | NOT_SWT .equ $FFFD * 'wait' bit complement
|
---|
| 223 | MTF_RUN .equ $0004 * 'run' bit
|
---|
| 224 | NOT_RUN .equ $FFFB * 'run' bit complement
|
---|
| 225 | MTF_STP .equ $0008 * 'stop' bit
|
---|
| 226 | NOT_STP .equ $FFF7 * 'stop' bit complement
|
---|
| 227 | *
|
---|
| 228 | .page
|
---|
| 229 | *
|
---|
| 230 | * CFR0 Baud Rates:
|
---|
| 231 | * ----------------
|
---|
| 232 | BR_300 .equ $04
|
---|
| 233 | BR_600 .equ $05
|
---|
| 234 | BR_1200 .equ $06
|
---|
| 235 | BR_1800 .equ $07
|
---|
| 236 | BR_2400 .equ $08
|
---|
| 237 | BR_3600 .equ $09
|
---|
| 238 | BR_4800 .equ $0A
|
---|
| 239 | BR_7200 .equ $0B
|
---|
| 240 | BR_9600 .equ $0C
|
---|
| 241 | BR_19K2 .equ $0D
|
---|
| 242 | BR_EXT .equ $0F
|
---|
| 243 | *
|
---|
| 244 | * CFR0 Stop bits (includes TBR select bit):
|
---|
| 245 | * -----------------------------------------
|
---|
| 246 | NSB_1 .equ $40
|
---|
| 247 | NSB_2 .equ $60
|
---|
| 248 | *
|
---|
| 249 | * CFR1 Number of Data Bits (includes MSB):
|
---|
| 250 | * ----------------------------------------
|
---|
| 251 | NDB_5 .equ $80
|
---|
| 252 | NDB_6 .equ $A0
|
---|
| 253 | NDB_7 .equ $C0
|
---|
| 254 | NDB_8 .equ $E0
|
---|
| 255 | *
|
---|
| 256 | * CFR1 Parity Selection:
|
---|
| 257 | * ----------------------
|
---|
| 258 | P_ODD .equ $04
|
---|
| 259 | P_EVEN .equ $0C
|
---|
| 260 | P_MARK .equ $14
|
---|
| 261 | P_SPACE .equ $1C
|
---|
| 262 | *
|
---|
| 263 | P_NONE .equ $00
|
---|
| 264 | *
|
---|
| 265 | * Line Discipline:
|
---|
| 266 | * ----------------
|
---|
| 267 | L_NUL .equ $00 * No protocol
|
---|
| 268 | L_XON .equ $01 * XON/XOFF
|
---|
| 269 | L_RTS .equ $02 * RTS/CTS
|
---|
| 270 | *
|
---|
| 271 | .page
|
---|
| 272 | *
|
---|
| 273 | * I/O Buffer Sizes:
|
---|
| 274 | * -----------------
|
---|
| 275 | SR1IBS .equ 128
|
---|
| 276 | SR1OBS .equ 128
|
---|
| 277 | SR2IBS .equ 256
|
---|
| 278 | SR2OBS .equ 256
|
---|
| 279 | *
|
---|
| 280 | MC1IBS .equ 512
|
---|
| 281 | MC1OBS .equ 256
|
---|
| 282 | MC2IBS .equ 512
|
---|
| 283 | MC2OBS .equ 256
|
---|
| 284 | *
|
---|
| 285 | * Line Disciplines:
|
---|
| 286 | * -----------------
|
---|
| 287 | SR1DISC .equ L_XON
|
---|
| 288 | SR2DISC .equ L_XON
|
---|
| 289 | MC1DISC .equ L_NUL
|
---|
| 290 | MC2DISC .equ L_NUL
|
---|
| 291 | *
|
---|
| 292 | * CFR Setings:
|
---|
| 293 | * ------------
|
---|
| 294 | SR1CFR0 .equ BR_9600+NSB_1
|
---|
| 295 | SR1CFR1 .equ NDB_8+P_NONE
|
---|
| 296 | SR2CFR0 .equ BR_9600+NSB_1
|
---|
| 297 | SR2CFR1 .equ NDB_8+P_NONE
|
---|
| 298 | *
|
---|
| 299 | MC1CFR0 .equ BR_EXT+NSB_1
|
---|
| 300 | MC1CFR1 .equ NDB_8+P_NONE
|
---|
| 301 | MC2CFR0 .equ BR_EXT+NSB_1
|
---|
| 302 | MC2CFR1 .equ NDB_8+P_NONE
|
---|
| 303 | *
|
---|
| 304 | .page
|
---|
| 305 | *
|
---|
| 306 | * I/O Addresses:
|
---|
| 307 | * --------------
|
---|
| 308 | VSDDINIT .equ $200400 * VSDD initial register base address
|
---|
| 309 | VSDDDATA .equ $200000 * VSDD data segment base address
|
---|
| 310 | FPUBASE .equ $180000 * FPU base address
|
---|
| 311 | TIMER .equ $3A0001 * Timer base address
|
---|
| 312 | LCD .equ $3A4001 * LCD driver base address
|
---|
| 313 | SR1ACIA .equ $3A8001 * Serial-1 ACIA base address (BUCHLA)
|
---|
| 314 | SR2ACIA .equ $3A8009 * Serial-2 ACIA base address
|
---|
| 315 | MC1ACIA .equ $3AC001 * MIDI-1 ACIA base address
|
---|
| 316 | MC2ACIA .equ $3AC009 * MIDI-2 ACIA base address
|
---|
| 317 | FLOPPY .equ $3B0001 * Floppy controller base address
|
---|
| 318 | PSG .equ $3B4001 * Sound chip base address
|
---|
| 319 | LEDS .equ $3B8001 * LED driver base address
|
---|
| 320 | ANALOG .equ $3BC001 * Analog processor base address
|
---|
| 321 | *
|
---|
| 322 | * FPU address offsets and misc. values
|
---|
| 323 | * ------------------------------------
|
---|
| 324 | FPU_CTL .equ $4000 * FPU control
|
---|
| 325 | FPU_IN .equ $4000 * FPU input address
|
---|
| 326 | FPU_CLR .equ $6000 * FPU interrupt reset address
|
---|
| 327 | FPU_RST .equ $0015 * FPU reset value
|
---|
| 328 | *
|
---|
| 329 | * PSG address offsets
|
---|
| 330 | * -------------------
|
---|
| 331 | PSG_RD .equ PSG * Read PSG data
|
---|
| 332 | PSG_WL .equ PSG * Write PSG address latch
|
---|
| 333 | PSG_WD .equ PSG+2 * Write PSG data
|
---|
| 334 | *
|
---|
| 335 | * VSDD data structure offsets
|
---|
| 336 | * ---------------------------
|
---|
| 337 | VSDD_REG .equ VSDDDATA * Registers
|
---|
| 338 | VSDD_AT .equ VSDDDATA+$0100 * Access Table
|
---|
| 339 | *
|
---|
| 340 | * Timer registers
|
---|
| 341 | * ---------------
|
---|
| 342 | TIME_CRX .equ TIMER * Control register 1 or 3
|
---|
| 343 | TIME_CR2 .equ TIMER+2 * Control register 2
|
---|
| 344 | TIME_T1H .equ TIMER+4 * Timer 1 high byte
|
---|
| 345 | TIME_T1L .equ TIMER+6 * Timer 1 low byte
|
---|
| 346 | TIME_T2H .equ TIMER+8 * Tiemr 2 high byte
|
---|
| 347 | TIME_T2L .equ TIMER+10 * Timer 2 low byte
|
---|
| 348 | TIME_T3H .equ TIMER+12 * Timer 3 high byte
|
---|
| 349 | TIME_T3L .equ TIMER+14 * Timer 3 low byte
|
---|
| 350 | *
|
---|
| 351 | .page
|
---|
| 352 | *
|
---|
| 353 | * ACIA Register offsets:
|
---|
| 354 | * ----------------------
|
---|
| 355 | ACIA_IER .equ 0 * ACIA IER offset
|
---|
| 356 | ACIA_ISR .equ 0 * ACIA ISR offset
|
---|
| 357 | ACIA_CSR .equ 2 * ACIA CSR offset
|
---|
| 358 | ACIA_CFR .equ 2 * ACIA CFR offset
|
---|
| 359 | ACIA_TBR .equ 4 * ACIA TBR offset
|
---|
| 360 | ACIA_TDR .equ 6 * ACIA TDR offset
|
---|
| 361 | ACIA_RDR .equ 6 * ACIA RDR offset
|
---|
| 362 | *
|
---|
| 363 | * Floppy register offsets:
|
---|
| 364 | * ------------------------
|
---|
| 365 | DSKCMD .equ 0 * Command / status
|
---|
| 366 | DSKTRK .equ 2 * Track
|
---|
| 367 | DSKSEC .equ 4 * Sector
|
---|
| 368 | DSKDAT .equ 6 * Data
|
---|
| 369 | *
|
---|
| 370 | * Miscellaneous equates:
|
---|
| 371 | * ----------------------
|
---|
| 372 | FL_NC .equ $02 * Non-compensated R/W/F bit
|
---|
| 373 | *
|
---|
| 374 | APISIZE .equ 256 * Analog processor buffer size
|
---|
| 375 | *
|
---|
| 376 | * Floppy commands:
|
---|
| 377 | * ----------------
|
---|
| 378 | FL_RS .equ $80 * Read sector
|
---|
| 379 | FL_RM .equ $90 * Read multiple
|
---|
| 380 | FL_WS .equ $A0 * Write sector
|
---|
| 381 | FL_WT .equ $F0 * Write track (format)
|
---|
| 382 | FL_FR .equ $D0 * Force reset
|
---|
| 383 | FL_SK .equ $10 * Seek
|
---|
| 384 | FL_SV .equ $14 * Seek w/verify
|
---|
| 385 | *
|
---|
| 386 | .page
|
---|
| 387 | *
|
---|
| 388 | * iorec structure definitions:
|
---|
| 389 | * ----------------------------
|
---|
| 390 | ibuf .equ 0 * L - Input buffer base address
|
---|
| 391 | ibufsize .equ ibuf+4 * W - Input buffer size (bytes)
|
---|
| 392 | ibufhd .equ ibufsize+2 * W - Input buffer head index
|
---|
| 393 | ibuftl .equ ibufhd+2 * W - Input buffer tail index
|
---|
| 394 | ibuflow .equ ibuftl+2 * W - Input buffer low water mark
|
---|
| 395 | ibufhi .equ ibuflow+2 * W - Input buffer high water mark
|
---|
| 396 | obuf .equ ibufhi+2 * L - Output buffer base address
|
---|
| 397 | obufsize .equ obuf+4 * W - Output buffer size (bytes)
|
---|
| 398 | obufhd .equ obufsize+2 * W - Output buffer head index
|
---|
| 399 | obuftl .equ obufhd+2 * W - Output buffer tail index
|
---|
| 400 | obuflow .equ obuftl+2 * W - Output buffer low water mark
|
---|
| 401 | obufhi .equ obuflow+2 * W - Output buffer high water mark
|
---|
| 402 | cfr0 .equ obufhi+2 * B - ACIA CFR, MS bit = 0
|
---|
| 403 | cfr1 .equ cfr0+1 * B - ACIA CFR, MS bit = 1
|
---|
| 404 | flagxon .equ cfr1+1 * B - XON flag (non-zero = XOFF sent)
|
---|
| 405 | flagxoff .equ flagxon+1 * B - XOFF flag (non-zero = active)
|
---|
| 406 | linedisc .equ flagxoff+1 * B - Line discipline flags
|
---|
| 407 | erbyte .equ linedisc+1 * B - Last error byte
|
---|
| 408 | isr .equ erbyte+1 * B - ACIA ISR on interrupt
|
---|
| 409 | csr .equ isr+1 * B - ACIA CSR on interrupt
|
---|
| 410 | errct .equ csr+1 * W - Error count (FRM/OVR/BRK)
|
---|
| 411 | ibfct .equ errct+2 * W - Input buffer overflow error count
|
---|
| 412 | inp_nf .equ ibfct+2 * L - Input buffer not-full semaphore
|
---|
| 413 | inp_ne .equ inp_nf+4 * L - Input buffer not-empty semaphore
|
---|
| 414 | out_nf .equ inp_ne+4 * L - Output buffer not-full semaphore
|
---|
| 415 | out_ne .equ out_nf+4 * L - Output buffer not-empty semaphore
|
---|
| 416 | *
|
---|
| 417 | IORECLN .equ out_ne+4 * Length of an iorec structure (bytes)
|
---|
| 418 | *
|
---|
| 419 | .page
|
---|
| 420 | *
|
---|
| 421 | * In the Beginning...
|
---|
| 422 | * -------------------
|
---|
| 423 | *
|
---|
| 424 | * Low PROM -- Contains the initial sp (unused), and the initial pc,
|
---|
| 425 | * as well as some version and creation date stuff and a copyright message,
|
---|
| 426 | * just to be thorough about it.
|
---|
| 427 | *
|
---|
| 428 | begin: bra.b biosinit * Jump to bios init
|
---|
| 429 | *
|
---|
| 430 | vermsg: dc.b VM1,VM2 * Version number
|
---|
| 431 | *
|
---|
| 432 | dc.l biosinit * Reset address (bios init)
|
---|
| 433 | *
|
---|
| 434 | created: dc.l VDATE * Creation date
|
---|
| 435 | *
|
---|
| 436 | copyrite: dc.b '{Copyright 1988 by ' * Copyright message
|
---|
| 437 | dc.b 'D.N. Lynx Crowe}',0
|
---|
| 438 | *
|
---|
| 439 | dc.l 0 * Some padding
|
---|
| 440 | *
|
---|
| 441 | .page
|
---|
| 442 | *
|
---|
| 443 | .even
|
---|
| 444 | *
|
---|
| 445 | * biosinit -- Setup the defaults for the BIOS
|
---|
| 446 | * -------- -------------------------------
|
---|
| 447 | biosinit: move.w #$2700,sr * Set sup mode, no interrupts
|
---|
| 448 | move.l #SSTACK,a7 * Setup supervisor stack pointer
|
---|
| 449 | *
|
---|
| 450 | lea badtrap,a1 * Set default bad trap vector
|
---|
| 451 | adda.l #$02000000,a1 * ... with trap # in bits 31..24
|
---|
| 452 | lea 8,a0 * ... for all traps
|
---|
| 453 | move.l #253,d1
|
---|
| 454 | *
|
---|
| 455 | binit1: move.l a1,(a0)+ * Store trap vector
|
---|
| 456 | adda.l #$01000000,a1 * Increment trap #
|
---|
| 457 | dbf d1,binit1 * Loop until done
|
---|
| 458 | *
|
---|
| 459 | lea biosram,a0 * Clear BIOS ram ...
|
---|
| 460 | lea SSTACK-2,a1 * ... from biosram to SSTACK-1
|
---|
| 461 | *
|
---|
| 462 | binit2: move.w #0,(a0)+ * Zero a word
|
---|
| 463 | cmpa.l a0,a1 * Last one ?
|
---|
| 464 | bne binit2 * Loop if not
|
---|
| 465 | *
|
---|
| 466 | .page
|
---|
| 467 | *
|
---|
| 468 | move.l #rsarea,savptr * Setup pointer to register area
|
---|
| 469 | move.l #RSMAGIC,_rsflag * Set magic in _rsflag
|
---|
| 470 | *
|
---|
| 471 | move.l #nullrts,timevec * Set timer interrupt vector
|
---|
| 472 | move.l #nullrts,critvec * Set critical error vector
|
---|
| 473 | move.l #nullrts,termvec * Set process terminate vector
|
---|
| 474 | move.l #nullfpu,resvec3 * Set software vector 3 (FPU)
|
---|
| 475 | move.l #nullrts,resvec4 * Set software vector 4 (VSDD)
|
---|
| 476 | move.l #nullrts,resvec5 * Set software vector 5
|
---|
| 477 | move.l #nullrts,resvec6 * Set software vector 6
|
---|
| 478 | move.l #nullrts,resvec7 * Set software vector 7
|
---|
| 479 | *
|
---|
| 480 | move.l #hardhlt,$0008 * Set bus error vector
|
---|
| 481 | move.l #nullrte,$0014 * Set divide error vector
|
---|
| 482 | move.l #nullrte,$0018 * Set CHK vector
|
---|
| 483 | move.l #nullrte,$001C * Set TRAPV vector
|
---|
| 484 | move.l #nullrte,$0024 * Set trace vector
|
---|
| 485 | *
|
---|
| 486 | move.l #nullrte,$0030 * Set reserved vector 12
|
---|
| 487 | move.l #nullrte,$0034 * Set reserved vector 13
|
---|
| 488 | move.l #nullrte,$0038 * Set reserved vector 14
|
---|
| 489 | *
|
---|
| 490 | move.l #nullrte,$003C * Set uninitialized int. vector
|
---|
| 491 | *
|
---|
| 492 | move.l #nullrte,$0040 * Set reserved vector 16
|
---|
| 493 | move.l #nullrte,$0044 * Set reserved vector 17
|
---|
| 494 | move.l #nullrte,$0048 * Set reserved vector 18
|
---|
| 495 | move.l #nullrte,$004C * Set reserved vector 19
|
---|
| 496 | move.l #nullrte,$0050 * Set reserved vector 20
|
---|
| 497 | move.l #nullrte,$0054 * Set reserved vector 21
|
---|
| 498 | move.l #nullrte,$0058 * Set reserved vector 22
|
---|
| 499 | move.l #nullrte,$005C * Set reserved vector 23
|
---|
| 500 | *
|
---|
| 501 | move.l #nullrte,$0060 * Set spurious int. vector
|
---|
| 502 | *
|
---|
| 503 | move.l #MTInt1,$0064 * Set level 1 vector VSDD
|
---|
| 504 | move.l #MTInt2,$0068 * Set level 2 vector FPU
|
---|
| 505 | move.l #MTInt3,$006C * Set level 3 vector panel
|
---|
| 506 | move.l #MTInt4,$0070 * Set level 4 vector timer
|
---|
| 507 | move.l #MTInt5,$0074 * Set level 5 vector serial I/O
|
---|
| 508 | move.l #nullrte,$0078 * Set level 6 vector -unused-
|
---|
| 509 | move.l #nullrte,$007C * Set level 7 vector -unused-
|
---|
| 510 | *
|
---|
| 511 | move.l #__MT_Swp,$00A0 * Set TRAP 8 vector MTSwap()
|
---|
| 512 | move.l #__MT_Nxt,$00A4 * Set TRAP 9 vector MTNext()
|
---|
| 513 | move.l #trap13,$00B4 * Set TRAP 13 vector BIOS()
|
---|
| 514 | move.l #trap14,$00B8 * Set TRAP 14 vector XBIOS()
|
---|
| 515 | *
|
---|
| 516 | .page
|
---|
| 517 | *
|
---|
| 518 | move.l #1,_SemTick * Clear timer tick semaphore
|
---|
| 519 | move.l #1,_SemFCLK * Clear score frame semaphore
|
---|
| 520 | move.l #1,_SemAPI * Clear analog FIFO semaphore
|
---|
| 521 | move.l #1,MT_ISEM1 * Clear int. level 1 semaphore
|
---|
| 522 | move.l #1,MT_ISEM2 * Clear int. level 2 semaphore
|
---|
| 523 | move.l #1,MT_ISEM3 * Clear int. level 3 semaphore
|
---|
| 524 | move.l #1,MT_ISEM4 * Clear int. level 4 semaphore
|
---|
| 525 | move.l #1,MT_ISEM5 * Clear int. level 5 semaphore
|
---|
| 526 | *
|
---|
| 527 | move.l #_hdvini,hdv_init * Set disk init vector
|
---|
| 528 | move.l #getbpb,hdv_bpb * Set get BPB vector
|
---|
| 529 | move.l #rwabs,hdv_rw * Set disk I/O vector
|
---|
| 530 | move.l #bootload,hdv_boot * Setup boot load vector
|
---|
| 531 | move.l #mediach,hdv_mchg * Setup media change vector
|
---|
| 532 | *
|
---|
| 533 | move.w #$FFFF,fverify * Set read after write flag
|
---|
| 534 | move.w #FL_SKR,seekrate * Set default seek rate
|
---|
| 535 | move.w #$FFFF,booted * Say we're not booted yet
|
---|
| 536 | move.l #buffer,dskbufp * Setup default disk buffer
|
---|
| 537 | *
|
---|
| 538 | .page
|
---|
| 539 | *
|
---|
| 540 | move.b #7,PSG_WL * Select PSG R7
|
---|
| 541 | move.b #$80,PSG_WD * Write $80 (port B = output)
|
---|
| 542 | move.b #15,PSG_WL * Select PSG R15
|
---|
| 543 | move.b #$00,PSG_WD * Write $00 (sync enable)
|
---|
| 544 | *
|
---|
| 545 | move.b #$00,TIME_T1H * Setup timer 1 (PLL)
|
---|
| 546 | move.b #$1F,TIME_T1L * ... for divide by 64
|
---|
| 547 | move.b #$0C,TIME_T2H * Setup timer 2 (FC)
|
---|
| 548 | move.b #$7F,TIME_T2L * ... for divide by 3200
|
---|
| 549 | move.b #RTCHI,TIME_T3H * Setup timer 3 (RTC)
|
---|
| 550 | move.b #RTCLO,TIME_T3L * ...
|
---|
| 551 | move.b #$42,TIME_CRX * Setup CR3
|
---|
| 552 | move.b #$41,TIME_CR2 * Setup CR2
|
---|
| 553 | move.b #$81,TIME_CRX * Setup CR1
|
---|
| 554 | move.b #$80,TIME_CRX * Start the timers
|
---|
| 555 | *
|
---|
| 556 | lea _sr1_ior,a0 * Serial-1 iorec address to a0
|
---|
| 557 | lea SR1ACIA,a1 * Serial-1 ACIA address to a1
|
---|
| 558 | lea sr1dflt,a2 * Serial-1 dflt table addr to a2
|
---|
| 559 | bsr aciainit * Go initialize the port
|
---|
| 560 | *
|
---|
| 561 | lea _sr2_ior,a0 * Serial-2 iorec address to a0
|
---|
| 562 | lea SR2ACIA,a1 * Serial-2 ACIA address to a1
|
---|
| 563 | lea sr2dflt,a2 * Serial-2 dflt table addr to a2
|
---|
| 564 | bsr aciainit * Go initialize the port
|
---|
| 565 | *
|
---|
| 566 | lea _mc1_ior,a0 * MIDI-1 iorec address to a0
|
---|
| 567 | lea MC1ACIA,a1 * MIDI-1 ACIA address to a1
|
---|
| 568 | lea mc1dflt,a2 * MIDI-1 dflt table addr to a2
|
---|
| 569 | bsr aciainit * Go initialize the port
|
---|
| 570 | *
|
---|
| 571 | lea _mc2_ior,a0 * MIDI-2 iorec address to a0
|
---|
| 572 | lea MC2ACIA,a1 * MIDI-2 ACIA address to a1
|
---|
| 573 | lea mc2dflt,a2 * MIDI-2 dflt table addr to a2
|
---|
| 574 | bsr aciainit * Go initialize the port
|
---|
| 575 | *
|
---|
| 576 | .page
|
---|
| 577 | *
|
---|
| 578 | lea VSDDINIT,a1 * Setup to load VSDD regs
|
---|
| 579 | lea vsddtab,a0 * ... from vsddtab
|
---|
| 580 | move.w #15,d0 * ...
|
---|
| 581 | *
|
---|
| 582 | vsddinit: move.w (a0)+,(a1)+ * Load the VSDD registers
|
---|
| 583 | btst.l #0,d0 * ...
|
---|
| 584 | btst.l #0,d0 * ...
|
---|
| 585 | btst.l #0,d0 * ...
|
---|
| 586 | dbf d0,vsddinit * ...
|
---|
| 587 | *
|
---|
| 588 | move.w vsddit02,VSDDINIT * Enable video output
|
---|
| 589 | *
|
---|
| 590 | move.w #23,d0 * Setup to clear key LEDs
|
---|
| 591 | move.b #$80,d1 * ...
|
---|
| 592 | *
|
---|
| 593 | ledclear: move.b d1,LEDS * Clear a LED
|
---|
| 594 | addq.b #1,d1 * Increment LED number
|
---|
| 595 | dbra d0,ledclear * Loop until all are done
|
---|
| 596 | *
|
---|
| 597 | move.w #7,d0 * Setup to clear pot LEDs
|
---|
| 598 | move.b #$18,d1 * ...
|
---|
| 599 | *
|
---|
| 600 | ledclr2: move.b d1,LEDS * Clear a LED
|
---|
| 601 | addq.b #1,d1 * Increment LED number
|
---|
| 602 | dbra d0,ledclr2 * Loop until all are done
|
---|
| 603 | *
|
---|
| 604 | clr.w fc_sw * Stop the frame clock
|
---|
| 605 | clr.l fc_val * ... and reset it
|
---|
| 606 | *
|
---|
| 607 | .page
|
---|
| 608 | *
|
---|
| 609 | * turn off the master volume (Amplitude) to quiet things down
|
---|
| 610 | *
|
---|
| 611 | lea FPUBASE+FPU_CTL,a0 * Point at FPU master level
|
---|
| 612 | move.w #$0000,$08(a0) * Set CV1 to 0
|
---|
| 613 | addq.w #1,d0 * Delay
|
---|
| 614 | addq.w #1,d0 * ...
|
---|
| 615 | move.w #$0000,$0A(a0) * Set SF1 to 0
|
---|
| 616 | addq.w #1,d0 * Delay
|
---|
| 617 | addq.w #1,d0 * ...
|
---|
| 618 | move.w #$0000,$0C(a0) * Set CV2 to 0
|
---|
| 619 | addq.w #1,d0 * Delay
|
---|
| 620 | addq.w #1,d0 * ...
|
---|
| 621 | move.w #$0000,$0E(a0) * Set SF2 to 0
|
---|
| 622 | addq.w #1,d0 * Delay
|
---|
| 623 | addq.w #1,d0 * ...
|
---|
| 624 | move.w #$0000,$10(a0) * Set CV3 to 0
|
---|
| 625 | addq.w #1,d0 * Delay
|
---|
| 626 | addq.w #1,d0 * ...
|
---|
| 627 | move.w #$0000,$12(a0) * Set SF3 to 0
|
---|
| 628 | addq.w #1,d0 * Delay
|
---|
| 629 | addq.w #1,d0 * ...
|
---|
| 630 | move.w #$8300,$02(a0) * Set new value '10' to -10.00
|
---|
| 631 | addq.w #1,d0 * Delay
|
---|
| 632 | addq.w #1,d0 * ...
|
---|
| 633 | move.w #$8300,$1C(a0) * Set new value '01' to -10.00
|
---|
| 634 | addq.w #1,d0 * Delay
|
---|
| 635 | addq.w #1,d0 * ...
|
---|
| 636 | move.w #$0001,$16(a0) * Set exponent for shortest time
|
---|
| 637 | addq.w #1,d0 * Delay
|
---|
| 638 | addq.w #1,d0 * ...
|
---|
| 639 | move.w #$FFF0,$14(a0) * Set mantissa for shortest time
|
---|
| 640 | addq.w #1,d0 * Delay
|
---|
| 641 | addq.w #1,d0 * ...
|
---|
| 642 | move.w #$0005,$00(a0) * Send control word to FPU
|
---|
| 643 | *
|
---|
| 644 | * start ROMP running
|
---|
| 645 | *
|
---|
| 646 | lea basepage,a1 * Pass start_ a pseudo base page
|
---|
| 647 | move.l #_errno,p_bbase(a1) * ...
|
---|
| 648 | clr.l p_blen(a1) * ...
|
---|
| 649 | move.l a1,-(a7) * ...
|
---|
| 650 | jsr start_ * Go start ROMP (we assume ...)
|
---|
| 651 | *
|
---|
| 652 | ori.w #IPL7,sr * Just in case we return ...
|
---|
| 653 | jmp biosinit * ...
|
---|
| 654 | *
|
---|
| 655 | .page
|
---|
| 656 | *
|
---|
| 657 | * hardhlt -- Bus error trap handler
|
---|
| 658 | * ------- ----------------------
|
---|
| 659 | hardhlt: stop #$2700 * "Die, sucker!"
|
---|
| 660 | bra hardhlt * ...
|
---|
| 661 | *
|
---|
| 662 | * badtrap -- Bad trap handler
|
---|
| 663 | * ------- ----------------
|
---|
| 664 | badtrap: move.w (a7)+,_crshsr * Get crash SR
|
---|
| 665 | move.l (a7)+,_crshpc * Get crash PC
|
---|
| 666 | move.l a7,_crshsp * Get crash SP
|
---|
| 667 | bsr badtr1 * Get TRAP PC with vector number
|
---|
| 668 | nop
|
---|
| 669 | *
|
---|
| 670 | badtr1: move.l (a7)+,_crshvc * Save for analysis of vector #
|
---|
| 671 | movem.l d0-d7/a0-a7,_crshrg * Save crash registers
|
---|
| 672 | move.l usp,a0 * Preserve crash USP
|
---|
| 673 | move.l a0,_crshus * ...
|
---|
| 674 | move.l a7,d0 * Get SP
|
---|
| 675 | andi.l #$FFFFFFFE,d0 * ... make sure it's even
|
---|
| 676 | movea.l d0,a1 * ...
|
---|
| 677 | move.w #15,d0 * Save top 16 words
|
---|
| 678 | lea _crshst,a0 * ... of crash stack in _crshst
|
---|
| 679 | *
|
---|
| 680 | badtr2: move.w (a1)+,(a0)+ * Save a stack value
|
---|
| 681 | dbf d0,badtr2 * Loop until all are saved
|
---|
| 682 | *
|
---|
| 683 | moveq.l #0,d0 * Get TRAP number
|
---|
| 684 | move.b _crshvc,d0 * ... as LS byte of d0
|
---|
| 685 | move.l _crshpc,a0 * Save crash PC in a0
|
---|
| 686 | move.w #$FFFF,_wzcrsh * Indicate we crashed
|
---|
| 687 | move.l #rsarea,savptr * Restore system save pointer
|
---|
| 688 | move.l #SSTACK,a7 * Reset the stack pointer
|
---|
| 689 | move.l #RSMAGIC,_rsflag * ... and the stack sentinel
|
---|
| 690 | trap #15 * TRAP to ROMP
|
---|
| 691 | *
|
---|
| 692 | jmp biosinit * Recover with a cold start
|
---|
| 693 | *
|
---|
| 694 | .page
|
---|
| 695 | *
|
---|
| 696 | * __MTInt4 -- Timer second level interrupt handler
|
---|
| 697 | * -------- ------------------------------------
|
---|
| 698 | __MTInt4: pea MT_ISEM4 * Wait on interrupt semaphore
|
---|
| 699 | jsr SM_Wait * ...
|
---|
| 700 | tst.l (a7)+ * ...
|
---|
| 701 | move.b TIME_CR2,d0 * Get timer interrupt status
|
---|
| 702 | btst.l #2,d0 * Check timer 3 status
|
---|
| 703 | beq tmi02 * Jump if not active
|
---|
| 704 | *
|
---|
| 705 | move.b TIME_T3H,d1 * Read timer 1 count
|
---|
| 706 | lsl.l #8,d1 * ...
|
---|
| 707 | move.b TIME_T3L,d1 * ...
|
---|
| 708 | move.w d1,t3count * ... and save it
|
---|
| 709 | addq.l #1,_hz_1k * Update real time clock
|
---|
| 710 | *
|
---|
| 711 | tst.l _SemTick * Check the timer semaphore
|
---|
| 712 | beq timenw * Jump if zero (nothing waiting)
|
---|
| 713 | *
|
---|
| 714 | btst.b #0,_SemTick+3 * Check the timer semaphore LSB
|
---|
| 715 | bne timenw * Jump if nothing waiting
|
---|
| 716 | *
|
---|
| 717 | move.l #_SemTick,-(a7) * Signal the timer semaphore
|
---|
| 718 | jsr SM_Sig * ...
|
---|
| 719 | tst.l (a7)+ * ...
|
---|
| 720 | *
|
---|
| 721 | timenw: cmpi.l #nullrts,timevec * See if we need to do timevec
|
---|
| 722 | beq timenv * Jump if not
|
---|
| 723 | *
|
---|
| 724 | movem.l d0-d7/a0-a6,-(a7) * Save registers
|
---|
| 725 | movea.l timevec,a0 * (*timevec)()
|
---|
| 726 | jsr (a0) * ...
|
---|
| 727 | movem.l (a7)+,d0-d7/a0-a6 * Restore registers
|
---|
| 728 | *
|
---|
| 729 | timenv: move.w tdiv1,d1 * Update divider
|
---|
| 730 | addq.w #1,d1 * ...
|
---|
| 731 | move.w d1,tdiv1 * ...
|
---|
| 732 | *
|
---|
| 733 | * cmpi.w #5,d1 * Do we need to update _hz_200 ?
|
---|
| 734 | * bcs tmi02 * Jump if not
|
---|
| 735 | *
|
---|
| 736 | addq.l #1,_hz_200 * Update 5ms clock (200 Hz)
|
---|
| 737 | *
|
---|
| 738 | move.w tdiv2,d1 * Update divider
|
---|
| 739 | addq.w #1,d1 * ...
|
---|
| 740 | move.w d1,tdiv2 * ...
|
---|
| 741 | *
|
---|
| 742 | cmpi.w #4,d1 * Do we need to update frclock ?
|
---|
| 743 | bcs tmi01 * Jump if not
|
---|
| 744 | *
|
---|
| 745 | addq.l #1,frclock * Update 20 Ms clock (50 Hz)
|
---|
| 746 | tst.w flock * See if floppy is active
|
---|
| 747 | bne tmi00 * Don't call flopvbl if so
|
---|
| 748 | *
|
---|
| 749 | movem.l d0-d7/a0-a6,-(a7) * Preserve registers
|
---|
| 750 | bsr flopvbl * Check on the floppy
|
---|
| 751 | movem.l (a7)+,d0-d7/a0-a6 * Restore registers
|
---|
| 752 | *
|
---|
| 753 | .page
|
---|
| 754 | *
|
---|
| 755 | tmi00: move.w #0,tdiv2 * Reset tdiv2
|
---|
| 756 | *
|
---|
| 757 | tmi01: move.w #0,tdiv1 * Reset tdiv1
|
---|
| 758 | *
|
---|
| 759 | tmi02: btst.l #0,d0 * Check timer 1 int
|
---|
| 760 | beq tmi03 * Jump if not set
|
---|
| 761 | *
|
---|
| 762 | move.b TIME_T1H,d1 * Read timer 1 to clear int.
|
---|
| 763 | lsl.l #8,d1 * ...
|
---|
| 764 | move.b TIME_T1L,d1 * ...
|
---|
| 765 | move.w d1,t1count * ... and save the count
|
---|
| 766 | *
|
---|
| 767 | tmi03: btst.l #1,d0 * Check for timer 2 int.
|
---|
| 768 | beq __MTInt4 * Jump if not set
|
---|
| 769 | *
|
---|
| 770 | move.b TIME_T2H,d1 * Read timer 2 to clear int.
|
---|
| 771 | lsl.l #8,d1 * ...
|
---|
| 772 | move.b TIME_T2L,d1 * ...
|
---|
| 773 | move.w d1,t2count * ... and save the count
|
---|
| 774 | *
|
---|
| 775 | tst.w fc_sw * Should we update the frame ?
|
---|
| 776 | beq __MTInt4 * Done if not
|
---|
| 777 | *
|
---|
| 778 | bmi tmi05 * Jump if we count down
|
---|
| 779 | *
|
---|
| 780 | move.l fc_val,d0 * Get the frame count
|
---|
| 781 | cmp.l #FCMAX,d0 * See it we've topped out
|
---|
| 782 | bge tmi06 * Jump if limit was hit
|
---|
| 783 | *
|
---|
| 784 | addq.l #1,d0 * Count up 1 frame
|
---|
| 785 | move.l d0,fc_val * Store updated frame count
|
---|
| 786 | move.l #_SemFCLK,-(a7) * Signal that the frame changed
|
---|
| 787 | jsr SM_Sig * ...
|
---|
| 788 | tst.l (a7)+ * ...
|
---|
| 789 | bra __MTInt4 * Done
|
---|
| 790 | *
|
---|
| 791 | tmi06: move.l #FCMAX,fc_val * Force hard limit, just in case
|
---|
| 792 | bra __MTInt4 * Done
|
---|
| 793 | *
|
---|
| 794 | tmi05: move.l fc_val,d0 * Get the frame count
|
---|
| 795 | beq __MTInt4 * Done if already zero
|
---|
| 796 | *
|
---|
| 797 | subq.l #1,d0 * Count down 1 frame
|
---|
| 798 | move.l d0,fc_val * Store udpated frame count
|
---|
| 799 | move.l #_SemFCLK,-(a7) * Signal that the frame changed
|
---|
| 800 | jsr SM_Sig * ...
|
---|
| 801 | tst.l (a7)+ * ...
|
---|
| 802 | bra __MTInt4 * Done
|
---|
| 803 | *
|
---|
| 804 | .page
|
---|
| 805 | *
|
---|
| 806 | * trap14 -- Extended BIOS entry point
|
---|
| 807 | * ------ -------------------------
|
---|
| 808 | trap14: lea t14tab,a0 * Setup trap 14 table address
|
---|
| 809 | bra trapent * Go process trap
|
---|
| 810 | *
|
---|
| 811 | * trap13 -- Main BIOS entry point
|
---|
| 812 | * ------ ---------------------
|
---|
| 813 | trap13: lea t13tab,a0 * Setup trap 13 table address
|
---|
| 814 | *
|
---|
| 815 | trapent: move.l savptr,a1 * Get save area pointer
|
---|
| 816 | move.w (a7)+,d0 * Status register to D0
|
---|
| 817 | move.w d0,-(a1) * Save in save area
|
---|
| 818 | move.l (a7)+,-(a1) * Stash PC in save area
|
---|
| 819 | movem.l d3-d7/a3-a7,-(a1) * Save parameter register
|
---|
| 820 | move.l a1,savptr * Update save pointer
|
---|
| 821 | btst #13,d0 * Were we in sup. mode ?
|
---|
| 822 | bne trwzsup * Jump if so
|
---|
| 823 | *
|
---|
| 824 | move.l usp,a7 * Move user sp to stack ptr.
|
---|
| 825 | *
|
---|
| 826 | trwzsup: move.w (a7)+,d0 * Get function number from stack
|
---|
| 827 | cmp.w (a0)+,d0 * Check against limit
|
---|
| 828 | bge trpexit * Jump if it's invalid
|
---|
| 829 | *
|
---|
| 830 | lsl.w #2,d0 * Multiply by 4 for use as index
|
---|
| 831 | move.l 0(a0,d0),a0 * Get routine address
|
---|
| 832 | sub.l a5,a5 * Clear a5
|
---|
| 833 | jsr (a0) * Execute the routine
|
---|
| 834 | *
|
---|
| 835 | trpexit: move.l savptr,a1 * Get SAVPTR into a1
|
---|
| 836 | movem.l (a1)+,d3-d7/a3-a7 * Restore registers
|
---|
| 837 | move.l (a1)+,-(a7) * Push return onto stack
|
---|
| 838 | move.w (a1)+,-(a7) * Push status onto stack
|
---|
| 839 | move.l a1,savptr * Update SAVPTR
|
---|
| 840 | *
|
---|
| 841 | * nullrte -- null rte
|
---|
| 842 | * ------- --------
|
---|
| 843 | nullrte: rte * Return to interrupted code
|
---|
| 844 | *
|
---|
| 845 | * nullrts -- null return
|
---|
| 846 | * ------- -----------
|
---|
| 847 | nullrts: rts * Just return to the caller
|
---|
| 848 | *
|
---|
| 849 | .page
|
---|
| 850 | *
|
---|
| 851 | * bconstat -- Get character device input status
|
---|
| 852 | * -------- ---------------------------------
|
---|
| 853 | bconstat: lea cdt01,a0 * Point at status table
|
---|
| 854 | bra condisp * Jump to dispatcher
|
---|
| 855 | *
|
---|
| 856 | * bconin -- Get input from character device
|
---|
| 857 | * ------ -------------------------------
|
---|
| 858 | bconin: lea cdt02,a0 * Point at input table
|
---|
| 859 | bra condisp * Jump to dispatcher
|
---|
| 860 | *
|
---|
| 861 | * bconout -- Output to character device
|
---|
| 862 | * ------- --------------------------
|
---|
| 863 | bconout: lea cdt03,a0 * Point at output table
|
---|
| 864 | bra condisp * Jump to dispatcher
|
---|
| 865 | *
|
---|
| 866 | * bcostat -- Get character device output status
|
---|
| 867 | * ------- ----------------------------------
|
---|
| 868 | bcostat: lea cdt04,a0 * Point at status table
|
---|
| 869 | *
|
---|
| 870 | * condisp -- Character device function dispatcher
|
---|
| 871 | * ------- ------------------------------------
|
---|
| 872 | condisp: move.w 4(a7),d0 * Get device number
|
---|
| 873 | lsl.w #2,d0 * ... times 4 for pointer
|
---|
| 874 | move.l 0(a0,d0),a0 * Get routine address
|
---|
| 875 | jmp (a0) * Jump to it
|
---|
| 876 | *
|
---|
| 877 | .page
|
---|
| 878 | *
|
---|
| 879 | * sr1ist -- Check CON (Serial-1) input buffer status
|
---|
| 880 | * ------ ----------------------------------------
|
---|
| 881 | sr1ist: lea _sr1_ior,a0 * Address of iorec to a0
|
---|
| 882 | lea SR1ACIA,a1 * Address of ACIA to a1
|
---|
| 883 | bra chkist * Go check buffer status
|
---|
| 884 | *
|
---|
| 885 | * sr2ist -- Check AUX (Serial-2) input buffer status
|
---|
| 886 | * ------ ----------------------------------------
|
---|
| 887 | sr2ist: lea _sr2_ior,a0 * Address of iorec to a0
|
---|
| 888 | lea SR2ACIA,a1 * Address of ACIA to a1
|
---|
| 889 | bra chkist * Go check buffer status
|
---|
| 890 | *
|
---|
| 891 | * mc1ist -- Check MC1 (MIDI-1) input buffer status
|
---|
| 892 | * ------ --------------------------------------
|
---|
| 893 | mc1ist: lea _mc1_ior,a0 * Address of iorec to a0
|
---|
| 894 | lea MC1ACIA,a1 * Address of ACIA to a1
|
---|
| 895 | bra chkist * Go check buffer status
|
---|
| 896 | *
|
---|
| 897 | * mc2ist -- Check MC2 (MIDI-2) input buffer status
|
---|
| 898 | * ------ --------------------------------------
|
---|
| 899 | mc2ist: lea _mc2_ior,a0 * Address of iorec to a0
|
---|
| 900 | lea MC2ACIA,a1 * Address of ACIA to a1
|
---|
| 901 | *
|
---|
| 902 | * chkist -- Check input buffer status
|
---|
| 903 | * ------ -------------------------
|
---|
| 904 | chkist: moveq.l #-1,d0 * Default to "Input available"
|
---|
| 905 | lea ibufhd(a0),a2 * Head index to a2
|
---|
| 906 | lea ibuftl(a0),a3 * Tail index to a3
|
---|
| 907 | cmpm.w (a3)+,(a2)+ * Buffer clear ?
|
---|
| 908 | bne chkist1 * Jump if not
|
---|
| 909 | *
|
---|
| 910 | moveq.l #0,d0 * Set to "Buffer empty"
|
---|
| 911 | *
|
---|
| 912 | chkist1: rts * Return to caller
|
---|
| 913 | *
|
---|
| 914 | .page
|
---|
| 915 | *
|
---|
| 916 | * sr1ost -- Check CON (Serial-1) output buffer status
|
---|
| 917 | * ------ -----------------------------------------
|
---|
| 918 | sr1ost: lea _sr1_ior,a0 * Address of iorec to a0
|
---|
| 919 | bra chkost * Go check buffer status
|
---|
| 920 | *
|
---|
| 921 | * sr2ost -- Check AUX (Serial-2) output buffer status
|
---|
| 922 | * ------ -----------------------------------------
|
---|
| 923 | sr2ost: lea _sr2_ior,a0 * Address of iorec to a0
|
---|
| 924 | bra chkost * Go check buffer status
|
---|
| 925 | *
|
---|
| 926 | * mc1ost -- Check MC1 (MIDI-1) output buffer status
|
---|
| 927 | * ------ ---------------------------------------
|
---|
| 928 | mc1ost: lea _mc1_ior,a0 * Address of iorec to a0
|
---|
| 929 | bra chkost * Go check buffer status
|
---|
| 930 | *
|
---|
| 931 | * mc2ost -- Check MC2 (MIDI-2) output buffer status
|
---|
| 932 | * ------ ---------------------------------------
|
---|
| 933 | mc2ost: lea _mc2_ior,a0 * Address of iorec to a0
|
---|
| 934 | *
|
---|
| 935 | * chkost -- Check output buffer status
|
---|
| 936 | * ------ --------------------------
|
---|
| 937 | chkost: moveq.l #-1,d0 * Default to "Output OK"
|
---|
| 938 | move.w obuftl(a0),d2 * Tail index to d2
|
---|
| 939 | bsr wrapout * Test for pointer wraparound
|
---|
| 940 | cmp.w obufhd(a0),d2 * Compare with head index
|
---|
| 941 | bne chkost1 * Jump if not equal
|
---|
| 942 | *
|
---|
| 943 | moveq.l #0,d0 * Set to "Buffer full"
|
---|
| 944 | *
|
---|
| 945 | chkost1: rts * Return to caller
|
---|
| 946 | *
|
---|
| 947 | .page
|
---|
| 948 | *
|
---|
| 949 | * wrapin -- Check input pointer for wraparound
|
---|
| 950 | * ------ ----------------------------------
|
---|
| 951 | wrapin: add.w #1,d1 * Head index +1
|
---|
| 952 | cmp.w ibufsize(a0),d1 * = buffer size ?
|
---|
| 953 | bcs wrapin1 * Jump if not
|
---|
| 954 | *
|
---|
| 955 | moveq.l #0,d1 * Wraparound
|
---|
| 956 | *
|
---|
| 957 | wrapin1: rts * Return to caller
|
---|
| 958 | *
|
---|
| 959 | * wrapout -- Check output pointer for wraparound
|
---|
| 960 | * ------- -----------------------------------
|
---|
| 961 | wrapout: addq.w #1,d2 * Tail index +1
|
---|
| 962 | cmp.w obufsize(a0),d2 * = buffer size ?
|
---|
| 963 | bcs wrapout1 * Jump if not
|
---|
| 964 | *
|
---|
| 965 | moveq.l #0,d2 * Wrap around if so
|
---|
| 966 | *
|
---|
| 967 | wrapout1: rts * Return to caller
|
---|
| 968 | *
|
---|
| 969 | * sr1inp -- Get input from Serial-1 (wait if empty)
|
---|
| 970 | * ------ ----------------------------------------
|
---|
| 971 | sr1inp: lea _sr1_ior,a0 * Serial-1 iorec address
|
---|
| 972 | lea SR1ACIA,a1 * Serial-1 ACIA base
|
---|
| 973 | bra serinp * Go get a byte
|
---|
| 974 | *
|
---|
| 975 | * sr2inp -- Get input from Serial-2 (wait if empty)
|
---|
| 976 | * ------ ----------------------------------------
|
---|
| 977 | sr2inp: lea _sr2_ior,a0 * Serial-2 iorec address
|
---|
| 978 | lea SR2ACIA,a1 * Serial-2 ACIA base
|
---|
| 979 | *
|
---|
| 980 | * serinp -- Get a byte from a serial port (with handshaking and wait if empty)
|
---|
| 981 | * ------ -------------------------------------------------------------------
|
---|
| 982 | serinp: pea inp_ne(a0) * Wait for a byte
|
---|
| 983 | jsr SM_Wait * ...
|
---|
| 984 | tst.l (a7)+ * ...
|
---|
| 985 | *
|
---|
| 986 | bsr getser * Get a byte from the buffer
|
---|
| 987 | and.w #$FFFF,d0 * Isolate LS bits 7..0
|
---|
| 988 | rts * Return to caller
|
---|
| 989 | *
|
---|
| 990 | .page
|
---|
| 991 | *
|
---|
| 992 | * mc1inp -- Get input from MIDI-1 (wait if empty)
|
---|
| 993 | * ------ --------------------------------------
|
---|
| 994 | mc1inp: lea _mc1_ior,a0 * MIDI-1 iorec address
|
---|
| 995 | lea MC1ACIA,a1 * MIDI-1 ACIA base
|
---|
| 996 | bra midinp * Go get a byte
|
---|
| 997 | *
|
---|
| 998 | * mc2inp -- Get input from MIDI-2 (wait if empty)
|
---|
| 999 | * ------ --------------------------------------
|
---|
| 1000 | mc2inp: lea _mc2_ior,a0 * MIDI-2 iorec address
|
---|
| 1001 | lea MC2ACIA,a1 * MIDI-2 ACIA base
|
---|
| 1002 | *
|
---|
| 1003 | * midinp -- Get input from a MIDI port (no handshaking)
|
---|
| 1004 | * ------ --------------------------------------------
|
---|
| 1005 | midinp: pea inp_ne(a0) * Wait for a byte
|
---|
| 1006 | jsr SM_Wait * ...
|
---|
| 1007 | tst.l (a7)+ * ...
|
---|
| 1008 | *
|
---|
| 1009 | move.w sr,-(a7) * Save status register
|
---|
| 1010 | ori.w #IPL7,sr * Set IPL = 7 (disable ints)
|
---|
| 1011 | move.w ibufhd(a0),d1 * Head index to d1
|
---|
| 1012 | cmp.w ibuftl(a0),d1 * Compare to tail index
|
---|
| 1013 | beq midin_1 * Jump if (somehow) empty
|
---|
| 1014 | *
|
---|
| 1015 | addq.w #1,d1 * Increment head index
|
---|
| 1016 | cmp.w ibufsize(a0),d1 * Did pointer wrap around ?
|
---|
| 1017 | bcs midin_2 * Jump if not
|
---|
| 1018 | *
|
---|
| 1019 | moveq.l #0,d1 * Wraparound
|
---|
| 1020 | *
|
---|
| 1021 | midin_2: move.l ibuf(a0),a2 * Get buffer base address in a2
|
---|
| 1022 | moveq.l #0,d0 * Clear MS bits of d0
|
---|
| 1023 | move.b 0(a2,d1),d0 * Get character from buffer
|
---|
| 1024 | move.w d1,ibufhd(a0) * Update buffer head index
|
---|
| 1025 | *
|
---|
| 1026 | midin_1: move.w (a7)+,sr * Restore status
|
---|
| 1027 | rts * Return to caller
|
---|
| 1028 | *
|
---|
| 1029 | .page
|
---|
| 1030 | *
|
---|
| 1031 | * getser -- Get a byte from a serial port buffer (with handshaking)
|
---|
| 1032 | * ------ --------------------------------------------------------
|
---|
| 1033 | getser: move.w sr,-(a7) * Save status register
|
---|
| 1034 | ori.w #IPL7,sr * Set IPL = 7 (disable ints)
|
---|
| 1035 | move.w ibufhd(a0),d1 * Get input buffer head index
|
---|
| 1036 | cmp.w ibuftl(a0),d1 * Compare tail index
|
---|
| 1037 | beq rs_mt * Jump if buffer empty (error!)
|
---|
| 1038 | *
|
---|
| 1039 | bsr wrapin * Adjust pointer for wraparound
|
---|
| 1040 | move.l ibuf(a0),a2 * Get buffer address
|
---|
| 1041 | moveq.l #0,d0 * Clear out MS bits of d0
|
---|
| 1042 | move.b 0(a2,d1),d0 * Get character from buffer
|
---|
| 1043 | move.w d1,ibufhd(a0) * Update head index
|
---|
| 1044 | move.w (a7)+,sr * Restore status
|
---|
| 1045 | andi #$FFFE,sr * Clear carry = OK
|
---|
| 1046 | bra rs_xnf * Go do XON/XOFF check
|
---|
| 1047 | *
|
---|
| 1048 | rs_mt: move.w (a7)+,sr * Restore status
|
---|
| 1049 | ori #$0001,sr * Set carry = no character there
|
---|
| 1050 | *
|
---|
| 1051 | rs_xnf: btst #0,linedisc(a0) * Check for XON/XOFF mode
|
---|
| 1052 | beq rs_exit * Jump if not enabled
|
---|
| 1053 | *
|
---|
| 1054 | tst.b flagxon(a0) * XON active ?
|
---|
| 1055 | beq rs_exit * Jump if not
|
---|
| 1056 | *
|
---|
| 1057 | bsr rsilen * Get length of buffer used
|
---|
| 1058 | cmp.w ibuflow(a0),d2 * At low water mark ?
|
---|
| 1059 | bne rs_exit * Jump if not
|
---|
| 1060 | *
|
---|
| 1061 | rs_txon: move.b #$11,d1 * Send an XON
|
---|
| 1062 | bsr serput * ...
|
---|
| 1063 | bcs rs_txon * ...
|
---|
| 1064 | *
|
---|
| 1065 | clr.b flagxon(a0) * Clear XON flag
|
---|
| 1066 | *
|
---|
| 1067 | rs_exit: rts * Return to caller
|
---|
| 1068 | *
|
---|
| 1069 | .page
|
---|
| 1070 | *
|
---|
| 1071 | * sr1out -- Output to serial-1
|
---|
| 1072 | * ------ ------------------
|
---|
| 1073 | sr1out: lea _sr1_ior,a0 * Serial-1 iorec address to a0
|
---|
| 1074 | lea SR1ACIA,a1 * Serial-1 ACIA address to a1
|
---|
| 1075 | *
|
---|
| 1076 | sr1out0: move.w 6(a7),d1 * Get data byte from stack
|
---|
| 1077 | bsr serput * Output to ACIA
|
---|
| 1078 | bcc sr1out2 * Jump if successful
|
---|
| 1079 | *
|
---|
| 1080 | sr1out1: pea out_nf(a0) * Wait for FIFO not full
|
---|
| 1081 | jsr SM_Wait * ...
|
---|
| 1082 | tst.l (a7)+ * ...
|
---|
| 1083 | *
|
---|
| 1084 | move.w 6(a7),d1 * Get data byte from stack
|
---|
| 1085 | bsr serput * Output to ACIA
|
---|
| 1086 | bcs sr1out1 * Jump if unsuccessful
|
---|
| 1087 | *
|
---|
| 1088 | sr1out2: rts * Return to caller
|
---|
| 1089 | *
|
---|
| 1090 | * sr2out -- Output to Serial-2
|
---|
| 1091 | * ------ ------------------
|
---|
| 1092 | sr2out: lea _sr2_ior,a0 * Serial-2 iorec address to a0
|
---|
| 1093 | lea SR2ACIA,a1 * Serial-2 ACIA address to a1
|
---|
| 1094 | bra sr1out0 * Go do output to ACIA
|
---|
| 1095 | *
|
---|
| 1096 | * mc1out -- Output to MIDI-1
|
---|
| 1097 | * ------ ----------------
|
---|
| 1098 | mc1out: lea _mc1_ior,a0 * MIDI-1 iorec address to a0
|
---|
| 1099 | lea MC1ACIA,a1 * MIDI-1 ACIA address to a1
|
---|
| 1100 | *
|
---|
| 1101 | mc1out0: move.w 6(a7),d1 * Get data byte from stack
|
---|
| 1102 | bsr midput * Output to ACIA
|
---|
| 1103 | bcc mc1out2 * Jump if successful
|
---|
| 1104 | *
|
---|
| 1105 | mc1out1: pea out_nf(a0) * Wait for FIFO not full
|
---|
| 1106 | jsr SM_Wait * ...
|
---|
| 1107 | tst.l (a7)+ * ...
|
---|
| 1108 | *
|
---|
| 1109 | move.w 6(a7),d1 * Get data byte from stack
|
---|
| 1110 | bsr midput * Output to ACIA
|
---|
| 1111 | bcs mc1out1 * Jump if unsuccessful
|
---|
| 1112 | *
|
---|
| 1113 | mc1out2: rts * Return to caller
|
---|
| 1114 | *
|
---|
| 1115 | * mc2out -- Output to MIDI-2
|
---|
| 1116 | * ------ ----------------
|
---|
| 1117 | mc2out: lea _mc2_ior,a0 * MIDI-2 iorec address to a0
|
---|
| 1118 | lea MC2ACIA,a1 * MIDI-2 ACIA address to a1
|
---|
| 1119 | bra mc1out0 * Go do output to ACIA
|
---|
| 1120 | *
|
---|
| 1121 | .page
|
---|
| 1122 | *
|
---|
| 1123 | * serput -- Output a character to a serial port
|
---|
| 1124 | * ------ -----------------------------------
|
---|
| 1125 | serput: move.w sr,-(a7) * Save status register
|
---|
| 1126 | ori.w #IPL7,sr * Set IPL = 7 (disable ints)
|
---|
| 1127 | move.b ACIA_ISR(a1),isr(a0) * Get ACIA isr
|
---|
| 1128 | move.b ACIA_CSR(a1),csr(a0) * Get ACIA csr
|
---|
| 1129 | btst #0,linedisc(a0) * XON/XOFF mode ?
|
---|
| 1130 | beq serpt_1 * Jump if not
|
---|
| 1131 | *
|
---|
| 1132 | tst.b flagxoff(a0) * XON active ?
|
---|
| 1133 | bne serpt_2 * Jump if so
|
---|
| 1134 | *
|
---|
| 1135 | serpt_1: btst.b #6,isr(a0) * Is ACIA still sending ?
|
---|
| 1136 | beq serpt_2 * Jump if so
|
---|
| 1137 | *
|
---|
| 1138 | move.w obufhd(a0),d2 * Head index to d2
|
---|
| 1139 | cmp.w obuftl(a0),d2 * Compare to tail index
|
---|
| 1140 | bne serpt_2 * Jump if buffer not empty
|
---|
| 1141 | *
|
---|
| 1142 | move.b d1,ACIA_TDR(a1) * Give byte to ACIA to send
|
---|
| 1143 | bra serpt_3 * Go deal with RTS/CTS if needed
|
---|
| 1144 | *
|
---|
| 1145 | serpt_2: move.w obuftl(a0),d2 * Tail index to d2
|
---|
| 1146 | bsr wrapout * Adjust for wraparound
|
---|
| 1147 | cmp.w obufhd(a0),d2 * Compare to head index
|
---|
| 1148 | beq serpt_4 * Jump if buffer full
|
---|
| 1149 | *
|
---|
| 1150 | move.l obuf(a0),a2 * Get buffer base address in a2
|
---|
| 1151 | move.b d1,0(a2,d2) * Put character in buffer
|
---|
| 1152 | move.w d2,obuftl(a0) * Update buffer tail index
|
---|
| 1153 | *
|
---|
| 1154 | serpt_3: bsr serchk * Check status on our way out
|
---|
| 1155 | bsr rtschk * Handle RTS protocol
|
---|
| 1156 | move.w (a7)+,sr * Restore status register
|
---|
| 1157 | andi #$FFFE,sr * Clear carry flag = OK
|
---|
| 1158 | rts * Return to caller
|
---|
| 1159 | *
|
---|
| 1160 | serpt_4: bsr serchk * Check status on our way out
|
---|
| 1161 | bsr rtschk * Handle RTS protocol
|
---|
| 1162 | move.w (a7)+,sr * Restore status register
|
---|
| 1163 | ori #$0001,sr * Set carry flag = buffer full
|
---|
| 1164 | rts * Return to caller
|
---|
| 1165 | *
|
---|
| 1166 | .page
|
---|
| 1167 | *
|
---|
| 1168 | * midput -- Output to MIDI
|
---|
| 1169 | * ------ --------------
|
---|
| 1170 | midput: move.w sr,-(a7) * Save status register
|
---|
| 1171 | ori.w #IPL7,sr * Set IPL = 7 (diable ints)
|
---|
| 1172 | move.b ACIA_ISR(a1),isr(a0) * Get ACIA isr
|
---|
| 1173 | move.b ACIA_CSR(a1),csr(a0) * Get ACIA csr
|
---|
| 1174 | btst.b #6,isr(a0) * Is ACIA still sending ?
|
---|
| 1175 | beq midpt_2 * Jump if so
|
---|
| 1176 | *
|
---|
| 1177 | move.w obufhd(a0),d2 * Head index to d2
|
---|
| 1178 | cmp.w obuftl(a0),d2 * Compare to tail index
|
---|
| 1179 | bne midpt_2 * Jump if buffer not empty
|
---|
| 1180 | *
|
---|
| 1181 | move.b d1,ACIA_TDR(a1) * Give byte to ACIA to send
|
---|
| 1182 | bra midpt_3 * Go set final status and exit
|
---|
| 1183 | *
|
---|
| 1184 | midpt_2: move.w obuftl(a0),d2 * Tail index to d2
|
---|
| 1185 | bsr wrapout * Adjust for wraparound
|
---|
| 1186 | cmp.w obufhd(a0),d2 * Compare to head index
|
---|
| 1187 | beq midpt_4 * Jump if buffer full
|
---|
| 1188 | *
|
---|
| 1189 | move.l obuf(a0),a2 * Get buffer base address in a2
|
---|
| 1190 | move.b d1,0(a2,d2) * Put character in buffer
|
---|
| 1191 | move.w d2,obuftl(a0) * Update buffer tail index
|
---|
| 1192 | *
|
---|
| 1193 | midpt_3: bsr midchk * Check status on our way out
|
---|
| 1194 | move.w (a7)+,sr * Restore status register
|
---|
| 1195 | andi #$FFFE,sr * Clear carry flag = OK
|
---|
| 1196 | rts * Return to caller
|
---|
| 1197 | *
|
---|
| 1198 | midpt_4: bsr midchk * Check status on our way out
|
---|
| 1199 | move.w (a7)+,sr * Restore status register
|
---|
| 1200 | ori #$0001,sr * Set carry flag = buffer full
|
---|
| 1201 | rts * Return to caller
|
---|
| 1202 | *
|
---|
| 1203 | .page
|
---|
| 1204 | *
|
---|
| 1205 | * rtschk -- Check RTS mode and turn on RTS if it's enabled
|
---|
| 1206 | * ------ ----------------------------------------------
|
---|
| 1207 | rtschk: btst #1,linedisc(a0) * RTS/CTS mode set ?
|
---|
| 1208 | beq rts_1 * Jump if not
|
---|
| 1209 | *
|
---|
| 1210 | bsr rtson * Turn on RTS
|
---|
| 1211 | *
|
---|
| 1212 | rts_1: rts * Return to caller
|
---|
| 1213 | *
|
---|
| 1214 | * rsilen -- Get length of portion of input buffer that's been used so far
|
---|
| 1215 | * ------ -------------------------------------------------------------
|
---|
| 1216 | rsilen: move.w ibuftl(a0),d2 * Tail index to d2
|
---|
| 1217 | move.w ibufhd(a0),d3 * Head index to d3
|
---|
| 1218 | cmp.w d3,d2 * Head > Tail ?
|
---|
| 1219 | bhi rsi_1 * Jump if not
|
---|
| 1220 | *
|
---|
| 1221 | add.w ibufsize(a0),d2 * Add buffer size to tail index
|
---|
| 1222 | *
|
---|
| 1223 | rsi_1: sub.w d3,d2 * Length = (adjusted)Tail - Head
|
---|
| 1224 | rts * Return to caller
|
---|
| 1225 | *
|
---|
| 1226 | * rtson -- Turn on RTS line
|
---|
| 1227 | * ----- ----------------
|
---|
| 1228 | rtson: move.b cfr1(a0),d0 * Pick up CFR1 image
|
---|
| 1229 | bclr #0,d0 * Turn on RTS line (active low)
|
---|
| 1230 | bset #7,d0 * Make sure MS bit is set
|
---|
| 1231 | move.b d0,cfr1(a0) * Update CFR1 image
|
---|
| 1232 | move.b d0,ACIA_CFR(a1) * Send CFR to hardware
|
---|
| 1233 | rts * Return to caller
|
---|
| 1234 | *
|
---|
| 1235 | * rtsoff -- Turn off RTS line
|
---|
| 1236 | * ------ -----------------
|
---|
| 1237 | rtsoff: move.b cfr1(a0),d0 * Pick up CFR1 image
|
---|
| 1238 | bset #0,d0 * Turn off RTS line (active low)
|
---|
| 1239 | bset #7,d0 * Make sure MS bit is set
|
---|
| 1240 | move.b d0,cfr1(a0) * Update CFR1 image
|
---|
| 1241 | move.b d0,ACIA_CFR(a1) * Send CFR to hardware
|
---|
| 1242 | rts
|
---|
| 1243 | *
|
---|
| 1244 | .page
|
---|
| 1245 | *
|
---|
| 1246 | * __MTInt5 -- Serial (Serial-1, Serial-2, MIDI-1, MIDI-2) interrupt handler
|
---|
| 1247 | * -------- -------------------------------------------------------------
|
---|
| 1248 | *
|
---|
| 1249 | __MTInt5: pea MT_ISEM5 * Wait for an interrupt
|
---|
| 1250 | jsr SM_Wait * ...
|
---|
| 1251 | tst.l (a7)+ * ...
|
---|
| 1252 | *
|
---|
| 1253 | lea _sr1_ior,a0 * Point at Serial-1 iorec
|
---|
| 1254 | lea SR1ACIA,a1 * Point at Serial-1 ACIA
|
---|
| 1255 | bsr serint * Go process possible int.
|
---|
| 1256 | *
|
---|
| 1257 | lea _sr2_ior,a0 * Point at Serial-2 iorec
|
---|
| 1258 | lea SR2ACIA,a1 * Point at Serial-2 ACIA
|
---|
| 1259 | bsr serint * Go process possible int.
|
---|
| 1260 | *
|
---|
| 1261 | lea _mc1_ior,a0 * Point at MIDI-1 iorec
|
---|
| 1262 | lea MC1ACIA,a1 * Point at MIDI-1 ACIA
|
---|
| 1263 | bsr midint * Go process possible int.
|
---|
| 1264 | *
|
---|
| 1265 | lea _mc2_ior,a0 * Point at MIDI-2 iorec
|
---|
| 1266 | lea MC2ACIA,a1 * Point at MIDI-2 ACIA
|
---|
| 1267 | bsr midint * Go process possible int.
|
---|
| 1268 | *
|
---|
| 1269 | bra __MTInt5 * Go wait for next interrupt
|
---|
| 1270 | *
|
---|
| 1271 | .page
|
---|
| 1272 | *
|
---|
| 1273 | * serint -- Process an interrupt from Serial-1 or Serial-2
|
---|
| 1274 | * ------ ----------------------------------------------
|
---|
| 1275 | serint: move.b ACIA_ISR(a1),isr(a0) * Get and save ISR
|
---|
| 1276 | move.b ACIA_CSR(a1),csr(a0) * Get and save CSR
|
---|
| 1277 | *
|
---|
| 1278 | btst.b #7,isr(a0) * Was int for this device ?
|
---|
| 1279 | beq serintx * Jump if not
|
---|
| 1280 | *
|
---|
| 1281 | serchk: btst.b #1,isr(a0) * FRM/OVR/BRK error ?
|
---|
| 1282 | bne sererr * Jump if so
|
---|
| 1283 | *
|
---|
| 1284 | btst.b #0,isr(a0) * Receiver interrupt ?
|
---|
| 1285 | bne serrx * Jump if so
|
---|
| 1286 | *
|
---|
| 1287 | sertxq: btst.b #6,isr(a0) * Transmitter interrupt ?
|
---|
| 1288 | bne sertx * Jump if so
|
---|
| 1289 | *
|
---|
| 1290 | serctq: btst.b #5,isr(a0) * CTS interrupt ?
|
---|
| 1291 | bne sercts * Jump if so
|
---|
| 1292 | *
|
---|
| 1293 | serintx: rts * Return to caller
|
---|
| 1294 | *
|
---|
| 1295 | sererr: addq.w #1,errct(a0) * Update error count
|
---|
| 1296 | move.b ACIA_RDR(a1),erbyte(a0) * Get error byte (clears ACIA)
|
---|
| 1297 | rts
|
---|
| 1298 | *
|
---|
| 1299 | * Handle CTS interrupt
|
---|
| 1300 | *
|
---|
| 1301 | sercts: btst.b #1,linedisc(a0) * RTS/CTS mode ?
|
---|
| 1302 | beq serintx * Ignore if not
|
---|
| 1303 | *
|
---|
| 1304 | sercts1: move.b ACIA_ISR(a1),isr(a0) * Get and save ISR
|
---|
| 1305 | btst.b #6,isr(a0) * TDRE set ?
|
---|
| 1306 | beq sercts1 * Loop until it is (!)
|
---|
| 1307 | *
|
---|
| 1308 | move.w obufhd(a0),d2 * Head index to d2
|
---|
| 1309 | cmp.w obuftl(a0),d2 * Compare to tail index
|
---|
| 1310 | beq serintx * Done if buffer empty
|
---|
| 1311 | *
|
---|
| 1312 | pea out_nf(a0) * Signal output FIFO 'not full'
|
---|
| 1313 | jsr SM_Sig * ...
|
---|
| 1314 | tst.l (a7)+ * ...
|
---|
| 1315 | bsr wrapout * Adjust pointer for wraparound
|
---|
| 1316 | move.l obuf(a0),a2 * Get buffer base in a2
|
---|
| 1317 | move.b 0(a2,d2),ACIA_TDR(a1) * Send byte on its way
|
---|
| 1318 | move.w d2,obufhd(a0) * Save updated head index
|
---|
| 1319 | rts
|
---|
| 1320 | *
|
---|
| 1321 | .page
|
---|
| 1322 | *
|
---|
| 1323 | * Handle receiver interrupt
|
---|
| 1324 | *
|
---|
| 1325 | serrx: btst.b #1,linedisc(a0) * RTS/CTS mode set ?
|
---|
| 1326 | beq serrx1 * Jump if not
|
---|
| 1327 | *
|
---|
| 1328 | bsr rtsoff * Turn off RTS
|
---|
| 1329 | *
|
---|
| 1330 | serrx1: move.b ACIA_RDR(a1),d0 * Read data from ACIA
|
---|
| 1331 | btst.b #1,linedisc(a0) * RTS/CTS mode set ?
|
---|
| 1332 | bne serrx3 * Jump if so
|
---|
| 1333 | *
|
---|
| 1334 | btst.b #0,linedisc(a0) * XON/XOFF mode set ?
|
---|
| 1335 | beq serrx3 * Jump if not
|
---|
| 1336 | *
|
---|
| 1337 | cmpi.b #$11,d0 * Is this an XON ?
|
---|
| 1338 | bne serrx2 * Jump if not
|
---|
| 1339 | *
|
---|
| 1340 | move.b #$00,flagxoff(a0) * Clear flagxoff
|
---|
| 1341 | bra sertxq * Done
|
---|
| 1342 | *
|
---|
| 1343 | serrx2: cmpi.b #$13,d0 * Is this an XOFF ?
|
---|
| 1344 | bne serrx3 * Jump if not
|
---|
| 1345 | *
|
---|
| 1346 | move.b #$FF,flagxoff(a0) * Set flagxoff
|
---|
| 1347 | bra sertxq * Done
|
---|
| 1348 | *
|
---|
| 1349 | .page
|
---|
| 1350 | *
|
---|
| 1351 | serrx3: move.w ibuftl(a0),d1 * Get tail index in d1
|
---|
| 1352 | bsr wrapin * Adjust for wraparound
|
---|
| 1353 | cmp.w ibufhd(a0),d1 * Head = tail ?
|
---|
| 1354 | beq seribf * If so, we drop the character
|
---|
| 1355 | *
|
---|
| 1356 | pea inp_ne(a0) * Signal input FIFO 'not empty'
|
---|
| 1357 | jsr SM_Sig * ...
|
---|
| 1358 | tst.l (a7)+ * ...
|
---|
| 1359 | move.l ibuf(a0),a2 * Get buffer address
|
---|
| 1360 | move.b d0,0(a2,d1) * Stash byte in buffer
|
---|
| 1361 | move.w d1,ibuftl(a0) * Save updated tail index
|
---|
| 1362 | bsr rsilen * Get length of buffer used
|
---|
| 1363 | cmp.w ibufhi(a0),d2 * Hit high water mark ?
|
---|
| 1364 | bne serrx4 * Jump if not
|
---|
| 1365 | *
|
---|
| 1366 | btst.b #1,linedisc(a0) * RTS/CTS mode set ?
|
---|
| 1367 | bne sertxq * Done if so
|
---|
| 1368 | *
|
---|
| 1369 | btst.b #0,linedisc(a0) * XON/XOFF mode set ?
|
---|
| 1370 | beq serrx4 * Jump if not
|
---|
| 1371 | *
|
---|
| 1372 | tst.b flagxon(a0) * XOFF already sent ?
|
---|
| 1373 | bne serrx4 * Jump if so
|
---|
| 1374 | *
|
---|
| 1375 | move.b #$FF,flagxon(a0) * Set the flag
|
---|
| 1376 | *
|
---|
| 1377 | serrx3a: move.b #$13,d1 * Send an XOFF
|
---|
| 1378 | bsr serput * ...
|
---|
| 1379 | bcs serrx3a * ...
|
---|
| 1380 | *
|
---|
| 1381 | .page
|
---|
| 1382 | *
|
---|
| 1383 | serrx4: btst #1,linedisc(a0) * RTS/CTS mode set ?
|
---|
| 1384 | beq sertxq * Done if not
|
---|
| 1385 | *
|
---|
| 1386 | bsr rtson * Turn on RTS
|
---|
| 1387 | bra sertxq
|
---|
| 1388 | *
|
---|
| 1389 | * Handle transmitter interrupt
|
---|
| 1390 | *
|
---|
| 1391 | sertx: btst.b #1,linedisc(a0) * RTS/CTS mode set ?
|
---|
| 1392 | bne sertx2 * If so, go check CTS
|
---|
| 1393 | *
|
---|
| 1394 | btst.b #0,linedisc(a0) * XON/XOFF mode set ?
|
---|
| 1395 | beq sertx1 * Jump if not
|
---|
| 1396 | *
|
---|
| 1397 | tst.b flagxoff(a0) * Check flagxoff
|
---|
| 1398 | bne serctq * Done if set
|
---|
| 1399 | *
|
---|
| 1400 | sertx1: move.w obufhd(a0),d2 * Head index to d2
|
---|
| 1401 | cmp.w obuftl(a0),d2 * Compare to tail index
|
---|
| 1402 | beq serctq * Done if buffer empty
|
---|
| 1403 | *
|
---|
| 1404 | pea out_nf(a0) * Signal output FIFO 'not-full'
|
---|
| 1405 | jsr SM_Sig * ...
|
---|
| 1406 | tst.l (a7)+ * ...
|
---|
| 1407 | bsr wrapout * Adjust pointer for wraparound
|
---|
| 1408 | move.l obuf(a0),a2 * Get buffer base address
|
---|
| 1409 | move.b 0(a2,d2),ACIA_TDR(a1) * Send byte on its way
|
---|
| 1410 | move.w d2,obufhd(a0) * Save updated head index
|
---|
| 1411 | bra serctq * Done
|
---|
| 1412 | *
|
---|
| 1413 | sertx2: btst.b #5,csr(a0) * CTS set in csr ?
|
---|
| 1414 | beq serctq * If not, go check for CTS int
|
---|
| 1415 | *
|
---|
| 1416 | bra sertx1 * CTS was set, go transmit
|
---|
| 1417 | *
|
---|
| 1418 | seribf: move.b d0,erbyte(a0) * Log dropped character
|
---|
| 1419 | addq.w #1,ibfct(a0) * ...
|
---|
| 1420 | bra sertxq * Go check Tx interrupt
|
---|
| 1421 | *
|
---|
| 1422 | .page
|
---|
| 1423 | *
|
---|
| 1424 | * midint -- Process an interrupt from MIDI-1 or MIDI-2
|
---|
| 1425 | * ------ ------------------------------------------
|
---|
| 1426 | midint: move.b ACIA_ISR(a1),isr(a0) * Get and save ISR
|
---|
| 1427 | move.b ACIA_CSR(a1),csr(a0) * Get and save CSR
|
---|
| 1428 | *
|
---|
| 1429 | btst.b #7,isr(a0) * Was int for this device ?
|
---|
| 1430 | beq midintx * Jump if not
|
---|
| 1431 | *
|
---|
| 1432 | midchk: btst.b #1,isr(a0) * FRM/OVR/BRK error ?
|
---|
| 1433 | bne miderr * Jump if so
|
---|
| 1434 | *
|
---|
| 1435 | btst.b #0,isr(a0) * Receiver interrupt ?
|
---|
| 1436 | bne midrx * Jump if so
|
---|
| 1437 | *
|
---|
| 1438 | midtxq: btst.b #6,isr(a0) * Transmitter interrupt ?
|
---|
| 1439 | bne midtx * Jump if so
|
---|
| 1440 | *
|
---|
| 1441 | midintx: rts * Return to caller
|
---|
| 1442 | *
|
---|
| 1443 | miderr: addq.w #1,errct(a0) * Update error count
|
---|
| 1444 | move.b ACIA_RDR(a1),erbyte(a0) * Get error byte
|
---|
| 1445 | rts
|
---|
| 1446 | *
|
---|
| 1447 | .page
|
---|
| 1448 | *
|
---|
| 1449 | * Handle receiver interrupt
|
---|
| 1450 | *
|
---|
| 1451 | midrx: move.b ACIA_RDR(a1),d0 * Read data from ACIA
|
---|
| 1452 | move.w ibuftl(a0),d1 * Get tail index in d1
|
---|
| 1453 | bsr wrapin * Adjust for wraparound
|
---|
| 1454 | cmp.w ibufhd(a0),d1 * Head = tail ?
|
---|
| 1455 | beq midibf * If so, we drop the character
|
---|
| 1456 | *
|
---|
| 1457 | pea inp_ne(a0) * Signal input FIFO 'not-empty'
|
---|
| 1458 | jsr SM_Sig * ...
|
---|
| 1459 | tst.l (a7)+ * ...
|
---|
| 1460 | move.l ibuf(a0),a2 * Get buffer address
|
---|
| 1461 | move.b d0,0(a2,d1) * Stash byte in buffer
|
---|
| 1462 | move.w d1,ibuftl(a0) * Save updated tail index
|
---|
| 1463 | bra midtxq * Done (go check tx int)
|
---|
| 1464 | *
|
---|
| 1465 | * Handle transmitter interrupt
|
---|
| 1466 | *
|
---|
| 1467 | midtx: move.w obufhd(a0),d2 * Head index to d2
|
---|
| 1468 | cmp.w obuftl(a0),d2 * Compare to tail index
|
---|
| 1469 | beq midintx * Done if buffer empty
|
---|
| 1470 | *
|
---|
| 1471 | pea out_nf(a0) * Signal output FIFO 'not-full'
|
---|
| 1472 | jsr SM_Sig * ...
|
---|
| 1473 | tst.l (a7)+ * ...
|
---|
| 1474 | bsr wrapout * Adjust pointer for wraparound
|
---|
| 1475 | move.l obuf(a0),a2 * Get buffer base address
|
---|
| 1476 | move.b 0(a2,d2),ACIA_TDR(a1) * Send byte on its way
|
---|
| 1477 | move.w d2,obufhd(a0) * Save updated head index
|
---|
| 1478 | bra midintx * Done
|
---|
| 1479 | *
|
---|
| 1480 | midibf: move.b d0,erbyte(a0) * Log dropped character
|
---|
| 1481 | addq.w #1,ibfct(a0) * ...
|
---|
| 1482 | bra midtxq * Go check Tx interrupt
|
---|
| 1483 | *
|
---|
| 1484 | .page
|
---|
| 1485 | *
|
---|
| 1486 | * setexec -- Set an exception vector
|
---|
| 1487 | * ------- -----------------------
|
---|
| 1488 | setexec: move.w 4(a7),d0 * Get vector number
|
---|
| 1489 | lsl.w #2,d0 * .. times 4
|
---|
| 1490 | sub.l a0,a0 * Clear a0
|
---|
| 1491 | lea 0(a0,d0),a0 * Get address of old vector
|
---|
| 1492 | move.l (a0),d0 * Move old vector to d0
|
---|
| 1493 | move.l 6(a7),d1 * Pick up new vector
|
---|
| 1494 | bmi setexec1 * Don't set if = -1
|
---|
| 1495 | *
|
---|
| 1496 | move.l d1,(a0) * Set new vector
|
---|
| 1497 | *
|
---|
| 1498 | setexec1: rts * Return to caller
|
---|
| 1499 | *
|
---|
| 1500 | * piorec -- Get pointer to iorec structure
|
---|
| 1501 | * ------ ------------------------------
|
---|
| 1502 | piorec: moveq.l #0,d1 * Clear out d1
|
---|
| 1503 | move.w 4(a7),d1 * Get device number
|
---|
| 1504 | move.w sr,-(a7) * Save status register
|
---|
| 1505 | ori.w #IPL7,sr * Set IPL = 7 (no ints)
|
---|
| 1506 | lea aciatab,a2 * Get base address of table
|
---|
| 1507 | asl.l #3,d1 * Device # times 8 for index
|
---|
| 1508 | move.l 0(a2,d1),d0 * Get iorec address from table
|
---|
| 1509 | move.w (a7)+,sr * Restore status register
|
---|
| 1510 | rts * Return to caller
|
---|
| 1511 | *
|
---|
| 1512 | .page
|
---|
| 1513 | *
|
---|
| 1514 | * setport -- Set ACIA parameters (unit, mode, baud, CFR0, CFR1)
|
---|
| 1515 | * ------- ---------------------------------------------------
|
---|
| 1516 | setport: moveq.l #0,d1 * Clear out d1
|
---|
| 1517 | move.w 4(a7),d1 * Get device number
|
---|
| 1518 | asl.l #3,d1 * Times 8 for index
|
---|
| 1519 | ori.w #IPL7,sr * Set IPL = 7 (no ints)
|
---|
| 1520 | lea aciatab,a2 * Get base of table
|
---|
| 1521 | move.l 0(a2,d1),d0 * Get iorec address
|
---|
| 1522 | move.l 4(a2,d1),d2 * Get ACIA address
|
---|
| 1523 | movea.l d0,a0 * Setup a0 = iorec address
|
---|
| 1524 | movea.l d2,a1 * Setup a1 = ACIA address
|
---|
| 1525 | tst.w 6(a7) * Change mode ?
|
---|
| 1526 | bmi setpt1 * Jump if not
|
---|
| 1527 | *
|
---|
| 1528 | move.b 7(a7),linedisc(a0) * Set line discipline (mode)
|
---|
| 1529 | *
|
---|
| 1530 | setpt1: tst.w 8(a7) * Change baud rate ?
|
---|
| 1531 | bmi setpt2 * Jump if not
|
---|
| 1532 | *
|
---|
| 1533 | moveq.l #0,d1 * Clear out d1
|
---|
| 1534 | move.w 8(a7),d1 * Get baud rate index
|
---|
| 1535 | lea brtable,a2 * Get base of baud rate table
|
---|
| 1536 | move.b 0(a2,d1),d2 * Get baud rate code from table
|
---|
| 1537 | move.b cfr0(a0),d0 * Get current CFR0
|
---|
| 1538 | andi.w #$0070,d0 * Mask off old baud rate code
|
---|
| 1539 | or.w d2,d0 * OR in new baud rate code
|
---|
| 1540 | move.b d0,cfr0(a0) * Update CFR0 in table
|
---|
| 1541 | move.b d0,ACIA_CFR(a1) * Update hardware
|
---|
| 1542 | *
|
---|
| 1543 | setpt2: tst.w 10(a7) * Change CFR0 ?
|
---|
| 1544 | bmi setpt3 * Jump if not
|
---|
| 1545 | *
|
---|
| 1546 | move.b 11(a7),cfr0(a0) * Update CFR0 in table
|
---|
| 1547 | move.b cfr0(a0),ACIA_CFR(a1) * Update CFR0 in hardware
|
---|
| 1548 | *
|
---|
| 1549 | setpt3: tst.w 12(a7) * Change CFR1 ?
|
---|
| 1550 | bmi setpt4 * Jump if not
|
---|
| 1551 | *
|
---|
| 1552 | bset.b #7,13(a7) * Force D7 = 1 in argument
|
---|
| 1553 | move.b 13(a7),cfr1(a0) * Update CFR1 in table
|
---|
| 1554 | move.b cfr1(a0),ACIA_CFR(a1) * Update CFR1 in hardware
|
---|
| 1555 | *
|
---|
| 1556 | setpt4: rts * Return to caller
|
---|
| 1557 | *
|
---|
| 1558 | .page
|
---|
| 1559 | *
|
---|
| 1560 | * aciainit -- Initialize an ACIA port
|
---|
| 1561 | * -------- -----------------------
|
---|
| 1562 | aciainit: move.w #IORECLN,d0 * Setup byte count for move
|
---|
| 1563 | move.l a0,-(a7) * Save iorec base
|
---|
| 1564 | *
|
---|
| 1565 | aciai_1: move.b (a2)+,(a0)+ * Move the default to the iorec
|
---|
| 1566 | dbf d0,aciai_1 * ...
|
---|
| 1567 | *
|
---|
| 1568 | move.l (a7)+,a0 * Restore iorec base
|
---|
| 1569 | move.b cfr0(a0),ACIA_CFR(a1) * Setup CFR0
|
---|
| 1570 | move.b cfr1(a0),ACIA_CFR(a1) * Setup CFR1
|
---|
| 1571 | move.b ACIA_RDR(a1),d0 * Clear RDR
|
---|
| 1572 | move.b #$7F,ACIA_IER(a1) * Disable all interrupts
|
---|
| 1573 | btst.b #1,linedisc(a0) * Are we in RTS/CTS mode ?
|
---|
| 1574 | bne aciai_2 * Jump if so
|
---|
| 1575 | *
|
---|
| 1576 | move.b #$C3,ACIA_IER(a1) * Enable TDRE, RDRF
|
---|
| 1577 | bra aciai_3 * Go return
|
---|
| 1578 | *
|
---|
| 1579 | aciai_2: move.b #$E3,ACIA_IER(a1) * Enable interrupts we want
|
---|
| 1580 | *
|
---|
| 1581 | aciai_3: rts * Return to caller
|
---|
| 1582 | *
|
---|
| 1583 | * fastcopy -- Copy disk sector quickly
|
---|
| 1584 | * -------- ------------------------
|
---|
| 1585 | fastcopy: move.l 4(a7),a0 * Get source pointer
|
---|
| 1586 | move.l 8(a7),a1 * Get destination pointer
|
---|
| 1587 | move.w $3F,d0 * 512 bytes (63+1)*8
|
---|
| 1588 | *
|
---|
| 1589 | fastcpy1: move.b (a0)+,(a1)+ * Move 8 bytes
|
---|
| 1590 | move.b (a0)+,(a1)+ * ...
|
---|
| 1591 | move.b (a0)+,(a1)+ * ...
|
---|
| 1592 | move.b (a0)+,(a1)+ * ...
|
---|
| 1593 | move.b (a0)+,(a1)+ * ...
|
---|
| 1594 | move.b (a0)+,(a1)+ * ...
|
---|
| 1595 | move.b (a0)+,(a1)+ * ...
|
---|
| 1596 | move.b (a0)+,(a1)+ * ...
|
---|
| 1597 | dbra d0,fastcpy1 * Loop until all bytes are moved
|
---|
| 1598 | *
|
---|
| 1599 | rts * Return to caller
|
---|
| 1600 | *
|
---|
| 1601 | .page
|
---|
| 1602 | *
|
---|
| 1603 | * _hdvini -- Drive initialization
|
---|
| 1604 | * ------- --------------------
|
---|
| 1605 | _hdvini: link a6,#-18 * Reserve space on stack
|
---|
| 1606 | movem.l d3-d7/a3-a5,-(a7) * Preserve registers
|
---|
| 1607 | move.l #300,maxactim * maxactim = 300 * 20ms
|
---|
| 1608 | clr.w d0 * Put zeros in ...
|
---|
| 1609 | move.w d0,nflops * ... nflops
|
---|
| 1610 | move.w d0,dskmode * ... dskmode
|
---|
| 1611 | move.w d0,-2(a6) * Start with drive A
|
---|
| 1612 | bra hdvilp * ...
|
---|
| 1613 | *
|
---|
| 1614 | hdvilp1: movea.l #dskmode,a0 * Get dskmode address in a0
|
---|
| 1615 | movea.w -2(a6),a1 * Drive number in a1
|
---|
| 1616 | adda.l a1,a0 * Point at dskmode for drive
|
---|
| 1617 | clr.b (a0) * Clear flag in dskmode
|
---|
| 1618 | clr.w -(a7) * Push arguments onto stack
|
---|
| 1619 | clr.w -(a7) * ...
|
---|
| 1620 | clr.w -(a7) * ...
|
---|
| 1621 | move.w -2(a6),-(a7) * Push drive number onto stack
|
---|
| 1622 | clr.l -(a7) * ... filler
|
---|
| 1623 | clr.l -(a7) * ... filler
|
---|
| 1624 | jsr flopini * Initialize drive
|
---|
| 1625 | adda.l #16,a7 * Cleanup stack
|
---|
| 1626 | move.w d0,-(a7) * Save error code on stack
|
---|
| 1627 | movea.w -2(a6),a0 * Get drive number
|
---|
| 1628 | adda.l a0,a0 * ... times 2
|
---|
| 1629 | adda.l #dskerrs,a0 * Add base of dskerrs
|
---|
| 1630 | move.w (a7)+,(a0) * Move error code off of stack
|
---|
| 1631 | bne hdvind * Jump if drive not present
|
---|
| 1632 | *
|
---|
| 1633 | addq.w #1,nflops * Update number of drives
|
---|
| 1634 | or.l #3,drvbits * Setup drive bits
|
---|
| 1635 | *
|
---|
| 1636 | hdvind: addq.w #1,-2(a6) * Increment drive number
|
---|
| 1637 | *
|
---|
| 1638 | hdvilp: cmp.w #2,-2(a6) * See if it's 2 yet
|
---|
| 1639 | blt hdvilp1 * Loop until it is
|
---|
| 1640 | *
|
---|
| 1641 | movem.l (a7)+,d3-d7/a3-a5 * Restore registers
|
---|
| 1642 | unlk a6 * Release temporary stack space
|
---|
| 1643 | rts * Return to caller
|
---|
| 1644 | *
|
---|
| 1645 | * drvmap -- get drive map
|
---|
| 1646 | * ------ -------------
|
---|
| 1647 | drvmap: move.l drvbits,d0 * Get drive bits
|
---|
| 1648 | rts * Return to caller
|
---|
| 1649 | *
|
---|
| 1650 | .page
|
---|
| 1651 | *
|
---|
| 1652 | * getbpb -- get BIOS parameter block
|
---|
| 1653 | * ------ ------------------------
|
---|
| 1654 | getbpb: link a6,#-12 * Reserve space for temporaries
|
---|
| 1655 | movem.l d5-d7/a4-a5,-(a7) * Save registers on stack
|
---|
| 1656 | cmp.w #2,8(a6) * Check drive number
|
---|
| 1657 | bcs gbpb1 * Jump if OK
|
---|
| 1658 | *
|
---|
| 1659 | moveq.l #0,d0 * Set drive number to 0
|
---|
| 1660 | bra gbpber * Go flag error
|
---|
| 1661 | *
|
---|
| 1662 | gbpb1: move.w 8(a6),d0 * Get drive number
|
---|
| 1663 | asl.w #5,d0 * ... times 32
|
---|
| 1664 | ext.l d0 * ... extend sign
|
---|
| 1665 | move.l d0,a5 * Move to a5
|
---|
| 1666 | add.l #drvbpbs,a5 * Add base of drive bpb are
|
---|
| 1667 | move.l a5,a4 * Save in a4
|
---|
| 1668 | *
|
---|
| 1669 | gbpbrds: move.w #1,(a7) * floprd count = 1,
|
---|
| 1670 | clr.w -(a7) * ... side = 0,
|
---|
| 1671 | clr.w -(a7) * ... track = 0,
|
---|
| 1672 | move.w #1,-(a7) * ... sector = 1,
|
---|
| 1673 | move.w 8(a6),-(a7) * ... drive #,
|
---|
| 1674 | clr.l -(a7) * ... filler
|
---|
| 1675 | move.l #buffer,-(a7) * ... buffer address,
|
---|
| 1676 | jsr floprd * Go read the sector
|
---|
| 1677 | add.l #16,a7 * Cleanup stack
|
---|
| 1678 | move.l d0,-12(a6) * Save error code
|
---|
| 1679 | tst.l -12(a6) * ... and test it
|
---|
| 1680 | bge gbpb2 * Jump if OK
|
---|
| 1681 | *
|
---|
| 1682 | move.w 8(a6),(a7) * Put drive number on stack
|
---|
| 1683 | move.l -12(a6),d0 * Get error code
|
---|
| 1684 | move.w d0,-(a7) * ... and put it on the stack
|
---|
| 1685 | jsr criterr * Go do critical error routine
|
---|
| 1686 | addq.l #2,a7 * Cleanup stack
|
---|
| 1687 | move.l d0,-12(a6) * Save error code
|
---|
| 1688 | *
|
---|
| 1689 | gbpb2: move.l -12(a6),d0 * Get error code
|
---|
| 1690 | cmp.l #RETRYIT,d0 * Magic number for retry ?
|
---|
| 1691 | beq gbpbrds * Re-read if so
|
---|
| 1692 | *
|
---|
| 1693 | tst.l -12(a6) * Test error code
|
---|
| 1694 | bge gbpb3 * Jump if OK
|
---|
| 1695 | *
|
---|
| 1696 | moveq.l #0,d0 * Set code in d0
|
---|
| 1697 | bra gbpber * Go set error code
|
---|
| 1698 | *
|
---|
| 1699 | .page
|
---|
| 1700 | *
|
---|
| 1701 | gbpb3: move.l #buffer+11,(a7) * Bytes per sector
|
---|
| 1702 | bsr itom * Convert 8086 to 68K format
|
---|
| 1703 | move.w d0,d7 * Save bytes per sector
|
---|
| 1704 | beq gbpb4 * Jump if zero
|
---|
| 1705 | *
|
---|
| 1706 | move.b buffer+13,d6 * Sectors per cluster
|
---|
| 1707 | ext.w d6 * ... sign extended
|
---|
| 1708 | and.w #$FF,d6 * ... and trimmed
|
---|
| 1709 | bne gbpb5 * Jump if non-zero
|
---|
| 1710 | *
|
---|
| 1711 | gbpb4: moveq.l #0,d0 * Set error code
|
---|
| 1712 | bra gbpber * ...
|
---|
| 1713 | *
|
---|
| 1714 | gbpb5: move.w d7,(a4) * Set recsize
|
---|
| 1715 | move.w d6,2(a4) * Set clsiz
|
---|
| 1716 | move.l #buffer+22,(a7) * Convert sectors per fat
|
---|
| 1717 | bsr itom * ...
|
---|
| 1718 | move.w d0,8(a4) * Set fsiz
|
---|
| 1719 | move.w 8(a4),d0 * Get fsiz
|
---|
| 1720 | addq.w #1,d0 * ... plus 1
|
---|
| 1721 | move.w d0,10(a4) * Set fatrec
|
---|
| 1722 | move.w (a4),d0 * Get recsize
|
---|
| 1723 | muls.w 2(a4),d0 * ... times clsiz
|
---|
| 1724 | move.w d0,4(a4) * Set clsizb
|
---|
| 1725 | move.l #buffer+17,(a7) * Convert number of dir ents
|
---|
| 1726 | bsr itom * ...
|
---|
| 1727 | asl.w #5,d0 * ... times 32
|
---|
| 1728 | ext.l d0 * ... sign extended
|
---|
| 1729 | divs.w (a4),d0 * ... / recsize
|
---|
| 1730 | move.w d0,6(a4) * Set rdlen
|
---|
| 1731 | move.w 10(a4),d0 * Get fatrec
|
---|
| 1732 | add.w 6(a4),d0 * ... + rdlen
|
---|
| 1733 | add.w 8(a4),d0 * ... + fsiz
|
---|
| 1734 | move.w d0,12(a4) * Set datrec
|
---|
| 1735 | move.l #buffer+19,(a7) * Get number of sectors
|
---|
| 1736 | bsr itom * ... convert
|
---|
| 1737 | sub.w 12(a4),d0 * ... - datrec
|
---|
| 1738 | ext.l d0 * ... sign extended
|
---|
| 1739 | divs.w 2(a4),d0 * ... / clsiz
|
---|
| 1740 | move.w d0,14(a4) * Set numcl
|
---|
| 1741 | *
|
---|
| 1742 | .page
|
---|
| 1743 | *
|
---|
| 1744 | move.l #buffer+26,(a7) * Convert number of heads
|
---|
| 1745 | bsr itom * ...
|
---|
| 1746 | move.w d0,20(a5) * Set dnsides
|
---|
| 1747 | move.l #buffer+24,(a7) * Convert sectors per track
|
---|
| 1748 | bsr itom * ...
|
---|
| 1749 | move.w d0,24(a5) * Set dspt
|
---|
| 1750 | move.w 20(a5),d0 * Get dnsides
|
---|
| 1751 | muls.w 24(a5),d0 * ... * dspt
|
---|
| 1752 | move.w d0,22(a5) * Set dspc
|
---|
| 1753 | move.l #buffer+28,(a7) * Convert number of hidden sects
|
---|
| 1754 | bsr itom * ...
|
---|
| 1755 | move.w d0,26(a5) * Set dhidden
|
---|
| 1756 | move.l #buffer+19,(a7) * Convert sectors on disk
|
---|
| 1757 | bsr itom * ...
|
---|
| 1758 | ext.l d0 * ... sign extended
|
---|
| 1759 | divs.w 22(a5),d0 * ... / dspc
|
---|
| 1760 | move.w d0,18(a5) * Set dntracks
|
---|
| 1761 | clr.w d7 * Counter = 0
|
---|
| 1762 | bra gbpblpt * Jump to end of loop
|
---|
| 1763 | *
|
---|
| 1764 | gbpb6: move.l a5,a0 * Get buffer pointer
|
---|
| 1765 | move.w d7,a1 * Loop count to a1
|
---|
| 1766 | add.l a1,a0 * ... + bpb address
|
---|
| 1767 | move.w d7,a1 * Loop count to a1
|
---|
| 1768 | add.l #buffer,a1 * ... + buffer address
|
---|
| 1769 | move.b 8(a1),28(a0) * Copy a s/n byte
|
---|
| 1770 | addq.w #1,d7 * Update loop count
|
---|
| 1771 | *
|
---|
| 1772 | gbpblpt: cmp.w #3,d7 * Moved 3 bytes ?
|
---|
| 1773 | blt gbpb6 * Loop if not
|
---|
| 1774 | *
|
---|
| 1775 | .page
|
---|
| 1776 | *
|
---|
| 1777 | move.l #cdev,a0 * Address of cdev table
|
---|
| 1778 | move.w 8(a6),a1 * ... plus drive number
|
---|
| 1779 | add.l a1,a0 * ... to a0
|
---|
| 1780 | move.l #wpstatus,a1 * Address of wpstatus table
|
---|
| 1781 | move.w 8(a6),a2 * ... plus drive number
|
---|
| 1782 | add.l a2,a1 * ... to a1
|
---|
| 1783 | move.b (a1),(a0) * Move wpstatus to cdev
|
---|
| 1784 | beq gbpb7
|
---|
| 1785 | *
|
---|
| 1786 | moveq.l #1,d0 * Set status = "Uncertain"
|
---|
| 1787 | bra gbpb8
|
---|
| 1788 | *
|
---|
| 1789 | gbpb7: clr.w d0 * Set status = "Unchanged"
|
---|
| 1790 | *
|
---|
| 1791 | gbpb8: move.l #dskmode,a1 * Update dskmode table
|
---|
| 1792 | move.w 8(a6),a2 * ...
|
---|
| 1793 | add.l a2,a1 * ...
|
---|
| 1794 | move.b d0,(a1) * ...
|
---|
| 1795 | move.l a5,d0 * Setup to return bpb pointer
|
---|
| 1796 | *
|
---|
| 1797 | gbpber: tst.l (a7)+ * Pop garbage off top of stack
|
---|
| 1798 | movem.l (a7)+,d6-d7/a4-a5 * Restore registers
|
---|
| 1799 | unlk a6
|
---|
| 1800 | rts
|
---|
| 1801 | *
|
---|
| 1802 | .page
|
---|
| 1803 | *
|
---|
| 1804 | * mediach -- check for media change
|
---|
| 1805 | * ------- ----------------------
|
---|
| 1806 | mediach: link a6,#0 * Create scratch on stack
|
---|
| 1807 | movem.l d6-d7/a5,-(a7) * Save registers on stack
|
---|
| 1808 | cmp.w #2,8(a6) * Check drive number
|
---|
| 1809 | bcs media1 * Jump if OK
|
---|
| 1810 | *
|
---|
| 1811 | moveq.l #ERR15,d0 * Error -- "unknown device"
|
---|
| 1812 | bra media2 * ...
|
---|
| 1813 | *
|
---|
| 1814 | media1: move.w 8(a6),d7 * Get drive number in d7
|
---|
| 1815 | movea.w d7,a5 * Point into dskmode table
|
---|
| 1816 | add.l #dskmode,a5 * ...
|
---|
| 1817 | cmp.b #2,(a5) * Definitely changed ?
|
---|
| 1818 | bne media3 * Jump if not
|
---|
| 1819 | *
|
---|
| 1820 | moveq.l #2,d0 * Setup to return "Changed"
|
---|
| 1821 | bra media2 * Done -- go return to caller
|
---|
| 1822 | *
|
---|
| 1823 | media3: move.l #wplatch,a0 * Check wplatch for drive
|
---|
| 1824 | tst.b 0(a0,d7) * ...
|
---|
| 1825 | beq media4 * Jump if not set
|
---|
| 1826 | *
|
---|
| 1827 | move.b #1,(a5) * Set dskmode to "Uncertain"
|
---|
| 1828 | *
|
---|
| 1829 | media4: move.l _hz_200,d0 * Get time in d0
|
---|
| 1830 | movea.w d7,a1 * Calculate acctim table address
|
---|
| 1831 | add.l a1,a1 * ... = drive # * 4
|
---|
| 1832 | add.l a1,a1 * ...
|
---|
| 1833 | add.l #acctim,a1 * ... + acctim base address
|
---|
| 1834 | move.l (a1),d1 * Get acctim for drive
|
---|
| 1835 | sub.l d1,d0 * Subtract from current time
|
---|
| 1836 | cmp.l maxactim,d0 * Timed out ?
|
---|
| 1837 | bge media5 * Jump if so
|
---|
| 1838 | *
|
---|
| 1839 | clr.w d0 * Setup to return "Unchanged"
|
---|
| 1840 | bra media2
|
---|
| 1841 | *
|
---|
| 1842 | media5: move.b (a5),d0 * Return status from dskmode
|
---|
| 1843 | ext.w d0
|
---|
| 1844 | *
|
---|
| 1845 | media2: tst.l (a7)+ * Pop extra stack word
|
---|
| 1846 | movem.l (a7)+,d7/a5 * Restore registers
|
---|
| 1847 | unlk a6
|
---|
| 1848 | rts * Return to caller
|
---|
| 1849 | *
|
---|
| 1850 | .page
|
---|
| 1851 | *
|
---|
| 1852 | * rwabs -- read / write sector(s)
|
---|
| 1853 | * ----- ----------------------
|
---|
| 1854 | rwabs: link a6,#-4 * Reserve stack for temps
|
---|
| 1855 | movem.l d4-d7/a5,-(a7) * Save registers on stack
|
---|
| 1856 | cmp.w #2,18(a6) * Drive number
|
---|
| 1857 | bcs rwabs1
|
---|
| 1858 | *
|
---|
| 1859 | moveq.l #ERR15,d0 * ERROR -- "unknown device"
|
---|
| 1860 | bra rwabser
|
---|
| 1861 | *
|
---|
| 1862 | rwabs1: move.w 18(a6),d6 * Save drive number
|
---|
| 1863 | cmp.w #2,8(a6) * Check rwflag
|
---|
| 1864 | bge rwabs7
|
---|
| 1865 | *
|
---|
| 1866 | move.w d6,d0
|
---|
| 1867 | asl.w #5,d0
|
---|
| 1868 | ext.l d0
|
---|
| 1869 | move.l d0,a5
|
---|
| 1870 | add.l #drvbpbs,a5
|
---|
| 1871 | move.w d6,(a7)
|
---|
| 1872 | bsr mediach * Test for media change
|
---|
| 1873 | move.w d0,d7 * Save status
|
---|
| 1874 | cmp.w #2,d7 * Disk changed ?
|
---|
| 1875 | bne rwabs2 * Jump if not
|
---|
| 1876 | *
|
---|
| 1877 | moveq.l #ERR14,d0 * ERROR -- "media changed"
|
---|
| 1878 | bra rwabser * ...
|
---|
| 1879 | *
|
---|
| 1880 | rwabs2: cmp.w #1,d7 * Disk possibly changed ?
|
---|
| 1881 | bne rwabs7
|
---|
| 1882 | *
|
---|
| 1883 | rwabs3: move.w #1,(a7) * floprd count = 1,
|
---|
| 1884 | clr.w -(a7) * ... side = 0,
|
---|
| 1885 | clr.w -(a7) * ... track = 0,
|
---|
| 1886 | move.w #1,-(a7) * ... sector = 1,
|
---|
| 1887 | move.w d6,-(a7) * ... drive number,
|
---|
| 1888 | clr.l -(a7) * ... filler,
|
---|
| 1889 | move.l #buffer,-(a7) * ... buffer address,
|
---|
| 1890 | jsr floprd * Read boot sector
|
---|
| 1891 | add.l #16,a7 * Cleanup stack
|
---|
| 1892 | move.l d0,-4(a6) * Save error number
|
---|
| 1893 | tst.l -4(a6) * ... and test it
|
---|
| 1894 | bge rwabs11 * Jump if OK
|
---|
| 1895 | *
|
---|
| 1896 | .page
|
---|
| 1897 | *
|
---|
| 1898 | move.w d6,(a7)
|
---|
| 1899 | move.l -4(a6),d0
|
---|
| 1900 | move.w d0,-(a7)
|
---|
| 1901 | jsr criterr * Call critical error code
|
---|
| 1902 | addq.l #2,a7 * Cleanup stack
|
---|
| 1903 | move.l d0,-4(a6)
|
---|
| 1904 | *
|
---|
| 1905 | rwabs11: move.l -4(a6),d0
|
---|
| 1906 | cmp.l #RETRYIT,d0
|
---|
| 1907 | beq rwabs3 * Read again
|
---|
| 1908 | *
|
---|
| 1909 | tst.l -4(a6) * Test error number
|
---|
| 1910 | bge rwabs4 * OK ?
|
---|
| 1911 | *
|
---|
| 1912 | move.l -4(a6),d0
|
---|
| 1913 | bra rwabser * ERROR
|
---|
| 1914 | *
|
---|
| 1915 | rwabs4: clr.w d7 * Clear media change status
|
---|
| 1916 | bra rwabs10
|
---|
| 1917 | *
|
---|
| 1918 | rwabs6: move.l #buffer,a0 * Address of sector buffer to a0
|
---|
| 1919 | move.b 8(a0,d7),d0 * Serial number
|
---|
| 1920 | ext.w d0
|
---|
| 1921 | move.b 28(a5,d7),d1 * Compare to old one
|
---|
| 1922 | ext.w d1
|
---|
| 1923 | cmp.w d1,d0
|
---|
| 1924 | beq rwabs5 * Jump if they're the same
|
---|
| 1925 | *
|
---|
| 1926 | moveq.l #ERR14,d0 * ERROR -- "media changed"
|
---|
| 1927 | bra rwabser
|
---|
| 1928 | *
|
---|
| 1929 | rwabs5: addq.w #1,d7 * Next byte of serial number
|
---|
| 1930 | *
|
---|
| 1931 | rwabs10: cmp.w #3,d7 * All 3 bytes checked ?
|
---|
| 1932 | blt rwabs6 * Loop if not
|
---|
| 1933 | *
|
---|
| 1934 | .page
|
---|
| 1935 | *
|
---|
| 1936 | move.w d6,a0 * Point at wplatch for drive
|
---|
| 1937 | add.l #wplatch,a0 * ...
|
---|
| 1938 | move.w d6,a1 * Point at wpstatus for drive
|
---|
| 1939 | add.l #wpstatus,a1 * ...
|
---|
| 1940 | move.b (a1),(a0) * Move wpstatus to wplatch
|
---|
| 1941 | bne rwabs9 * Jump if set
|
---|
| 1942 | *
|
---|
| 1943 | move.w d6,a0 * Set dskmode to "Unchanged"
|
---|
| 1944 | add.l #dskmode,a0 * ...
|
---|
| 1945 | clr.b (a0) * ...
|
---|
| 1946 | *
|
---|
| 1947 | rwabs7: tst.w nflops * Test nflops
|
---|
| 1948 | bne rwabs8
|
---|
| 1949 | *
|
---|
| 1950 | moveq.l #ERR02,d0 * ERROR -- "drive not ready"
|
---|
| 1951 | bra rwabser
|
---|
| 1952 | *
|
---|
| 1953 | rwabs8: cmp.w #1,8(a6) * Check rwflag
|
---|
| 1954 | ble rwabs9
|
---|
| 1955 | *
|
---|
| 1956 | subq.w #2,8(a6) * Adjust to 0|1
|
---|
| 1957 | *
|
---|
| 1958 | rwabs9: move.w 14(a6),(a7) * Setup count,
|
---|
| 1959 | move.w d6,-(a7) * ... drive,
|
---|
| 1960 | move.w 16(a6),-(a7) * ... recno,
|
---|
| 1961 | move.l 10(a6),-(a7) * ... buffer,
|
---|
| 1962 | move.w 8(a6),-(a7) * ... rwflag
|
---|
| 1963 | bsr floprw * Call floprw
|
---|
| 1964 | *
|
---|
| 1965 | add.l #10,a7 * Cleanup stack
|
---|
| 1966 | *
|
---|
| 1967 | rwabser: tst.l (a7)+ * Pop stack scratch
|
---|
| 1968 | movem.l (a7)+,d5-d7/a5 * Restore registers
|
---|
| 1969 | unlk a6 * Release temporaries
|
---|
| 1970 | rts * Return to caller
|
---|
| 1971 | *
|
---|
| 1972 | .page
|
---|
| 1973 | *
|
---|
| 1974 | * floprw -- Floppy read / write driver
|
---|
| 1975 | * ------ --------------------------
|
---|
| 1976 | floprw: link a6,#-6 * Reserve space for temps
|
---|
| 1977 | movem.l d2-d7/a5,-(a7) * Save registers
|
---|
| 1978 | move.w 16(a6),d0 * Drive number to d0
|
---|
| 1979 | asl.w #5,d0 * Shift ( *32 )
|
---|
| 1980 | ext.l d0 * Sign extend it, too
|
---|
| 1981 | move.l d0,a5 * Result in a5
|
---|
| 1982 | add.l #drvbpbs,a5 * Add base of BPB table
|
---|
| 1983 | btst #0,13(a6) * Buffer address even ?
|
---|
| 1984 | bne floprw01 * Jump if not
|
---|
| 1985 | *
|
---|
| 1986 | clr.w d0 * Clear odd flag
|
---|
| 1987 | bra floprw02 * Go save the flag
|
---|
| 1988 | *
|
---|
| 1989 | floprw01: moveq.l #1,d0 * Set odd flag
|
---|
| 1990 | *
|
---|
| 1991 | floprw02: move.w d0,-2(a6) * Save it
|
---|
| 1992 | tst.w 22(a5) * dspc set ?
|
---|
| 1993 | bne floprw20 * Jump if so
|
---|
| 1994 | *
|
---|
| 1995 | moveq.l #9,d0 * Assume 9
|
---|
| 1996 | move.w d0,22(a5) * ... and make it the default
|
---|
| 1997 | move.w d0,24(a5) * ... for dspt and dspc
|
---|
| 1998 | *
|
---|
| 1999 | floprw20: bra floprw18
|
---|
| 2000 | *
|
---|
| 2001 | floprw03: tst.w -2(a6) * Is odd flag set ?
|
---|
| 2002 | beq floprw04 * Jump if not
|
---|
| 2003 | *
|
---|
| 2004 | move.l #buffer,d0 * Point to sector buffer
|
---|
| 2005 | bra floprw05
|
---|
| 2006 | *
|
---|
| 2007 | floprw04: move.l 10(a6),d0 * Get buffer address
|
---|
| 2008 | *
|
---|
| 2009 | floprw05: move.l d0,-6(a6) * ... and save
|
---|
| 2010 | move.w 14(a6),d6 * Get recno (lsn)
|
---|
| 2011 | ext.l d6 * Extend it to long
|
---|
| 2012 | divs.w 22(a5),d6 * Divide by dspc for track #
|
---|
| 2013 | move.w 14(a6),d4 * Get recno
|
---|
| 2014 | ext.l d4 * Extend to long
|
---|
| 2015 | divs.w 22(a5),d4 * Divide by dspc
|
---|
| 2016 | swap d4 * Use remainder as sector number
|
---|
| 2017 | cmp.w 24(a5),d4 * Compare with dspt
|
---|
| 2018 | bge floprw06 * Greater than or equal ?
|
---|
| 2019 | *
|
---|
| 2020 | moveq.l #0,d5 * Use side 0
|
---|
| 2021 | bra floprw07
|
---|
| 2022 | *
|
---|
| 2023 | floprw06: moveq.l #1,d5 * Use side 1
|
---|
| 2024 | sub.w 24(a5),d4 * Subtract dspt from sector #
|
---|
| 2025 | *
|
---|
| 2026 | .page
|
---|
| 2027 | *
|
---|
| 2028 | floprw07: tst.w -2(a6) * Is odd flag set ?
|
---|
| 2029 | beq floprw08 * Jump if not
|
---|
| 2030 | *
|
---|
| 2031 | moveq.l #1,d3 * Set counter to 1
|
---|
| 2032 | bra floprw10
|
---|
| 2033 | *
|
---|
| 2034 | floprw08: move.w 24(a5),d0 * Get dspt
|
---|
| 2035 | sub.w d4,d0 * Subtract sector number
|
---|
| 2036 | cmp.w 18(a6),d0 * Compare with number of sectors
|
---|
| 2037 | bge floprw09 * Jump if greater than or eq to
|
---|
| 2038 | *
|
---|
| 2039 | move.w 24(a5),d3 * Get dspt
|
---|
| 2040 | sub.w d4,d3 * Subtract sector number
|
---|
| 2041 | bra floprw10
|
---|
| 2042 | *
|
---|
| 2043 | floprw09: move.w 18(a6),d3 * Count = number of sectors
|
---|
| 2044 | *
|
---|
| 2045 | floprw10: addq.w #1,d4 * Adjust sector number (1 org)
|
---|
| 2046 | *
|
---|
| 2047 | floprw11: tst.w 8(a6) * Test r/w flag
|
---|
| 2048 | beq floprw14 * Jump if it's a read
|
---|
| 2049 | *
|
---|
| 2050 | move.l -6(a6),d0 * Get buffer pointer
|
---|
| 2051 | cmp.l 10(a6),d0 * See if it's = buffer addr
|
---|
| 2052 | beq floprw12 * Jump if so
|
---|
| 2053 | *
|
---|
| 2054 | move.l -6(a6),(a7) * Get source address
|
---|
| 2055 | move.l 10(a6),-(a7) * Destination address
|
---|
| 2056 | jsr fastcopy * Copy the sector
|
---|
| 2057 | addq.l #4,a7 * Cleanup stack
|
---|
| 2058 | *
|
---|
| 2059 | floprw12: move.w d3,(a7) * Number of sectors
|
---|
| 2060 | move.w d5,-(a7) * Side number
|
---|
| 2061 | move.w d6,-(a7) * Track number
|
---|
| 2062 | move.w d4,-(a7) * Sector number
|
---|
| 2063 | move.w 16(a6),-(a7) * Drive number
|
---|
| 2064 | clr.l -(a7) * Filler
|
---|
| 2065 | move.l -6(a6),-(a7) * Buffer address
|
---|
| 2066 | jsr flopwr * Write sector
|
---|
| 2067 | add.l #16,a7 * Cleaup stack
|
---|
| 2068 | move.l d0,d7 * Save error code in d7
|
---|
| 2069 | tst.l d7 * Errors ?
|
---|
| 2070 | bne floprw13 * Jump if so
|
---|
| 2071 | *
|
---|
| 2072 | .page
|
---|
| 2073 | *
|
---|
| 2074 | tst.w fverify * Verify after write ?
|
---|
| 2075 | beq floprw13 * Jump if not
|
---|
| 2076 | *
|
---|
| 2077 | move.w d3,(a7) * Number of sectors
|
---|
| 2078 | move.w d5,-(a7) * Side number
|
---|
| 2079 | move.w d6,-(a7) * Track number
|
---|
| 2080 | move.w d4,-(a7) * Sector number
|
---|
| 2081 | move.w 16(a6),-(a7) * Drive number
|
---|
| 2082 | clr.l -(a7) * Filler
|
---|
| 2083 | move.l #buffer,-(a7) * Buffer address
|
---|
| 2084 | jsr flopver * Verify sector(s)
|
---|
| 2085 | add.l #16,a7 * Cleanup stack
|
---|
| 2086 | move.l d0,d7 * Save error code in d7
|
---|
| 2087 | tst.l d7 * Errors ?
|
---|
| 2088 | bne floprw13 * Jump if so
|
---|
| 2089 | *
|
---|
| 2090 | move.l #buffer,(a7) * Address of sector buffer
|
---|
| 2091 | bsr itom * Convert first word of buffer
|
---|
| 2092 | tst.w d0 * Bad sectors ?
|
---|
| 2093 | beq floprw13 * Jump if not
|
---|
| 2094 | *
|
---|
| 2095 | moveq.l #ERR16,d7 * ERROR -- "Bad sectors"
|
---|
| 2096 | *
|
---|
| 2097 | floprw13: bra floprw15
|
---|
| 2098 | *
|
---|
| 2099 | .page
|
---|
| 2100 | *
|
---|
| 2101 | floprw14: move.w d3,(a7) * Number of sectors
|
---|
| 2102 | move.w d5,-(a7) * Side number
|
---|
| 2103 | move.w d6,-(a7) * Track number
|
---|
| 2104 | move.w d4,-(a7) * Sector number
|
---|
| 2105 | move.w 16(a6),-(a7) * Drive number
|
---|
| 2106 | clr.l -(a7) * Filler
|
---|
| 2107 | move.l -6(a6),-(a7) * Sector buffer
|
---|
| 2108 | jsr floprd * Read floppy sector(s)
|
---|
| 2109 | add.l #16,a7 * Cleanup stack
|
---|
| 2110 | move.l d0,d7 * Save error code in d7
|
---|
| 2111 | move.l -6(a6),d0 * User buffer address
|
---|
| 2112 | cmp.l 10(a6),d0 * Is it the desired buffer ?
|
---|
| 2113 | beq floprw15 * Jump if so
|
---|
| 2114 | *
|
---|
| 2115 | move.l 10(a6),(a7) * Push source address
|
---|
| 2116 | move.l -6(a6),-(a7) * Push destination address
|
---|
| 2117 | jsr fastcopy * Copy the sector
|
---|
| 2118 | addq.l #4,a7 * Cleanup stack
|
---|
| 2119 | *
|
---|
| 2120 | floprw15: tst.l d7 * Error code set ?
|
---|
| 2121 | bge floprw16 * Jump if not
|
---|
| 2122 | *
|
---|
| 2123 | move.w 16(a6),(a7) * Push drive number
|
---|
| 2124 | move.l d7,d0 * Error code
|
---|
| 2125 | move.w d0,-(a7) * ... onto stack
|
---|
| 2126 | jsr criterr * Call critical error handler
|
---|
| 2127 | addq.l #2,a7 * Cleanup stack
|
---|
| 2128 | move.l d0,d7 * Get error code
|
---|
| 2129 | *
|
---|
| 2130 | floprw16: cmp.l #RETRYIT,d7 * Re-try ?
|
---|
| 2131 | beq floprw11 * Jump if so
|
---|
| 2132 | *
|
---|
| 2133 | tst.l d7 * Check error code
|
---|
| 2134 | bge floprw17 * Jump if no error
|
---|
| 2135 | *
|
---|
| 2136 | move.l d7,d0 * Error code is the result
|
---|
| 2137 | bra floprw19
|
---|
| 2138 | *
|
---|
| 2139 | .page
|
---|
| 2140 | *
|
---|
| 2141 | floprw17: move.w d3,d0 * Sector counter to d0
|
---|
| 2142 | ext.l d0 * Sign extend
|
---|
| 2143 | moveq.l #9,d1 * Times 512
|
---|
| 2144 | asl.l d1,d0 * ...
|
---|
| 2145 | add.l d0,10(a6) * Update buffer address
|
---|
| 2146 | add.w d3,14(a6) * Update sector number
|
---|
| 2147 | sub.w d3,18(a6) * Update sector count
|
---|
| 2148 | *
|
---|
| 2149 | floprw18: tst.w 18(a6) * More sectors ?
|
---|
| 2150 | bne floprw03 * Jump if so
|
---|
| 2151 | *
|
---|
| 2152 | moveq.l #0,d0 * Set "no error" as result
|
---|
| 2153 | *
|
---|
| 2154 | floprw19: tst.l (a7)+ * Test top of stack
|
---|
| 2155 | movem.l (a7)+,d3-d7/a5 * Restore registers
|
---|
| 2156 | unlk a6 * Release stack space
|
---|
| 2157 | rts * Return to caller
|
---|
| 2158 | *
|
---|
| 2159 | .page
|
---|
| 2160 | *
|
---|
| 2161 | * itom -- Convert 8086 integer format to 680000 integer format
|
---|
| 2162 | * ---- ----------------------------------------------------
|
---|
| 2163 | itom: link a6,#-4 * Reserve stack for temps
|
---|
| 2164 | move.l 8(a6),a0 * Address of the number to a0
|
---|
| 2165 | move.b 1(a0),d0 * Get high byte
|
---|
| 2166 | ext.w d0 * Make it a word
|
---|
| 2167 | and.w #$FF,d0 * Isolate bits 0..7
|
---|
| 2168 | asl.w #8,d0 * Shift in bits 8..15
|
---|
| 2169 | move.l 8(a6),a1 * Address of the number to a1
|
---|
| 2170 | move.b (a1),d1 * Get low byte
|
---|
| 2171 | ext.w d1 * Extend to word
|
---|
| 2172 | and.w #$FF,d1 * Isolate bits 0..7
|
---|
| 2173 | or.w d1,d0 * Combine with bits 8..15
|
---|
| 2174 | unlk a6 * Release stack space
|
---|
| 2175 | rts * Return to caller
|
---|
| 2176 | *
|
---|
| 2177 | * flopini -- Initialize floppy drive
|
---|
| 2178 | * ------- -----------------------
|
---|
| 2179 | flopini: lea dsb0,a1 * Point to dsb for drive A
|
---|
| 2180 | tst.w 12(a7) * Drive A wanted ?
|
---|
| 2181 | beq flopin01 * Jump if so
|
---|
| 2182 | *
|
---|
| 2183 | lea dsb1,a1 * Drive B dsb address to a1
|
---|
| 2184 | *
|
---|
| 2185 | flopin01: move.w seekrate,2(a1) * Get seek rate
|
---|
| 2186 | moveq.l #ERR01,d0 * Set default error number
|
---|
| 2187 | clr.w 0(a1) * Set track number to 0
|
---|
| 2188 | bsr floplock * Setup floppy parameters
|
---|
| 2189 | bsr select * Select drive and side
|
---|
| 2190 | move.w #$FF00,0(a1)
|
---|
| 2191 | bsr restore * Restore the drive
|
---|
| 2192 | moveq.l #6,d7
|
---|
| 2193 | bsr hseek1
|
---|
| 2194 | bne flopin02
|
---|
| 2195 | *
|
---|
| 2196 | bsr restore * Restore the drive
|
---|
| 2197 | beq flopok * Jump if no error
|
---|
| 2198 | *
|
---|
| 2199 | flopin02: bra flopfail * Jump to error handler
|
---|
| 2200 | *
|
---|
| 2201 | .page
|
---|
| 2202 | *
|
---|
| 2203 | * floprd -- Read floppy
|
---|
| 2204 | * ------ -----------
|
---|
| 2205 | floprd: bsr change * Disk changed ?
|
---|
| 2206 | moveq.l #ERR11,d0 * Set to "read error"
|
---|
| 2207 | bsr floplock * Set parameters
|
---|
| 2208 | *
|
---|
| 2209 | floprd01: bsr select * Select drive and side
|
---|
| 2210 | bsr go2track * Position on track
|
---|
| 2211 | bne floprd02 * Try again on error
|
---|
| 2212 | *
|
---|
| 2213 | move.w #ERR01,deferr(a5) * Set default error
|
---|
| 2214 | move.l edma(a5),a0 * Get final DMA address
|
---|
| 2215 | move.l cdma(a5),a2 * Get first DMA address
|
---|
| 2216 | move.l #$40000,d7 * Set timeout counter
|
---|
| 2217 | move.b #FL_RM,DSKCMD(a6) * Start readng the disk
|
---|
| 2218 | *
|
---|
| 2219 | floprd03: btst #0,DSKCMD(a6) * Disk busy yet ?
|
---|
| 2220 | bne floprd05 * Jump if so
|
---|
| 2221 | *
|
---|
| 2222 | subq.l #1,d7 * Decrement timeout counter
|
---|
| 2223 | beq floprd04 * Jump if timed out
|
---|
| 2224 | *
|
---|
| 2225 | bra floprd03 * Go try for busy again
|
---|
| 2226 | *
|
---|
| 2227 | floprd05: move.l #$40000,d7 * Reset timeout counter
|
---|
| 2228 | bra floprd09 * Go join main read loop
|
---|
| 2229 | *
|
---|
| 2230 | floprd07: subq.l #1,d7 * Decrement timeout counter
|
---|
| 2231 | beq floprd04 * Jump if timed out
|
---|
| 2232 | *
|
---|
| 2233 | btst #0,DSKCMD(a6) * Done yet ?
|
---|
| 2234 | beq floprd08 * Jump if so
|
---|
| 2235 | *
|
---|
| 2236 | floprd09: btst #1,DSKCMD(a6) * DRQ set ?
|
---|
| 2237 | beq floprd07 * Jump if not
|
---|
| 2238 | *
|
---|
| 2239 | move.b DSKDAT(a6),(a2)+ * Read the byte into the buffer
|
---|
| 2240 | cmp.l a0,a2 * Done reading ?
|
---|
| 2241 | bne floprd07 * Jump if not
|
---|
| 2242 | *
|
---|
| 2243 | .page
|
---|
| 2244 | *
|
---|
| 2245 | floprd08: move.b DSKCMD(a6),d0 * Read final status into d0
|
---|
| 2246 | and.b #$1C,d0 * Mask for error bits
|
---|
| 2247 | beq flopok * Jump if no errors
|
---|
| 2248 | *
|
---|
| 2249 | bsr errbits * Determine error code
|
---|
| 2250 | *
|
---|
| 2251 | floprd02: cmp.w #1,retrycnt(a5) * Re-try ?
|
---|
| 2252 | bne floprd06 * Jump if not
|
---|
| 2253 | *
|
---|
| 2254 | bsr reseek * Home and repeat the seek
|
---|
| 2255 | *
|
---|
| 2256 | floprd06: subq.w #1,retrycnt(a5) * Update re-try count
|
---|
| 2257 | bpl floprd01 * Re-try if count still >0
|
---|
| 2258 | *
|
---|
| 2259 | bra flopfail * Failure
|
---|
| 2260 | *
|
---|
| 2261 | floprd04: move.w #ERR02,curerr(a5) * Set error code "not ready"
|
---|
| 2262 | bsr rs1772 * Reset the WD1772
|
---|
| 2263 | bra floprd02 * See if it can be retried
|
---|
| 2264 | *
|
---|
| 2265 | .page
|
---|
| 2266 | *
|
---|
| 2267 | * errbits -- Develop error code for floppy I/O error
|
---|
| 2268 | * ------- ---------------------------------------
|
---|
| 2269 | errbits: moveq.l #ERR13,d1 * Write protect ?
|
---|
| 2270 | btst #6,d0 * ...
|
---|
| 2271 | bne errbits1 * Jump if so
|
---|
| 2272 | *
|
---|
| 2273 | moveq.l #ERR08,d1 * Record not found ?
|
---|
| 2274 | btst #4,d0 * ...
|
---|
| 2275 | bne errbits1 * Jump if so
|
---|
| 2276 | *
|
---|
| 2277 | moveq.l #ERR04,d1 * CRC error ?
|
---|
| 2278 | btst #3,d0 * ...
|
---|
| 2279 | bne errbits1 * Jump if so
|
---|
| 2280 | *
|
---|
| 2281 | moveq.l #ERR12,d1 * Lost data ?
|
---|
| 2282 | btst #2,d0 * ...
|
---|
| 2283 | bne errbits1 * Jump if so
|
---|
| 2284 | *
|
---|
| 2285 | move.w deferr(a5),d1 * Use default error
|
---|
| 2286 | *
|
---|
| 2287 | errbits1: move.w d1,curerr(a5) * ... as curerr
|
---|
| 2288 | rts * Return to caller
|
---|
| 2289 | *
|
---|
| 2290 | .page
|
---|
| 2291 | *
|
---|
| 2292 | * flopwr -- Floppy write
|
---|
| 2293 | * ------ ------------
|
---|
| 2294 | flopwr: bsr change * Check for disk change
|
---|
| 2295 | moveq.l #ERR10,d0 * Set write error
|
---|
| 2296 | bsr floplock * Set parameters
|
---|
| 2297 | move.w csect(a5),d0 * Get sector number in d0
|
---|
| 2298 | subq.w #1,d0 * ... -1
|
---|
| 2299 | or.w ctrack(a5),d0 * OR with track number
|
---|
| 2300 | or.w cside(a5),d0 * OR with side number
|
---|
| 2301 | bne flopwr01 * Jump if not boot sector
|
---|
| 2302 | *
|
---|
| 2303 | moveq.l #2,d0 * Media change
|
---|
| 2304 | bsr setdmode * Set to "unsure"
|
---|
| 2305 | *
|
---|
| 2306 | flopwr01: bsr select * Select drive and side
|
---|
| 2307 | bsr go2track * Seek
|
---|
| 2308 | bne flopwr06 * Re-try on error
|
---|
| 2309 | *
|
---|
| 2310 | flopwr02: move.w #ERR01,curerr(a5) * Set for default error
|
---|
| 2311 | move.l cdma(a5),a2 * Get I/O address
|
---|
| 2312 | move.l #$40000,d7 * Set timeout counter
|
---|
| 2313 | move.w ctrack(a5),d0 * Get track number
|
---|
| 2314 | cmpi.w #40,d0 * See if we need precomp
|
---|
| 2315 | bcs flopwr10 * Jump if not
|
---|
| 2316 | *
|
---|
| 2317 | move.b #FL_WS,DSKCMD(a6) * Write with precomp
|
---|
| 2318 | bra flopwr08 * Go join main write loop
|
---|
| 2319 | *
|
---|
| 2320 | flopwr10: move.b #FL_WS+FL_NC,DSKCMD(a6) * Write (no precomp)
|
---|
| 2321 | *
|
---|
| 2322 | .page
|
---|
| 2323 | *
|
---|
| 2324 | flopwr08: btst #0,DSKCMD(a6) * Busy yet ?
|
---|
| 2325 | bne flopwr09 * Jump if so
|
---|
| 2326 | *
|
---|
| 2327 | subq.l #1,d7 * Decrement tiemout count
|
---|
| 2328 | bne flopwr08 * Jump if not timed out
|
---|
| 2329 | *
|
---|
| 2330 | flopwr13: bsr rs1772 * Reset WD1772
|
---|
| 2331 | bra flopwr05 * See if we can retry
|
---|
| 2332 | *
|
---|
| 2333 | flopwr11: btst #0,DSKCMD(a6) * Done ?
|
---|
| 2334 | beq flopwr04 * Jump if so
|
---|
| 2335 | *
|
---|
| 2336 | flopwr09: btst #1,DSKCMD(a6) * DRQ set ?
|
---|
| 2337 | bne flopwr12 * Jump if so
|
---|
| 2338 | *
|
---|
| 2339 | subq.l #1,d7 * Decrement timeout counter
|
---|
| 2340 | beq flopwr13 * Jump if timed out
|
---|
| 2341 | *
|
---|
| 2342 | bra flopwr11 * Jump if not
|
---|
| 2343 | *
|
---|
| 2344 | flopwr12: move.b (a2)+,DSKDAT(a6) * Write byte to floppy
|
---|
| 2345 | bra flopwr11 * Go get the next one
|
---|
| 2346 | *
|
---|
| 2347 | .page
|
---|
| 2348 | *
|
---|
| 2349 | flopwr04: move.b DSKCMD(a6),d0 * Get floppy status
|
---|
| 2350 | bsr errbits * Set error code
|
---|
| 2351 | btst #6,d0 * Write protect error ?
|
---|
| 2352 | bne flopfail * Fail if so
|
---|
| 2353 | *
|
---|
| 2354 | and.b #$5C,d0 * Mask error bits
|
---|
| 2355 | bne flopwr05 * Jump if an error occurred
|
---|
| 2356 | *
|
---|
| 2357 | addq.w #1,csect(a5) * Update sector number
|
---|
| 2358 | add.l #512,cdma(a5) * Update DMA address
|
---|
| 2359 | subq.w #1,ccount(a5) * Decrement sector count
|
---|
| 2360 | beq flopok * Jump if zero -- done
|
---|
| 2361 | *
|
---|
| 2362 | bsr select1 * Set sector and DMA pointer
|
---|
| 2363 | bra flopwr02 * Write next sector
|
---|
| 2364 | *
|
---|
| 2365 | flopwr05: cmp.w #1,retrycnt(a5) * Second re-try ?
|
---|
| 2366 | bne flopwr07 * Jump if not
|
---|
| 2367 | *
|
---|
| 2368 | flopwr06: bsr reseek * Restore and re-seek
|
---|
| 2369 | *
|
---|
| 2370 | flopwr07: subq.w #1,retrycnt(a5) * Update re-try count
|
---|
| 2371 | bpl flopwr01 * Re-try if still >0
|
---|
| 2372 | *
|
---|
| 2373 | bra flopfail * ... else fail
|
---|
| 2374 | *
|
---|
| 2375 | .page
|
---|
| 2376 | *
|
---|
| 2377 | * flopfmt -- Format a track on the floppy
|
---|
| 2378 | * ------- ----------------------------
|
---|
| 2379 | flopfmt: cmp.l #FMAGIC,22(a7) * Is the magic right ?
|
---|
| 2380 | bne flopfail * Fail immediately if not
|
---|
| 2381 | *
|
---|
| 2382 | bsr change * Check for disk change
|
---|
| 2383 | moveq.l #ERR01,d0 * Set default error number
|
---|
| 2384 | bsr floplock * Set parameters
|
---|
| 2385 | bsr select * Select drive and side
|
---|
| 2386 | move.w 14(a7),spt(a5) * Set sectors per track,
|
---|
| 2387 | move.w 20(a7),interlv(a5) * ... interleave,
|
---|
| 2388 | move.w 26(a7),virgin(a5) * ... initial data,
|
---|
| 2389 | moveq.l #2,d0 * Disk changed
|
---|
| 2390 | bsr setdmode * ...
|
---|
| 2391 | bsr hseek * Seek
|
---|
| 2392 | bne flopfail * Fail if seek error occurs
|
---|
| 2393 | *
|
---|
| 2394 | move.w ctrack(a5),0(a1) * Current track to DSB
|
---|
| 2395 | move.w #ERR01,curerr(a5) * Default to curerr
|
---|
| 2396 | bsr fmtrack * Format the track
|
---|
| 2397 | bne flopfail * Fail if error occurs
|
---|
| 2398 | *
|
---|
| 2399 | move.w spt(a5),ccount(a5) * Use spt as ccount
|
---|
| 2400 | move.w #1,csect(a5) * Start with sector 1
|
---|
| 2401 | bsr verify1 * Verify the sector
|
---|
| 2402 | move.l cdma(a5),a2 * Get bad sector list
|
---|
| 2403 | tst.w (a2) * Any bad ones ?
|
---|
| 2404 | beq flopok * Jump if not
|
---|
| 2405 | *
|
---|
| 2406 | move.w #ERR16,curerr(a5) * ERROR -- "bad sectors"
|
---|
| 2407 | bra flopfail
|
---|
| 2408 | *
|
---|
| 2409 | .page
|
---|
| 2410 | *
|
---|
| 2411 | * fmtrack -- Do the dirty work of formatting a track
|
---|
| 2412 | * ------- ---------------------------------------
|
---|
| 2413 | fmtrack: move.w #ERR10,deferr(a5) * Set default error number
|
---|
| 2414 | move.w #1,d3 * Start with sector 1
|
---|
| 2415 | move.l cdma(a5),a2 * Get track buffer address
|
---|
| 2416 | move.w #60-1,d1 * Set count = 60
|
---|
| 2417 | move.b #$4E,d0 * Write $4E as initial gap
|
---|
| 2418 | bsr wmult * ...
|
---|
| 2419 | *
|
---|
| 2420 | fmtrak01: move.w d3,d4 * Save sector number in d4
|
---|
| 2421 | *
|
---|
| 2422 | fmtrak02: move.w #12-1,d1 * Set count = 12
|
---|
| 2423 | clr.b d0 * Write $00 as sync
|
---|
| 2424 | bsr wmult * ...
|
---|
| 2425 | move.w #3-1,d1 * Set count = 3
|
---|
| 2426 | move.b #$F5,d0 * Write $F5's
|
---|
| 2427 | bsr wmult * ...
|
---|
| 2428 | move.b #$FE,(a2)+ * Write $FE (address mark)
|
---|
| 2429 | move.b ctrack+1,(a2)+ * Write track #
|
---|
| 2430 | move.b cside+1,(a2)+ * Write side #
|
---|
| 2431 | move.b d4,(a2)+ * Write sector #
|
---|
| 2432 | move.b #2,(a2)+ * Write sector size code
|
---|
| 2433 | move.b #$F7,(a2)+ * Write checksum code
|
---|
| 2434 | move.w #22-1,d1 * Set count = 22
|
---|
| 2435 | move.b #$4E,d0 * Write gap
|
---|
| 2436 | bsr wmult * ...
|
---|
| 2437 | move.w #12-1,d1 * Set count = 12
|
---|
| 2438 | clr.b d0 * Write $00 as sync
|
---|
| 2439 | bsr wmult * ...
|
---|
| 2440 | move.w #3-1,d1 * Set count = 3
|
---|
| 2441 | move.b #$F5,d0 * Write $F5's
|
---|
| 2442 | bsr wmult * ...
|
---|
| 2443 | move.b #$FB,(a2)+ * Write DAM
|
---|
| 2444 | move.w #256-1,d1 * Set count = 256 words
|
---|
| 2445 | *
|
---|
| 2446 | .page
|
---|
| 2447 | *
|
---|
| 2448 | fmtrak03: move.b virgin(a5),(a2)+ * Write virgin data in buffer
|
---|
| 2449 | move.b virgin+1(a5),(a2)+ * ...
|
---|
| 2450 | dbf d1,fmtrak03 * ...
|
---|
| 2451 | *
|
---|
| 2452 | move.b #$F7,(a2)+ * Write CRC code
|
---|
| 2453 | move.w #40-1,d1 * Set count = 40
|
---|
| 2454 | move.b #$4E,d0 * Write gap
|
---|
| 2455 | bsr wmult * ...
|
---|
| 2456 | add.w interlv(a5),d4 * Add interleave to sector #
|
---|
| 2457 | cmp.w spt(a5),d4 * Check against spt
|
---|
| 2458 | ble fmtrak02 * Jump if not >
|
---|
| 2459 | *
|
---|
| 2460 | addq.w #1,d3 * Starting sector +1
|
---|
| 2461 | cmp.w interlv(a5),d3
|
---|
| 2462 | ble fmtrak01
|
---|
| 2463 | *
|
---|
| 2464 | move.w #1401-1,d1 * Set count = 1401
|
---|
| 2465 | move.b #$4E,d0 * Write final gap
|
---|
| 2466 | bsr wmult * ...
|
---|
| 2467 | move.l cdma(a5),a2 * Get buffer address
|
---|
| 2468 | move.l #$40000,d7 * Set timeout count
|
---|
| 2469 | move.w ctrack(a5),d0 * Get track number
|
---|
| 2470 | cmpi.w #40,d0 * Do we need precomp ?
|
---|
| 2471 | bcs fmtrak08 * Jump if not
|
---|
| 2472 | *
|
---|
| 2473 | move.b #FL_WT,DSKCMD(a6) * Start format with precomp
|
---|
| 2474 | bra fmtrak07 * Go join main format loop
|
---|
| 2475 | *
|
---|
| 2476 | fmtrak08: move.b #FL_WT+FL_NC,DSKCMD(a6) * Start format without precomp
|
---|
| 2477 | *
|
---|
| 2478 | .page
|
---|
| 2479 | *
|
---|
| 2480 | fmtrak07: btst #0,DSKCMD(a6) * Busy yet ?
|
---|
| 2481 | bne fmtrak09 * Jump if so
|
---|
| 2482 | *
|
---|
| 2483 | fmtrak04: subq.l #1,d7 * Decrement timeout counter
|
---|
| 2484 | bne fmtrak07 * Jump if not timed out
|
---|
| 2485 | *
|
---|
| 2486 | fmtrak05: bsr rs1772 * Reset WD1772
|
---|
| 2487 | moveq.l #1,d7 * Set error flag
|
---|
| 2488 | rts * Return to caller
|
---|
| 2489 | *
|
---|
| 2490 | fmtrak11: btst #0,DSKCMD(a6) * Done ?
|
---|
| 2491 | beq fmtrak06 * Jump if so
|
---|
| 2492 | *
|
---|
| 2493 | fmtrak09: btst #1,DSKCMD(a6) * DRQ set ?
|
---|
| 2494 | bne fmtrak10 * Jump if so
|
---|
| 2495 | *
|
---|
| 2496 | subq.l #1,d7 * Decrement timeout coutner
|
---|
| 2497 | beq fmtrak05 * Jump if timed out
|
---|
| 2498 | *
|
---|
| 2499 | bra fmtrak11 * Go check again
|
---|
| 2500 | *
|
---|
| 2501 | fmtrak10: move.b (a2)+,DSKDAT(a6) * Write a byte of format
|
---|
| 2502 | bra fmtrak11 * Go wait for DRQ
|
---|
| 2503 | *
|
---|
| 2504 | fmtrak06: move.b DSKCMD(a6),d0 * Get final status
|
---|
| 2505 | bsr errbits * Set possible error code
|
---|
| 2506 | andi.b #$44,d0 * Check error bits
|
---|
| 2507 | rts * Return to caller with status
|
---|
| 2508 | *
|
---|
| 2509 | * wmult -- write multiple bytes into the track buffer
|
---|
| 2510 | * ----- ------------------------------------------
|
---|
| 2511 | wmult: move.b d0,(a2)+ * Move a byte into the buffer
|
---|
| 2512 | dbf d1,wmult * Loop until we're done
|
---|
| 2513 | *
|
---|
| 2514 | rts * Return to caller
|
---|
| 2515 | *
|
---|
| 2516 | .page
|
---|
| 2517 | *
|
---|
| 2518 | * flopver -- verify sector(s) on a floppy
|
---|
| 2519 | * ------- ----------------------------
|
---|
| 2520 | flopver: bsr change * Check for disk change
|
---|
| 2521 | moveq.l #ERR11,d0 * Set default to "read error"
|
---|
| 2522 | bsr floplock * Set parameters
|
---|
| 2523 | bsr select * Select drive and side
|
---|
| 2524 | bsr go2track * Seek
|
---|
| 2525 | bne flopfail * Jump if seek error
|
---|
| 2526 | *
|
---|
| 2527 | bsr verify1 * Verify the data
|
---|
| 2528 | bra flopok * Done
|
---|
| 2529 | *
|
---|
| 2530 | * verify1 -- Verify the data for a sector
|
---|
| 2531 | * ------- ----------------------------
|
---|
| 2532 | verify1: move.w #ERR11,deferr(a5) * Set default = "read error"
|
---|
| 2533 | move.l cdma(a5),a2 * Pointer for bad sector list
|
---|
| 2534 | add.l #512,cdma(a5) * Update by length of a sector
|
---|
| 2535 | *
|
---|
| 2536 | verify01: move.w #2,retrycnt(a5) * Set retrycnt for 2 attempts
|
---|
| 2537 | move.w csect(a5),d7 * Get sector nubmer
|
---|
| 2538 | move.b d7,DSKSEC(a6) * Send to WD1772
|
---|
| 2539 | *
|
---|
| 2540 | verify02: moveq.l #0,d6 * Clear bad compare flag
|
---|
| 2541 | move.l cdma(a5),a0 * Get compare address
|
---|
| 2542 | move.l #$40000,d7 * Set timeout counter
|
---|
| 2543 | move.b #FL_RS,DSKCMD(a6) * Start the read
|
---|
| 2544 | *
|
---|
| 2545 | verify08: btst #0,DSKCMD(a6) * Busy yet ?
|
---|
| 2546 | bne verify09 * Jump if so
|
---|
| 2547 | *
|
---|
| 2548 | subq.l #1,d7 * Decrement timeout counter
|
---|
| 2549 | beq verify13 * Jump if timed out
|
---|
| 2550 | *
|
---|
| 2551 | bra verify08 * Wait for busy some more
|
---|
| 2552 | *
|
---|
| 2553 | verify09: move.l #$40000,d7 * Reset timeout counter
|
---|
| 2554 | bra verify11 * Go join main compare loop
|
---|
| 2555 | *
|
---|
| 2556 | verify10: subq.l #1,d7 * Decrement timeout counter
|
---|
| 2557 | beq verify13 * Jump if timed out
|
---|
| 2558 | *
|
---|
| 2559 | btst #0,DSKCMD(a6) * Done yet ?
|
---|
| 2560 | beq verify12 * Jump if so
|
---|
| 2561 | *
|
---|
| 2562 | .page
|
---|
| 2563 | *
|
---|
| 2564 | verify11: btst #1,DSKCMD(a6) * DRQ set ?
|
---|
| 2565 | beq verify10 * Jump if not
|
---|
| 2566 | *
|
---|
| 2567 | move.b DSKDAT(a6),d0 * Read data
|
---|
| 2568 | bra verify10 * Continue reading
|
---|
| 2569 | *
|
---|
| 2570 | verify12: move.b DSKCMD(a6),d0 * Get final status
|
---|
| 2571 | bsr errbits * Determine error code
|
---|
| 2572 | and.b #$1C,d0 * Mask RNF, CRC, LOST
|
---|
| 2573 | bne verify06 * Jump to re-try if any set
|
---|
| 2574 | *
|
---|
| 2575 | verify05: addq.w #1,csect(a5) * Update sector number
|
---|
| 2576 | subq.w #1,ccount(a5) * Update sector count
|
---|
| 2577 | bne verify01 * Jump if more to do
|
---|
| 2578 | *
|
---|
| 2579 | sub.l #512,cdma(a5) * Reset DMA pointer
|
---|
| 2580 | clr.w (a2) * Set NIL in bad sector list
|
---|
| 2581 | rts * Return to caller
|
---|
| 2582 | *
|
---|
| 2583 | verify06: cmp.w #1,retrycnt(a5) * Is it the 2nd attempt ?
|
---|
| 2584 | bne verify07 * Jump if not
|
---|
| 2585 | *
|
---|
| 2586 | bsr reseek * Restore and re-seek
|
---|
| 2587 | *
|
---|
| 2588 | verify07: subq.w #1,retrycnt(a5) * Decrement retry count
|
---|
| 2589 | bpl verify02 * Re-try if still positive
|
---|
| 2590 | *
|
---|
| 2591 | move.w csect(a5),(a2)+ * Add to bad sector list
|
---|
| 2592 | bra verify05 * Go do next sector
|
---|
| 2593 | *
|
---|
| 2594 | verify13: move.w #ERR02,curerr(a5) * Set timeout error code
|
---|
| 2595 | bsr rs1772 * Reset WD1772
|
---|
| 2596 | bra verify06 * See if we can retry it
|
---|
| 2597 | *
|
---|
| 2598 | .page
|
---|
| 2599 | *
|
---|
| 2600 | * flopvbl -- Floppy VBL timer interrupt handling
|
---|
| 2601 | * ------- -----------------------------------
|
---|
| 2602 | flopvbl: movem.l d0-d1/a0-a1/a5-a6,-(a7) * Save registers
|
---|
| 2603 | sub.l a5,a5 * Clear a5 for use as RAM base
|
---|
| 2604 | lea FLOPPY,a6 * Base of floppy regs
|
---|
| 2605 | st motoron(a5) * Set motoron flag
|
---|
| 2606 | move.l frclock(a5),d0 * Get interrupt count
|
---|
| 2607 | move.b d0,d1 * ...
|
---|
| 2608 | and.b #7,d1 * ... MOD 8
|
---|
| 2609 | bne flopvb02 * Jump if not 8th int
|
---|
| 2610 | *
|
---|
| 2611 | move.w sr,-(a7) * Save interrupt level
|
---|
| 2612 | ori.w #IPL7,sr * Mask off interrupts
|
---|
| 2613 | clr.w deslflag(a5) * Clear deselect flag
|
---|
| 2614 | move.b _mc1_ior+cfr1,d0 * Get port status
|
---|
| 2615 | ori.b #1,d0 * Set drive select bit
|
---|
| 2616 | move.b d0,MC1ACIA+ACIA_CFR * Send drive select to port
|
---|
| 2617 | move.b d0,_mc1_ior+cfr1 * Store updated port status
|
---|
| 2618 | move.w (a7)+,sr * Restore interrupt level
|
---|
| 2619 | lea wpstatus(a5),a0 * Point at wpstatus for drive
|
---|
| 2620 | lea dsb0(a5),a1 * Point at dsb0
|
---|
| 2621 | move.b DSKCMD(a6),d0 * Read WD1772 status
|
---|
| 2622 | btst #6,d0 * Test write protect bit
|
---|
| 2623 | sne (a0) * ... and save
|
---|
| 2624 | *
|
---|
| 2625 | flopvb02: move.w wpstatus(a5),d0 * Get wpstatus of drive A
|
---|
| 2626 | or.w d0,wplatch(a5) * OR into wplatch
|
---|
| 2627 | tst.w deslflag(a5) * Floppies already deselected ?
|
---|
| 2628 | bne flopvb03 * Jump if so
|
---|
| 2629 | *
|
---|
| 2630 | move.b DSKCMD(a6),d0 * Read WD1772 status
|
---|
| 2631 | btst #7,d0 * Motor-on bit set ?
|
---|
| 2632 | bne flopvb04 * Don't de-select if it is
|
---|
| 2633 | *
|
---|
| 2634 | move.w sr,-(a7) * Save sr
|
---|
| 2635 | ori.w #IPL7,sr * Disable interrupts
|
---|
| 2636 | move.b _mc1_ior+cfr1,d0 * Get cfr1 image
|
---|
| 2637 | bclr #0,d0 * Clear d0 (drive select)
|
---|
| 2638 | move.b d0,_mc1_ior+cfr1 * Save new value
|
---|
| 2639 | move.b d0,MC1ACIA+ACIA_CFR * Send to hardware
|
---|
| 2640 | move.w (a7)+,sr * Restore sr (enable ints)
|
---|
| 2641 | move.w #1,deslflag(a5) * Set the deselect flag
|
---|
| 2642 | *
|
---|
| 2643 | flopvb03: clr.w motoron(a5) * Clear motoron flag
|
---|
| 2644 | *
|
---|
| 2645 | flopvb04: movem.l (a7)+,d0-d1/a0-a1/a5-a6 * Restore registers
|
---|
| 2646 | rts * Return to caller
|
---|
| 2647 | *
|
---|
| 2648 | .page
|
---|
| 2649 | *
|
---|
| 2650 | * floplock -- Setup floppy parameters
|
---|
| 2651 | * -------- -----------------------
|
---|
| 2652 | floplock: movem.l d3-d7/a3-a6,flpregs * Save registers
|
---|
| 2653 | move.w sr,flpsrsv * Save sr
|
---|
| 2654 | ori.w #IPL7,sr * Disable ints
|
---|
| 2655 | sub.l a5,a5 * Clear a5
|
---|
| 2656 | lea FLOPPY,a6 * Base of floppy registers
|
---|
| 2657 | st motoron(a5) * Set motoron flag
|
---|
| 2658 | move.w d0,deferr(a5) * Set default error code
|
---|
| 2659 | move.w d0,curerr(a5) * ... current error code
|
---|
| 2660 | move.w #1,flock(a5) * Disable flopvbl routine
|
---|
| 2661 | move.l 8(a7),cdma(a5) * Set cdma
|
---|
| 2662 | move.w 16(a7),cdev(a5) * ... cdev
|
---|
| 2663 | move.w 18(a7),csect(a5) * ... csect
|
---|
| 2664 | move.w 20(a7),ctrack(a5) * ... ctrack
|
---|
| 2665 | move.w 22(a7),cside(a5) * ... cside
|
---|
| 2666 | move.w 24(a7),ccount(a5) * ... ccount
|
---|
| 2667 | move.w #2,retrycnt(a5) * ... retrycnt
|
---|
| 2668 | lea dsb0(a5),a1 * Address of dsb0
|
---|
| 2669 | tst.w cdev(a5) * Drive A ?
|
---|
| 2670 | beq floplk01 * Jump if so
|
---|
| 2671 | *
|
---|
| 2672 | lea dsb1(a5),a1 * Drive B, use dsb1
|
---|
| 2673 | *
|
---|
| 2674 | floplk01: moveq.l #0,d7 * Clear out d7
|
---|
| 2675 | move.w ccount(a5),d7 * Get ccount
|
---|
| 2676 | lsl.w #8,d7 * ... * sector length (512)
|
---|
| 2677 | lsl.w #1,d7 * ...
|
---|
| 2678 | move.l cdma(a5),a0 * Get DMA start address
|
---|
| 2679 | add.l d7,a0 * Add length of sectors
|
---|
| 2680 | move.l a0,edma(a5) * Set edma (end DMA address)
|
---|
| 2681 | tst.w 0(a1) * Check current track
|
---|
| 2682 | bpl floplk03 * Jump if >= 0
|
---|
| 2683 | *
|
---|
| 2684 | bsr select * Select the drive
|
---|
| 2685 | clr.w 0(a1) * Set current track to 0
|
---|
| 2686 | bsr restore * Restore drive to track 0
|
---|
| 2687 | beq floplk03 * Jump if OK
|
---|
| 2688 | *
|
---|
| 2689 | moveq.l #10,d7 * Seek out to track 10
|
---|
| 2690 | bsr hseek1 * ...
|
---|
| 2691 | bne floplk02 * Jump if an error occurred
|
---|
| 2692 | *
|
---|
| 2693 | bsr restore * Try the restore again
|
---|
| 2694 | beq floplk03 * Jump if OK
|
---|
| 2695 | *
|
---|
| 2696 | floplk02: move.w #$FF00,0(a1) * Recalibrate error
|
---|
| 2697 | *
|
---|
| 2698 | floplk03: rts * Return to caller
|
---|
| 2699 | *
|
---|
| 2700 | .page
|
---|
| 2701 | *
|
---|
| 2702 | * flopfail -- Floppy I/O failure exit
|
---|
| 2703 | * -------- -----------------------
|
---|
| 2704 | flopfail: moveq.l #1,d0 * Set media change to "unsure"
|
---|
| 2705 | bsr setdmode * ...
|
---|
| 2706 | move.w curerr(a5),d0 * Get curerr
|
---|
| 2707 | ext.l d0 * ...
|
---|
| 2708 | bra flopok1 * Go set end status
|
---|
| 2709 | *
|
---|
| 2710 | * flopok -- Floppy I/O success exit
|
---|
| 2711 | * ------ -----------------------
|
---|
| 2712 | flopok: moveq.l #0,d0 * Set error code = 0 (no error)
|
---|
| 2713 | *
|
---|
| 2714 | flopok1: move.l d0,-(a7) * Push code onto stack
|
---|
| 2715 | move.w 0(a1),d7 * Get track number
|
---|
| 2716 | move.b d7,DSKDAT(a6) * Send to WD1772
|
---|
| 2717 | move.w #FL_SK,d6 * Seek command to d6
|
---|
| 2718 | bsr flopcmds * Send command
|
---|
| 2719 | move.w cdev(a5),d0 * Get drive number
|
---|
| 2720 | lsl.w #2,d0 * Use as index
|
---|
| 2721 | lea acctim(a5),a0 * ... into acctim
|
---|
| 2722 | move.l _hz_200(a5),0(a0,d0) * Set last access time
|
---|
| 2723 | cmp.w #1,nflops(a5)
|
---|
| 2724 | bne flopok01
|
---|
| 2725 | *
|
---|
| 2726 | move.l _hz_200(a5),4(a0) * Time for other drive
|
---|
| 2727 | *
|
---|
| 2728 | flopok01: move.w flpsrsv,sr * Restore sr (enable ints)
|
---|
| 2729 | move.l (a7)+,d0 * Restore error number to d0
|
---|
| 2730 | movem.l flpregs,d3-d7/a3-a6 * Restore registers
|
---|
| 2731 | clr.w flock * Release flopvbl routine
|
---|
| 2732 | rts * Return to caller
|
---|
| 2733 | *
|
---|
| 2734 | .page
|
---|
| 2735 | *
|
---|
| 2736 | * hseek -- seek to track in ctrack
|
---|
| 2737 | * ----- -----------------------
|
---|
| 2738 | hseek: move.w ctrack,d7 * Get ctrack
|
---|
| 2739 | *
|
---|
| 2740 | * hseek1 -- seek to track in d7
|
---|
| 2741 | * ------ -------------------
|
---|
| 2742 | hseek1: move.w #ERR10,curerr * Set curerr = "seek error"
|
---|
| 2743 | move.b d7,DSKDAT(a6) * Send track number to WD1772
|
---|
| 2744 | move.w #FL_SK,d6 * Seek command
|
---|
| 2745 | bra flopcmds * Go send command to WD1772
|
---|
| 2746 | *
|
---|
| 2747 | * reseek -- Restore, then re-seek
|
---|
| 2748 | * ------ ---------------------
|
---|
| 2749 | reseek: move.w #ERR10,curerr * Set curerr = "seek error"
|
---|
| 2750 | bsr restore * Restore
|
---|
| 2751 | bne reseek01 * Jump if error occurred
|
---|
| 2752 | *
|
---|
| 2753 | clr.w 0(a1) * Clear current track to 0
|
---|
| 2754 | move.b #0,DSKTRK(a6) * Send track to WD1772
|
---|
| 2755 | move.b #5,DSKDAT(a6) * Setup to seek to track 5
|
---|
| 2756 | move.w #FL_SK,d6 * Seek command
|
---|
| 2757 | bsr flopcmds * Seek
|
---|
| 2758 | bne reseek01 * Jump if error
|
---|
| 2759 | *
|
---|
| 2760 | move.w #5,0(a1) * Update current track = 5
|
---|
| 2761 | *
|
---|
| 2762 | * go2track -- seek with verify
|
---|
| 2763 | * -------- ----------------
|
---|
| 2764 | go2track: move.w #ERR10,curerr(a5) * Set curerr = "seek error"
|
---|
| 2765 | move.w ctrack(a5),d7 * Put track # in d7
|
---|
| 2766 | move.b d7,DSKDAT(a6) * Send track to WD1772
|
---|
| 2767 | moveq.l #FL_SV,d6 * Seek/verify command
|
---|
| 2768 | bsr flopcmds * Send command to floppy
|
---|
| 2769 | bne reseek01 * Jump if error occurred
|
---|
| 2770 | *
|
---|
| 2771 | move.w ctrack(a5),0(a1) * Update track number in dsb
|
---|
| 2772 | and.b #$18,d7 * Test for RNF, CRC, LOST
|
---|
| 2773 | *
|
---|
| 2774 | reseek01: rts * Return to caller
|
---|
| 2775 | *
|
---|
| 2776 | .page
|
---|
| 2777 | *
|
---|
| 2778 | * restore -- Restore to track 0
|
---|
| 2779 | * ------- ------------------
|
---|
| 2780 | restore: clr.w d6 * Restore command
|
---|
| 2781 | bsr flopcmds * Send to WD1772
|
---|
| 2782 | bne restor01 * Jump if an error occurred
|
---|
| 2783 | *
|
---|
| 2784 | btst #2,d7 * Check track 0 bit
|
---|
| 2785 | eori #0004,sr * Invert Z flag in 680000 sr
|
---|
| 2786 | bne restor01 * Jump if not track 0
|
---|
| 2787 | *
|
---|
| 2788 | clr.w 0(a1) * Set track = 0 in dsb
|
---|
| 2789 | *
|
---|
| 2790 | restor01: rts * Return to caller
|
---|
| 2791 | *
|
---|
| 2792 | * flopcmds -- Send command to WD1772 floppy controller
|
---|
| 2793 | * -------- ----------------------------------------
|
---|
| 2794 | flopcmds: move.w 2(a1),d0 * Get seek rate from dsb
|
---|
| 2795 | and.b #$3,d0 * ...
|
---|
| 2796 | or.b d0,d6 * OR into command word
|
---|
| 2797 | move.l #$40000,d7 * Set timeout counter
|
---|
| 2798 | btst #7,DSKCMD(a6) * Motor on ?
|
---|
| 2799 | bne flopcm01 * Jump if so
|
---|
| 2800 | *
|
---|
| 2801 | move.l #$60000,d7 * Set longer timeout count
|
---|
| 2802 | *
|
---|
| 2803 | flopcm01: move.b d6,DSKCMD(a6) * Write command from d6
|
---|
| 2804 | *
|
---|
| 2805 | move.l #$1000,d0 * Set initial busy timeout in d0
|
---|
| 2806 | *
|
---|
| 2807 | flopcm04: btst #0,DSKCMD(a6) * Controller busy yet ?
|
---|
| 2808 | bne flopcm02 * Jump if so
|
---|
| 2809 | *
|
---|
| 2810 | subq.l #1,d0 * Decrement timeout counter
|
---|
| 2811 | beq flopcm03 * Jump if timed out
|
---|
| 2812 | *
|
---|
| 2813 | bra flopcm04 * Wait for busy some more
|
---|
| 2814 | *
|
---|
| 2815 | flopcm02: subq.l #1,d7 * Decrement timeout counter
|
---|
| 2816 | beq flopcm03 * Jump if timed out
|
---|
| 2817 | *
|
---|
| 2818 | btst #0,DSKCMD(a6) * WD1772 done ?
|
---|
| 2819 | bne flopcm02 * Jump if not
|
---|
| 2820 | *
|
---|
| 2821 | moveq.l #0,d7 * Clear out upper bits of d7
|
---|
| 2822 | move.b DSKCMD(a6),d7 * Read status into LS byte of d7
|
---|
| 2823 | moveq.l #0,d6 * Clear error flag in d6
|
---|
| 2824 | rts * Return to caller
|
---|
| 2825 | *
|
---|
| 2826 | flopcm03: bsr rs1772 * Reset WD1772 (end transfer)
|
---|
| 2827 | moveq.l #1,d6 * Set error flag in d6
|
---|
| 2828 | rts * Return to caller
|
---|
| 2829 | *
|
---|
| 2830 | .page
|
---|
| 2831 | *
|
---|
| 2832 | * rs1772 -- Reset WD1772 floppy controller
|
---|
| 2833 | * ------ ------------------------------
|
---|
| 2834 | rs1772: move.b #FL_FR,DSKCMD(a6) * Send reset to WD1772
|
---|
| 2835 | move.w #15,d7 * Set delay count
|
---|
| 2836 | *
|
---|
| 2837 | rs1772a: dbf d7,rs1772a * Delay a while
|
---|
| 2838 | rts * Return to caller
|
---|
| 2839 | *
|
---|
| 2840 | * select -- Select drive and side
|
---|
| 2841 | * ------ ----------------------
|
---|
| 2842 | select: move.w sr,-(a7) * Save sr on stack
|
---|
| 2843 | ori.w #IPL7,sr * Disable interrupts
|
---|
| 2844 | clr.w deslflag(a5) * Clear deselect flag
|
---|
| 2845 | move.b _mc1_ior+cfr1,d0 * Get current MC1 cfr1 image
|
---|
| 2846 | ori.b #1,d0 * Select drive (we only have 1)
|
---|
| 2847 | move.b d0,_mc1_ior+cfr1 * Store updated image
|
---|
| 2848 | move.b d0,MC1ACIA+ACIA_CFR * Send it to the MC1 ACIA
|
---|
| 2849 | move.w cside(a5),d0 * Get side number (LS bit)
|
---|
| 2850 | and.w #1,d0 * Mask off garbage bits
|
---|
| 2851 | andi.b #$FE,_mc2_ior+cfr1 * Mask off D0 in MC2 cfr1 image
|
---|
| 2852 | or.b _mc2_ior+cfr1,d0 * OR side with _mc2_ior cfr1
|
---|
| 2853 | move.b d0,_mc2_ior+cfr1 * Store updated cfr1 image
|
---|
| 2854 | move.b d0,MC2ACIA+ACIA_CFR * Send it to the MC2 ACIA
|
---|
| 2855 | move.w (a7)+,sr * Restore interrupts
|
---|
| 2856 | move.w 0(a1),d7 * Get track from dsb
|
---|
| 2857 | move.b d7,DSKTRK(a6) * Send it to the WD1772
|
---|
| 2858 | clr.b tmpdma(a5) * Clear bits 31..24 of tmpdma
|
---|
| 2859 | *
|
---|
| 2860 | select1: move.w csect(a5),d7 * Get sector number
|
---|
| 2861 | move.b d7,DSKSEC(a6) * Send it to the WD1772
|
---|
| 2862 | move.l cdma(a5),a0 * Setup transfer address in a0
|
---|
| 2863 | rts * Return to caller
|
---|
| 2864 | *
|
---|
| 2865 | .page
|
---|
| 2866 | *
|
---|
| 2867 | * change -- Check for disk change status
|
---|
| 2868 | * ------ ----------------------------
|
---|
| 2869 | change: cmp.w #1,nflops * Check # of floppies
|
---|
| 2870 | bne change02
|
---|
| 2871 | *
|
---|
| 2872 | move.w 16(a7),d0 * Drive number to d0
|
---|
| 2873 | cmp.w disknum,d0
|
---|
| 2874 | beq change01 * Jump if =
|
---|
| 2875 | *
|
---|
| 2876 | move.w d0,-(a7) * Stack drive number
|
---|
| 2877 | move.w #ERR17,-(a7) * Stack error code
|
---|
| 2878 | bsr criterr * Do critical error routine
|
---|
| 2879 | addq.w #4,a7 * Cleanup stack
|
---|
| 2880 | move.w #$FFFF,wplatch * Status for drives = "unsure"
|
---|
| 2881 | move.w 16(a7),disknum * Save disk number
|
---|
| 2882 | *
|
---|
| 2883 | change01: clr.w 16(a7) * Clear disk number
|
---|
| 2884 | *
|
---|
| 2885 | change02: rts * Return to caller
|
---|
| 2886 | *
|
---|
| 2887 | * setdmode -- Set drive change mode
|
---|
| 2888 | * -------- ---------------------
|
---|
| 2889 | setdmode: lea dskmode,a0 * Point at disk mode table
|
---|
| 2890 | move.b d0,-(a7) * Save mode on stack
|
---|
| 2891 | move.w cdev(a5),d0 * Get drive number
|
---|
| 2892 | move.b (a7)+,0(a0,d0) * Set drive mode / cleanup stack
|
---|
| 2893 | rts * Return to caller
|
---|
| 2894 | *
|
---|
| 2895 | .page
|
---|
| 2896 | *
|
---|
| 2897 | * bootload -- Load boot sector
|
---|
| 2898 | * -------- ----------------
|
---|
| 2899 | bootload: link a6,#0 * Link stack frames
|
---|
| 2900 | movem.l d6-d7,-(a7) * Save registers
|
---|
| 2901 | jsr _hdvini * Init drive
|
---|
| 2902 | tst.w nflops * See if any connected
|
---|
| 2903 | beq bootld01 * Jump if drive there
|
---|
| 2904 | *
|
---|
| 2905 | moveq.l #1,d0 * "couldn't load"
|
---|
| 2906 | bra bootld02
|
---|
| 2907 | *
|
---|
| 2908 | bootld01: moveq.l #2,d0 * "no drive connected"
|
---|
| 2909 | *
|
---|
| 2910 | bootld02: move.w d0,d7 * Save possible error in d7
|
---|
| 2911 | tst.w nflops
|
---|
| 2912 | beq bootld04
|
---|
| 2913 | *
|
---|
| 2914 | cmp.w #2,bootdev
|
---|
| 2915 | bge bootld04
|
---|
| 2916 | *
|
---|
| 2917 | move.w #1,(a7) * Sector count = 1,
|
---|
| 2918 | clr.w -(a7) * ... side = 0,
|
---|
| 2919 | clr.w -(a7) * ... track = 0,
|
---|
| 2920 | move.w #1,-(a7) * ... sector = 1,
|
---|
| 2921 | move.w bootdev,-(a7) * ... drive = bootdev,
|
---|
| 2922 | clr.l -(a7) * ... filler,
|
---|
| 2923 | move.l #buffer,-(a7) * ... buffer address
|
---|
| 2924 | jsr floprd * Read the sector
|
---|
| 2925 | add.l #16,a7 * Cleanup stack
|
---|
| 2926 | tst.l d0 * Error ?
|
---|
| 2927 | bne bootld03 * Jump if not
|
---|
| 2928 | *
|
---|
| 2929 | clr.w d7
|
---|
| 2930 | bra bootld04
|
---|
| 2931 | *
|
---|
| 2932 | bootld03: tst.b wpstatus
|
---|
| 2933 | bne bootld04
|
---|
| 2934 | *
|
---|
| 2935 | moveq.l #3,d0 * "unreadable"
|
---|
| 2936 | bra bootld07
|
---|
| 2937 | *
|
---|
| 2938 | bootld04: tst.w d7
|
---|
| 2939 | beq bootld05
|
---|
| 2940 | *
|
---|
| 2941 | move.w d7,d0 * Get old error code
|
---|
| 2942 | bra bootld07
|
---|
| 2943 | *
|
---|
| 2944 | .page
|
---|
| 2945 | *
|
---|
| 2946 | bootld05: move.w #256,(a7) * Set count for 256 words
|
---|
| 2947 | move.l #buffer,-(a7) * Point at buffer
|
---|
| 2948 | bsr chksum * Calculate checksum
|
---|
| 2949 | addq.l #4,a7 * Cleanup stack
|
---|
| 2950 | cmp.w #$1234,d0 * Boot sector checksum ?
|
---|
| 2951 | bne bootld06 * Jump if not
|
---|
| 2952 | *
|
---|
| 2953 | clr.w d0 * Set flag for OK
|
---|
| 2954 | move.w bootdev,booted * Save last boot device
|
---|
| 2955 | bra bootld07
|
---|
| 2956 | *
|
---|
| 2957 | bootld06: moveq.l #4,d0 * "not valid boot sector"
|
---|
| 2958 | *
|
---|
| 2959 | bootld07: tst.l (a7)+
|
---|
| 2960 | movem.l (a7)+,d7 * Restore registers
|
---|
| 2961 | unlk a6
|
---|
| 2962 | rts * Return to caller
|
---|
| 2963 | *
|
---|
| 2964 | .page
|
---|
| 2965 | *
|
---|
| 2966 | * chksum -- caluculate checksum
|
---|
| 2967 | * ------ -------------------
|
---|
| 2968 | chksum: link a6,#0
|
---|
| 2969 | movem.l d6-d7,-(a7) * Preserve registers
|
---|
| 2970 | clr.w d7 * Clear sum
|
---|
| 2971 | bra chksum02 * Jump into loop
|
---|
| 2972 | *
|
---|
| 2973 | chksum01: move.l 8(a6),a0 * Get buffer address
|
---|
| 2974 | move.w (a0),d0 * Get word
|
---|
| 2975 | add.w d0,d7 * Add to checksum in d7
|
---|
| 2976 | addq.l #2,8(a6) * Update buffer address
|
---|
| 2977 | *
|
---|
| 2978 | chksum02: move.w 12(a6),d0 * Get word count
|
---|
| 2979 | subq.w #1,12(a6) * Decrement it
|
---|
| 2980 | tst.w d0 * Done ?
|
---|
| 2981 | bne chksum01 * Loop if not
|
---|
| 2982 | *
|
---|
| 2983 | move.w d7,d0 * Put result in d0
|
---|
| 2984 | tst.l (a7)+
|
---|
| 2985 | movem.l (a7)+,d7 * Restore registers
|
---|
| 2986 | unlk a6
|
---|
| 2987 | rts * Return to caller
|
---|
| 2988 | *
|
---|
| 2989 | .page
|
---|
| 2990 | *
|
---|
| 2991 | * mult32 -- 32 bit signed multiply
|
---|
| 2992 | * ------ ----------------------
|
---|
| 2993 | mult32: link a6,#-4
|
---|
| 2994 | clr.w d2
|
---|
| 2995 | tst.l 8(a6)
|
---|
| 2996 | bge mult32a
|
---|
| 2997 | *
|
---|
| 2998 | neg.l 8(a6)
|
---|
| 2999 | addq.w #1,d2
|
---|
| 3000 | *
|
---|
| 3001 | mult32a: tst.l 12(a6)
|
---|
| 3002 | bge mult32b
|
---|
| 3003 | *
|
---|
| 3004 | neg.l 12(a6)
|
---|
| 3005 | addq.w #1,d2
|
---|
| 3006 | *
|
---|
| 3007 | mult32b: move.w 10(a6),d0
|
---|
| 3008 | mulu 14(a6),d0
|
---|
| 3009 | move.l d0,-4(a6)
|
---|
| 3010 | move.w 8(a6),d0
|
---|
| 3011 | mulu 14(a6),d0
|
---|
| 3012 | move.w 12(a6),d1
|
---|
| 3013 | mulu 10(a6),d1
|
---|
| 3014 | add.w d1,d0
|
---|
| 3015 | add.w -4(a6),d0
|
---|
| 3016 | move.w d0,-4(a6)
|
---|
| 3017 | move.l -4(a6),d0
|
---|
| 3018 | btst #0,d2
|
---|
| 3019 | beq mult32c
|
---|
| 3020 | *
|
---|
| 3021 | neg.l d0
|
---|
| 3022 | *
|
---|
| 3023 | mult32c: unlk a6
|
---|
| 3024 | rts
|
---|
| 3025 | *
|
---|
| 3026 | .page
|
---|
| 3027 | *
|
---|
| 3028 | * rand -- Generate a random number
|
---|
| 3029 | * ---- ------------------------
|
---|
| 3030 | rand: link a6,#-4 * Reserve stack for temps
|
---|
| 3031 | tst.l rseed * See if the seed is zero
|
---|
| 3032 | bne rand01 * Jump if not
|
---|
| 3033 | *
|
---|
| 3034 | move.l _hz_200,d0 * Pick up the 200 Hz clock
|
---|
| 3035 | moveq.l #16,d1 * Shift it left
|
---|
| 3036 | asl.l d1,d0 * ...
|
---|
| 3037 | or.l _hz_200,d0 * OR in current 200 Hz clock
|
---|
| 3038 | move.l d0,rseed * Use that as the seed
|
---|
| 3039 | *
|
---|
| 3040 | rand01: move.l #$BB40E62D,-(a7) * Put PI on the stack
|
---|
| 3041 | move.l rseed,-(a7) * ... and rseed, too
|
---|
| 3042 | bsr mult32 * Multiply them
|
---|
| 3043 | addq.l #8,a7 * Cleanup stack
|
---|
| 3044 | addq.l #1,d0 * Add 1 to the result
|
---|
| 3045 | move.l d0,rseed * Save as new seed
|
---|
| 3046 | move.l rseed,d0
|
---|
| 3047 | asr.l #8,d0 * Make it a 24 bit number
|
---|
| 3048 | and.l #$FFFFFF,d0 * ...
|
---|
| 3049 | unlk a6 * Release stack
|
---|
| 3050 | rts * Return to caller
|
---|
| 3051 | *
|
---|
| 3052 | .page
|
---|
| 3053 | *
|
---|
| 3054 | * protobt -- Generate a prototype boot sector
|
---|
| 3055 | * ------- --------------------------------
|
---|
| 3056 | protobt: link a6,#-6
|
---|
| 3057 | movem.l d5-d7/a5,-(a7) * Save registers
|
---|
| 3058 | tst.w 18(a6) * Test execflg
|
---|
| 3059 | bge protbt03 * Jump if set
|
---|
| 3060 | *
|
---|
| 3061 | move.w #256,(a7) * Count = 256 words
|
---|
| 3062 | move.l 8(a6),-(a7) * Address of buffer
|
---|
| 3063 | bsr chksum * Calculate checksum
|
---|
| 3064 | addq.l #4,a7 * Cleanup stack
|
---|
| 3065 | cmp.w #$1234,d0 * Boot checksum ?
|
---|
| 3066 | beq protbt01 * Jump if so
|
---|
| 3067 | *
|
---|
| 3068 | clr.w d0 * Not executable
|
---|
| 3069 | bra protbt02
|
---|
| 3070 | *
|
---|
| 3071 | protbt01: moveq.l #1,d0 * Executable
|
---|
| 3072 | *
|
---|
| 3073 | protbt02: move.w d0,18(a6) * Set execflg
|
---|
| 3074 | *
|
---|
| 3075 | protbt03: tst.l 12(a6) * Serial number ?
|
---|
| 3076 | blt protbt07 * Jump if not to be changed
|
---|
| 3077 | *
|
---|
| 3078 | move.l 12(a6),d0 * Get it into d0
|
---|
| 3079 | cmp.l #$FFFFFF,d0 * > $FFFFFF
|
---|
| 3080 | ble protbt04 * Jump if not
|
---|
| 3081 | *
|
---|
| 3082 | bsr rand * Generate a random number
|
---|
| 3083 | move.l d0,12(a6) * Save as s/n
|
---|
| 3084 | *
|
---|
| 3085 | protbt04: clr.w d7 * Clear counter
|
---|
| 3086 | bra protbt06 * Enter move loop
|
---|
| 3087 | *
|
---|
| 3088 | .page
|
---|
| 3089 | *
|
---|
| 3090 | protbt05: move.l 12(a6),d0 * Get s/n
|
---|
| 3091 | and.l #$FF,d0 * Isolate low 8 bits
|
---|
| 3092 | move.w d7,a1 * Point to next byte
|
---|
| 3093 | add.l 8(a6),a1 * ...
|
---|
| 3094 | move.b d0,8(a1) * Write byte in buffer
|
---|
| 3095 | move.l 12(a6),d0 * Get s/n
|
---|
| 3096 | asr.l #8,d0 * Shift right 8 bits
|
---|
| 3097 | move.l d0,12(a6) * Save shifted value
|
---|
| 3098 | addq.w #1,d7 * Update counter
|
---|
| 3099 | *
|
---|
| 3100 | protbt06: cmp.w #3,d7 * See if we're done
|
---|
| 3101 | blt protbt05 * Loop if not
|
---|
| 3102 | *
|
---|
| 3103 | protbt07: tst.w 16(a6) * Diskette size ?
|
---|
| 3104 | blt protbt10 * Jump if not to be changed
|
---|
| 3105 | *
|
---|
| 3106 | move.w 16(a6),d6 * Get diskette size
|
---|
| 3107 | muls.w #19,d6 * ... times 19 as pointer
|
---|
| 3108 | clr.w d7 * Clear counter
|
---|
| 3109 | bra protbt09 * Go move in BPB
|
---|
| 3110 | *
|
---|
| 3111 | protbt08: move.w d7,a0 * Get counter
|
---|
| 3112 | add.l 8(a6),a0 * Add base of buffer
|
---|
| 3113 | move.w d6,a1 * Get BPB pointer
|
---|
| 3114 | add.l #pbpbtab,a1 * Add base of prototype BPB's
|
---|
| 3115 | move.b (a1),11(a0) * Copy BPB data
|
---|
| 3116 | addq.w #1,d6 * Update pointer
|
---|
| 3117 | addq.w #1,d7 * Update counter
|
---|
| 3118 | *
|
---|
| 3119 | protbt09: cmp.w #19,d7 * Done ?
|
---|
| 3120 | blt protbt08 * Loop if not
|
---|
| 3121 | *
|
---|
| 3122 | protbt10: clr.w -6(a6)
|
---|
| 3123 | move.l 8(a6),-4(a6)
|
---|
| 3124 | bra protbt12
|
---|
| 3125 | *
|
---|
| 3126 | .page
|
---|
| 3127 | *
|
---|
| 3128 | protbt11: move.l -4(a6),a0 * Get buffer pointer
|
---|
| 3129 | move.w (a0),d0 * Get word from buffer
|
---|
| 3130 | add.w d0,-6(a6) * Sum for checksum
|
---|
| 3131 | addq.l #2,-4(a6) * Point at next word
|
---|
| 3132 | *
|
---|
| 3133 | protbt12: move.l 8(a6),d0 * Get buffer address
|
---|
| 3134 | add.l #$1FE,d0 * Plus sector length
|
---|
| 3135 | cmp.l -4(a6),d0 * Done ?
|
---|
| 3136 | bhi protbt11 * Loop if not
|
---|
| 3137 | *
|
---|
| 3138 | move.w #$1234,d0 * Checksum for boot sector
|
---|
| 3139 | sub.w -6(a6),d0 * Subtract checksum for buffer
|
---|
| 3140 | move.l -4(a6),a1
|
---|
| 3141 | move.w d0,(a1) * Store checksum in buffer
|
---|
| 3142 | tst.w 18(a6) * Check execflg
|
---|
| 3143 | bne protbt13 * Boot sector to be executable ?
|
---|
| 3144 | *
|
---|
| 3145 | move.l -4(a6),a0 * Mung checksum so it's not
|
---|
| 3146 | addq.w #1,(a0)
|
---|
| 3147 | *
|
---|
| 3148 | protbt13: tst.l (a7)+
|
---|
| 3149 | movem.l (a7)+,d6-d7/a5 * Restore registers
|
---|
| 3150 | unlk a6 * Release stack
|
---|
| 3151 | rts * Return to caller
|
---|
| 3152 | *
|
---|
| 3153 | * criterr -- Critical error handler
|
---|
| 3154 | * ------- ----------------------
|
---|
| 3155 | criterr: move.l critvec,-(a7) * Put error vector on stack
|
---|
| 3156 | moveq.l #-1,d0 * Set default error return
|
---|
| 3157 | rts * "Return" to handler
|
---|
| 3158 | *
|
---|
| 3159 | .page
|
---|
| 3160 | *
|
---|
| 3161 | * __MTInt3 -- Analog processor second level interrupt handler
|
---|
| 3162 | * -------- -----------------------------------------------
|
---|
| 3163 | *
|
---|
| 3164 | __MTInt3: pea MT_ISEM3 * Wait for an interrupt
|
---|
| 3165 | jsr SM_Wait * ...
|
---|
| 3166 | tst.l (a7)+ * ...
|
---|
| 3167 | moveq.l #0,d0 * Read input port
|
---|
| 3168 | move.b ANALOG,d0 * ... into d0[7..0]
|
---|
| 3169 | move.b d0,api_inp * ... and api_inp
|
---|
| 3170 | btst #7,d0 * Check for signal number flag
|
---|
| 3171 | bne api_s0a * Jump if signal number read
|
---|
| 3172 | *
|
---|
| 3173 | lea api_tv,a0 * Get api_tv base in a0
|
---|
| 3174 | clr.w d1 * Get api_sv in d1
|
---|
| 3175 | move.b api_sv,d1 * ...
|
---|
| 3176 | cmpi.b #6,d1 * Check range
|
---|
| 3177 | bhi api_sve * Jump if out of range
|
---|
| 3178 | *
|
---|
| 3179 | lsl.w #2,d1 * Develop jump address
|
---|
| 3180 | move.l 0(a0,d1.W),a1 * ... from api_tv in a1
|
---|
| 3181 | jmp (a1) * Jump to state handler
|
---|
| 3182 | *
|
---|
| 3183 | api_s0: btst #7,d0 * Check for signal number flag
|
---|
| 3184 | beq __MTInt3 * Done if not signal number
|
---|
| 3185 | *
|
---|
| 3186 | api_s0a: clr.b api_val * Clear value byte
|
---|
| 3187 | andi.b #$7F,d0 * Mask off signal number flag
|
---|
| 3188 | cmpi.b #82,d0 * See if it's in range
|
---|
| 3189 | bhi api_err * Jump if out of range (GT 82)
|
---|
| 3190 | *
|
---|
| 3191 | move.b d0,api_sig * Store signal number
|
---|
| 3192 | beq api_pub * Jump if it was "all off"
|
---|
| 3193 | *
|
---|
| 3194 | lea api_tab,a0 * Get sv table base
|
---|
| 3195 | move.b 0(a0,d0.W),api_sv * Set sv for next time
|
---|
| 3196 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3197 | *
|
---|
| 3198 | api_err: move.b d0,api_bug * Catch the bug
|
---|
| 3199 | clr.b api_sv * Force state zero
|
---|
| 3200 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3201 | *
|
---|
| 3202 | api_sve: move.b d1,api_svb * Catch the bug
|
---|
| 3203 | clr.b api_sv * Force state zero
|
---|
| 3204 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3205 | *
|
---|
| 3206 | .page
|
---|
| 3207 | api_s1: btst #0,d0 * See if it takes a value
|
---|
| 3208 | beq api_s1a * Jump if not
|
---|
| 3209 | *
|
---|
| 3210 | move.b #2,api_sv * Set sv for state 2
|
---|
| 3211 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3212 | *
|
---|
| 3213 | api_s1a: clr.b api_val * Clear value byte
|
---|
| 3214 | bra api_pub * Go output to FIFO
|
---|
| 3215 | *
|
---|
| 3216 | api_s2: ori.b #$80,d0 * Set status = 1
|
---|
| 3217 | move.b d0,api_val * Set value byte
|
---|
| 3218 | bra api_pub * Go output to FIFO
|
---|
| 3219 | *
|
---|
| 3220 | api_s3: ror.b #1,d0 * Set status in value byte
|
---|
| 3221 | andi.b #$80,d0 * ...
|
---|
| 3222 | move.b d0,api_val * ...
|
---|
| 3223 | move.b #4,api_sv * Set sv for state 4
|
---|
| 3224 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3225 | *
|
---|
| 3226 | api_s4: or.b d0,api_val * Set value byte
|
---|
| 3227 | bra api_pub * Go output to FIFO
|
---|
| 3228 | *
|
---|
| 3229 | api_s5: ror.b #1,d0 * Set status in value byte
|
---|
| 3230 | andi.b #$80,d0 * ...
|
---|
| 3231 | *
|
---|
| 3232 | api_s6: move.b d0,api_val * Set value byte
|
---|
| 3233 | *
|
---|
| 3234 | .page
|
---|
| 3235 | *
|
---|
| 3236 | api_pub: movea.l api_fi,a0 * Get FIFO input pointer in a0
|
---|
| 3237 | move.w api_sig,(a0)+ * Store new input
|
---|
| 3238 | cmpa.l #api_fe,a0 * Wrap around ?
|
---|
| 3239 | bcs api_pb1 * Jump if not
|
---|
| 3240 | *
|
---|
| 3241 | movea.l #api_fum,a0 * Wrap input pointer to start
|
---|
| 3242 | *
|
---|
| 3243 | api_pb1: move.l a0,api_fi * Update input pointer
|
---|
| 3244 | cmpa.l api_fo,a0 * Buffer full ?
|
---|
| 3245 | bne api_pb3 * Jump if not
|
---|
| 3246 | *
|
---|
| 3247 | movea.l api_fo,a1 * Get FIFO output pointer in a1
|
---|
| 3248 | adda.l #2,a1 * Increment it
|
---|
| 3249 | cmpa.l #api_fe,a1 * Wrap around ?
|
---|
| 3250 | bcs api_pb2 * Jump if not
|
---|
| 3251 | *
|
---|
| 3252 | movea.l #api_fum,a1 * Wrap output pointer to start
|
---|
| 3253 | *
|
---|
| 3254 | api_pb2: move.l a1,api_fo * Set new output pointer
|
---|
| 3255 | clr.b api_sv * Set state to 0
|
---|
| 3256 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3257 | *
|
---|
| 3258 | api_pb3: pea _SemAPI * Signal FIFO has a new value
|
---|
| 3259 | jsr SM_Sig * ...
|
---|
| 3260 | tst.l (a7)+ * ...
|
---|
| 3261 | clr.b api_sv * Set state to to 0
|
---|
| 3262 | bra __MTInt3 * Go wait for next interrupt
|
---|
| 3263 | *
|
---|
| 3264 | .page
|
---|
| 3265 | *
|
---|
| 3266 | * api_get -- Get analog input
|
---|
| 3267 | * ------- ----------------
|
---|
| 3268 | api_get: pea _SemAPI * Wait on FIFO not-empty
|
---|
| 3269 | jsr SM_Wait * ...
|
---|
| 3270 | tst.l (a7)+ * ...
|
---|
| 3271 | move.w sr,-(a7) * Save status register
|
---|
| 3272 | ori.w #IPL3,sr * Disable ANALOG I/O interrupts
|
---|
| 3273 | movea.l api_fo,a0 * Get fifo output pointer
|
---|
| 3274 | moveq.l #0,d0 * Get fifo value
|
---|
| 3275 | move.w (a0)+,d0 * ...
|
---|
| 3276 | cmpa.l #api_fe,a0 * See if pointer wrapped
|
---|
| 3277 | bcs api_g2 * Jump if not
|
---|
| 3278 | *
|
---|
| 3279 | movea.l #api_fum,a0 * Wrap the pointer around
|
---|
| 3280 | *
|
---|
| 3281 | api_g2: move.l a0,api_fo * Update pointer
|
---|
| 3282 | move.w (a7)+,sr * Restore interrupt mask
|
---|
| 3283 | rts * Return to caller
|
---|
| 3284 | *
|
---|
| 3285 | .page
|
---|
| 3286 | *
|
---|
| 3287 | * api_chk -- check analog FIFO status
|
---|
| 3288 | * ------- ------------------------
|
---|
| 3289 | api_chk: move.w sr,-(a7) * Save status register
|
---|
| 3290 | ori.w #IPL3,sr * Disable analog I/O interrupts
|
---|
| 3291 | move.l _SemAPI,d0 * Get FIFO semaphore
|
---|
| 3292 | beq api_g0 * Jump if un-initialized (empty)
|
---|
| 3293 | *
|
---|
| 3294 | btst.l #0,d0 * See if FIFO is empty
|
---|
| 3295 | bne api_g1 * Jump if maybe not
|
---|
| 3296 | *
|
---|
| 3297 | api_g0: moveq.l #0,d0 * Set empty FIFO value
|
---|
| 3298 | move.w (a7)+,sr * Restore interrupt mask
|
---|
| 3299 | rts * Return to caller
|
---|
| 3300 | *
|
---|
| 3301 | api_g1: andi.l #$FFFFFFFE,d0 * Check the count
|
---|
| 3302 | beq api_g0 * Jump if count is 0
|
---|
| 3303 | *
|
---|
| 3304 | moveq.l #-1,d0 * Set non-empty FIFO value
|
---|
| 3305 | move.w (a7)+,sr * Restore interrupt mask
|
---|
| 3306 | rts * Return to caller
|
---|
| 3307 | *
|
---|
| 3308 | .page
|
---|
| 3309 | *
|
---|
| 3310 | * api_zap -- clear analog I/O FIFO
|
---|
| 3311 | * ------- ---------------------
|
---|
| 3312 | api_zap: move.w sr,-(a7) * Save status register
|
---|
| 3313 | ori.w #IPL3,sr * Disable analog I/O interrupts
|
---|
| 3314 | move.l #api_fum,api_fi * Clear analog processor fifo
|
---|
| 3315 | move.l #api_fum,api_fo * ...
|
---|
| 3316 | move.l _SemAPI,d0 * Get semaphore value
|
---|
| 3317 | beq api_z0 * Jump if it's all zeroes
|
---|
| 3318 | *
|
---|
| 3319 | btst.l #0,d0 * See if it's a count
|
---|
| 3320 | beq api_z1 * Jump if not (waiting task)
|
---|
| 3321 | *
|
---|
| 3322 | api_z0: move.l #1,_SemAPI * Reset semaphore (count = 0)
|
---|
| 3323 | *
|
---|
| 3324 | api_z1: move.w (a7)+,sr * Restore interrupt mask
|
---|
| 3325 | rts
|
---|
| 3326 |
|
---|
| 3327 | *
|
---|
| 3328 | * get_mtd -- get Multi-Tasker interface block pointer
|
---|
| 3329 | * ------- ----------------------------------------
|
---|
| 3330 | get_mtd: move.l #mtdefs,d0
|
---|
| 3331 | rts
|
---|
| 3332 | *
|
---|
| 3333 | .page
|
---|
| 3334 | *************************************************************************
|
---|
| 3335 | ************************* Constant definitions **************************
|
---|
| 3336 | *************************************************************************
|
---|
| 3337 | *
|
---|
| 3338 | .even
|
---|
| 3339 | *
|
---|
| 3340 | * t13tab -- Trap-13 pointer table -- Primary BIOS functions
|
---|
| 3341 | * ------ -----------------------------------------------
|
---|
| 3342 | t13tab: dc.w 12 * Number of Trap-13 routines
|
---|
| 3343 | *
|
---|
| 3344 | dc.l nullrts * 0 - (getmpb)
|
---|
| 3345 | dc.l bconstat * 1 - bconstat
|
---|
| 3346 | dc.l bconin * 2 - bconin
|
---|
| 3347 | dc.l bconout * 3 - bconout
|
---|
| 3348 | dc.l rwabs * 4 - rwabs
|
---|
| 3349 | dc.l setexec * 5 - setexec
|
---|
| 3350 | dc.l nullrts * 6 - (tickcal)
|
---|
| 3351 | dc.l getbpb * 7 - getbpb
|
---|
| 3352 | dc.l bcostat * 8 - bcostat
|
---|
| 3353 | dc.l mediach * 9 - mediach
|
---|
| 3354 | dc.l drvmap * 10 - drvmap
|
---|
| 3355 | dc.l nullrts * 11 - (shift)
|
---|
| 3356 | *
|
---|
| 3357 | * t14tab -- Trap-14 pointer table -- Extended BIOS functions (Buchla 700 only)
|
---|
| 3358 | * ------ ------------------------------------------------------------------
|
---|
| 3359 | t14tab: dc.w 12 * Number of trap14 routines
|
---|
| 3360 | *
|
---|
| 3361 | dc.l piorec * 0 - Get iorec address
|
---|
| 3362 | dc.l setport * 1 - Set ACIA parameters
|
---|
| 3363 | dc.l floprd * 2 - Read floppy
|
---|
| 3364 | dc.l flopwr * 3 - Write floppy
|
---|
| 3365 | dc.l flopfmt * 4 - Format floppy
|
---|
| 3366 | dc.l flopver * 5 - Verify floppy
|
---|
| 3367 | dc.l protobt * 6 - Create proto. boot sector
|
---|
| 3368 | dc.l rand * 7 - Generate random number
|
---|
| 3369 | dc.l api_get * 8 - Get analog input
|
---|
| 3370 | dc.l api_zap * 9 - Clear analog FIFO
|
---|
| 3371 | dc.l api_chk * 10 - Check analog FIFO
|
---|
| 3372 | dc.l get_mtd * 11 - Get MT interface block
|
---|
| 3373 | *
|
---|
| 3374 | .even
|
---|
| 3375 | *
|
---|
| 3376 | *
|
---|
| 3377 | .page
|
---|
| 3378 | *
|
---|
| 3379 | * cdt01 -- Character device dispatch table #1 -- input status
|
---|
| 3380 | * ----- --------------------------------------------------
|
---|
| 3381 | cdt01: dc.l sr1ist * 0 - PRT -- Printer
|
---|
| 3382 | dc.l sr2ist * 1 - AUX -- Serial-2
|
---|
| 3383 | dc.l sr2ist * 2 - CON -- Console
|
---|
| 3384 | dc.l mc1ist * 3 - MC1 -- MIDI-1
|
---|
| 3385 | dc.l mc2ist * 4 - MC2 -- MIDI-2
|
---|
| 3386 | *
|
---|
| 3387 | * cdt02 -- Character device dispatch table #2 -- input
|
---|
| 3388 | * ----- -------------------------------------------
|
---|
| 3389 | cdt02: dc.l sr1inp * 0 - PRT -- Printer
|
---|
| 3390 | dc.l sr2inp * 1 - AUX -- Serial-2
|
---|
| 3391 | dc.l sr2inp * 2 - CON -- Console
|
---|
| 3392 | dc.l mc1inp * 3 - MC1 -- MIDI-1
|
---|
| 3393 | dc.l mc2inp * 4 - MC2 -- MIDI-2
|
---|
| 3394 | *
|
---|
| 3395 | * cdt03 -- Character device dispatch table #3 -- output
|
---|
| 3396 | * ----- --------------------------------------------
|
---|
| 3397 | cdt03: dc.l sr1out * 0 - PRT -- Printer
|
---|
| 3398 | dc.l sr2out * 1 - AUX -- Serial-2
|
---|
| 3399 | dc.l sr2out * 2 - CON -- Console
|
---|
| 3400 | dc.l mc1out * 3 - MC1 -- MIDI-1
|
---|
| 3401 | dc.l mc2out * 4 - MC2 -- MIDI-2
|
---|
| 3402 | *
|
---|
| 3403 | * cdt04 -- Character device dispatch table #4 -- output status
|
---|
| 3404 | * ----- ---------------------------------------------------
|
---|
| 3405 | cdt04: dc.l sr1ost * 0 - PRT -- Printer
|
---|
| 3406 | dc.l sr2ost * 1 - AUX -- Serial-2
|
---|
| 3407 | dc.l sr2ost * 2 - CON -- Console
|
---|
| 3408 | dc.l mc1ost * 3 - MC1 -- MIDI-1
|
---|
| 3409 | dc.l mc2ost * 4 - MC2 -- MIDI-2
|
---|
| 3410 | *
|
---|
| 3411 | .page
|
---|
| 3412 | *
|
---|
| 3413 | * iorec defaults:
|
---|
| 3414 | * ---------------
|
---|
| 3415 | * Serial-1:
|
---|
| 3416 | * ---------
|
---|
| 3417 | sr1dflt: dc.l sr1ibuf * ibuf
|
---|
| 3418 | dc.w SR1IBS * ibufsize
|
---|
| 3419 | dc.w 0,0 * ibufhd, ibuftl
|
---|
| 3420 | dc.w SR1IBS/4 * ibuflow
|
---|
| 3421 | dc.w SR1IBS-(SR1IBS/4) * ibufhi
|
---|
| 3422 | dc.l sr1obuf * obuf
|
---|
| 3423 | dc.w SR1OBS * obufsize
|
---|
| 3424 | dc.w 0,0 * obufhd, obuftl
|
---|
| 3425 | dc.w SR1OBS/4 * obuflow
|
---|
| 3426 | dc.w SR1OBS-(SR1OBS/4) * obufhi
|
---|
| 3427 | dc.b SR1CFR0,SR1CFR1 * cfr0, cfr1
|
---|
| 3428 | dc.b 0,0 * flagxon, flagxoff
|
---|
| 3429 | dc.b SR1DISC,0 * linedisc, erbyte
|
---|
| 3430 | dc.b 0,0 * isr, csr
|
---|
| 3431 | dc.w 0,0 * errct, ibfct
|
---|
| 3432 | dc.l (SR1IBS*2)+1 * inp_nf
|
---|
| 3433 | dc.l 1 * inp_ne
|
---|
| 3434 | dc.l (SR1OBS*2)+1 * out_nf
|
---|
| 3435 | dc.l 1 * out_ne
|
---|
| 3436 | *
|
---|
| 3437 | * Serial-2:
|
---|
| 3438 | * ---------
|
---|
| 3439 | sr2dflt: dc.l sr2ibuf
|
---|
| 3440 | dc.w SR2IBS
|
---|
| 3441 | dc.w 0,0
|
---|
| 3442 | dc.w SR2IBS/4
|
---|
| 3443 | dc.w SR2IBS-(SR2IBS/4)
|
---|
| 3444 | dc.l sr2obuf
|
---|
| 3445 | dc.w SR2OBS
|
---|
| 3446 | dc.w 0,0
|
---|
| 3447 | dc.w SR2OBS/4
|
---|
| 3448 | dc.w SR2OBS-(SR2OBS/4)
|
---|
| 3449 | dc.b SR2CFR0,SR2CFR1
|
---|
| 3450 | dc.b 0,0
|
---|
| 3451 | dc.b SR2DISC,0
|
---|
| 3452 | dc.b 0,0
|
---|
| 3453 | dc.w 0,0
|
---|
| 3454 | dc.l (SR2IBS*2)+1
|
---|
| 3455 | dc.l 1
|
---|
| 3456 | dc.l (SR2OBS*2)+1
|
---|
| 3457 | dc.l 1
|
---|
| 3458 | *
|
---|
| 3459 | .page
|
---|
| 3460 | *
|
---|
| 3461 | * MIDI-1:
|
---|
| 3462 | * -------
|
---|
| 3463 | mc1dflt: dc.l mc1ibuf
|
---|
| 3464 | dc.w MC1IBS
|
---|
| 3465 | dc.w 0,0
|
---|
| 3466 | dc.w MC1IBS/4
|
---|
| 3467 | dc.w MC1IBS-(MC1IBS/4)
|
---|
| 3468 | dc.l mc1obuf
|
---|
| 3469 | dc.w MC1OBS
|
---|
| 3470 | dc.w 0,0
|
---|
| 3471 | dc.w MC1OBS/4
|
---|
| 3472 | dc.w MC1OBS-(MC1OBS/4)
|
---|
| 3473 | dc.b MC1CFR0,MC1CFR1
|
---|
| 3474 | dc.b 0,0
|
---|
| 3475 | dc.b MC1DISC,0
|
---|
| 3476 | dc.b 0,0
|
---|
| 3477 | dc.w 0,0
|
---|
| 3478 | dc.l (MC1IBS*2)+1
|
---|
| 3479 | dc.l 1
|
---|
| 3480 | dc.l (MC1OBS*2)+1
|
---|
| 3481 | dc.l 1
|
---|
| 3482 | *
|
---|
| 3483 | * MIDI-2:
|
---|
| 3484 | * -------
|
---|
| 3485 | mc2dflt: dc.l mc2ibuf
|
---|
| 3486 | dc.w MC2IBS
|
---|
| 3487 | dc.w 0,0
|
---|
| 3488 | dc.w MC2IBS/4
|
---|
| 3489 | dc.w MC2IBS-(MC2IBS/4)
|
---|
| 3490 | dc.l mc2obuf
|
---|
| 3491 | dc.w MC2OBS
|
---|
| 3492 | dc.w 0,0
|
---|
| 3493 | dc.w MC2OBS/4
|
---|
| 3494 | dc.w MC2OBS-(MC2OBS/4)
|
---|
| 3495 | dc.b MC2CFR0,MC2CFR1
|
---|
| 3496 | dc.b 0,0
|
---|
| 3497 | dc.b MC2DISC,0
|
---|
| 3498 | dc.b 0,0
|
---|
| 3499 | dc.w 0,0
|
---|
| 3500 | dc.l (MC2IBS*2)+1
|
---|
| 3501 | dc.l 1
|
---|
| 3502 | dc.l (MC2OBS*2)+1
|
---|
| 3503 | dc.l 1
|
---|
| 3504 | *
|
---|
| 3505 | .page
|
---|
| 3506 | *
|
---|
| 3507 | * brtable -- Baud rate setup table
|
---|
| 3508 | * ------- ---------------------
|
---|
| 3509 | brtable: dc.b BR_19K2 * 0 - 19200 baud
|
---|
| 3510 | dc.b BR_9600 * 1 - 9600 baud
|
---|
| 3511 | dc.b BR_4800 * 2 - 4800 baud
|
---|
| 3512 | dc.b BR_3600 * 3 - 3600 baud
|
---|
| 3513 | dc.b BR_2400 * 4 - 2400 baud
|
---|
| 3514 | dc.b BR_7200 * 5 - 7200 baud
|
---|
| 3515 | dc.b BR_1800 * 6 - 1800 baud
|
---|
| 3516 | dc.b BR_1200 * 7 - 1200 baud
|
---|
| 3517 | dc.b BR_600 * 8 - 600 baud
|
---|
| 3518 | dc.b BR_300 * 9 - 300 baud
|
---|
| 3519 | *
|
---|
| 3520 | * aciatab -- iorec and ACIA pointer table
|
---|
| 3521 | * ------- ----------------------------
|
---|
| 3522 | aciatab: dc.l _sr1_ior,SR1ACIA * 0 - PRT Serial-1
|
---|
| 3523 | dc.l _sr2_ior,SR2ACIA * 1 - AUX Serial-2
|
---|
| 3524 | dc.l _sr2_ior,SR2ACIA * 2 - CON Serial-2
|
---|
| 3525 | dc.l _mc1_ior,MC1ACIA * 3 - MC1 MIDI-1
|
---|
| 3526 | dc.l _mc2_ior,MC2ACIA * 4 - MC2 MIDI-2
|
---|
| 3527 | *
|
---|
| 3528 | .page
|
---|
| 3529 | *
|
---|
| 3530 | * pbpbtab -- Prototype BPB data table (BPS..NHID) 19 bytes per entry
|
---|
| 3531 | * ------- ---------------------------------------------------------
|
---|
| 3532 | *
|
---|
| 3533 | * 0 -- 40 tracks, single sided (180K)
|
---|
| 3534 | *
|
---|
| 3535 | pbpbtab: dc.b $00,$02,$01,$01,$00,$02,$40,$00
|
---|
| 3536 | dc.b $68,$01,$FC,$02,$00,$09,$00,$01
|
---|
| 3537 | dc.b $00,$00,$00
|
---|
| 3538 | *
|
---|
| 3539 | * 1 -- 40 tracks, double sided (360K)
|
---|
| 3540 | *
|
---|
| 3541 | dc.b $00,$02,$02,$01,$00,$02,$70,$00
|
---|
| 3542 | dc.b $D0,$02,$FD,$02,$00,$09,$00,$02
|
---|
| 3543 | dc.b $00,$00,$00
|
---|
| 3544 | *
|
---|
| 3545 | * 2 -- 80 tracks, single sided (360K)
|
---|
| 3546 | *
|
---|
| 3547 | dc.b $00,$02,$02,$01,$00,$02,$70,$00
|
---|
| 3548 | dc.b $D0,$02,$F8,$05,$00,$09,$00,$01
|
---|
| 3549 | dc.b $00,$00,$00
|
---|
| 3550 | *
|
---|
| 3551 | * 3 -- 80 tracks, double sided (720K)
|
---|
| 3552 | *
|
---|
| 3553 | dc.b $00,$02,$02,$01,$00,$02,$70,$00
|
---|
| 3554 | dc.b $A0,$05,$F9,$05,$00,$09,$00,$02
|
---|
| 3555 | dc.b $00,$00,$00
|
---|
| 3556 | *
|
---|
| 3557 | * VSDD initialization table
|
---|
| 3558 | *
|
---|
| 3559 | .even
|
---|
| 3560 | *
|
---|
| 3561 | vsddtab: dc.w $8252 * R0 Mode word 0
|
---|
| 3562 | dc.w $E474 * R1 Mode word 1
|
---|
| 3563 | dc.w $0006 * R2 Register window base
|
---|
| 3564 | dc.w $0100 * R3 Data window base
|
---|
| 3565 | dc.w $0000 * R4 Data length mask
|
---|
| 3566 | dc.w $0000 * R5 Data segment base
|
---|
| 3567 | dc.w $0001 * R6 Priority access count
|
---|
| 3568 | dc.w $0040 * R7 ODT base
|
---|
| 3569 | dc.w $0080 * R8 AT base
|
---|
| 3570 | dc.w $0010 * R9 CLT base
|
---|
| 3571 | dc.w $0011 * R10 CG bases
|
---|
| 3572 | dc.w $0000 * R11 AT counter (R/O)
|
---|
| 3573 | *
|
---|
| 3574 | dc.w $0808 * R12 HC0 = 2, VC0 = 8
|
---|
| 3575 | dc.w $0C0A * R13 HC1 = 3, VC1 = 10
|
---|
| 3576 | dc.w $8D68 * R14 HC2 = 35, VC2 = 360
|
---|
| 3577 | dc.w $9969 * R15 HC3 = 38, VC3 = 361
|
---|
| 3578 | *
|
---|
| 3579 | vsddit01: dc.w $8253 * R0 with UCF = 1, DEN = 0
|
---|
| 3580 | vsddit02: dc.w $825B * R0 with UCF = 1, DEN = 1
|
---|
| 3581 | *
|
---|
| 3582 | .page
|
---|
| 3583 | *
|
---|
| 3584 | * analog processor input state table
|
---|
| 3585 | *
|
---|
| 3586 | api_tab: dc.b 0,1,1,1,1,1,1,1,1,1 * 0..9
|
---|
| 3587 | dc.b 1,1,1,1,1,1,1,1,1,1 * 10..19
|
---|
| 3588 | dc.b 1,1,1,1,1 * 20..24
|
---|
| 3589 | dc.b 3,3,3,3,3 * 25..29
|
---|
| 3590 | dc.b 3,3,3,3,3,3,3,3,3 * 30..38
|
---|
| 3591 | dc.b 5 * 39
|
---|
| 3592 | dc.b 5,5,5,5,5,5,5,5,5,5 * 40..49
|
---|
| 3593 | dc.b 5,5,5 * 50..52
|
---|
| 3594 | dc.b 3,3,3,3,3,3,3 * 53..59
|
---|
| 3595 | dc.b 5,5,5,5,5,5,5,5,5,5 * 60..69
|
---|
| 3596 | dc.b 5,5,5 * 70..72
|
---|
| 3597 | dc.b 6,6,6,6,6,6,6 * 73..79
|
---|
| 3598 | dc.b 6,6,6 * 80..82
|
---|
| 3599 | *
|
---|
| 3600 | .even
|
---|
| 3601 | *
|
---|
| 3602 | * analog processor state transfer vector
|
---|
| 3603 | *
|
---|
| 3604 | api_tv: dc.l api_s0,api_s1,api_s2,api_s3
|
---|
| 3605 | dc.l api_s4,api_s5,api_s6
|
---|
| 3606 | *
|
---|
| 3607 | * Multi-Tasker pointer table structure
|
---|
| 3608 | *
|
---|
| 3609 | mtdefs: dc.l MTStruct * pointer to Multi-Tasker stuff
|
---|
| 3610 | dc.l _SemFCLK * pointer to frame sempahore
|
---|
| 3611 | dc.l _SemQuit * pointer to terminate semaphore
|
---|
| 3612 | dc.l _MSG_Vid * pointer to video message queue
|
---|
| 3613 | *
|
---|
| 3614 | * Multi-Tasker interrupt handler TCB pointer table
|
---|
| 3615 | *
|
---|
| 3616 | _MT_ITT: dc.l 0 * level 0 -unused-
|
---|
| 3617 | dc.l MT_ITCB1 * level 1 VSDD
|
---|
| 3618 | dc.l MT_ITCB2 * level 2 FPU
|
---|
| 3619 | dc.l MT_ITCB3 * level 3 panel
|
---|
| 3620 | dc.l MT_ITCB4 * level 4 timer
|
---|
| 3621 | dc.l MT_ITCB5 * level 5 serial I/O
|
---|
| 3622 | dc.l 0 * level 6 -unused-
|
---|
| 3623 | dc.l 0 * level 7 -unused-
|
---|
| 3624 | *
|
---|
| 3625 | .page
|
---|
| 3626 | *************************************************************************
|
---|
| 3627 | ************************ RAM storage definitions ************************
|
---|
| 3628 | *************************************************************************
|
---|
| 3629 | *
|
---|
| 3630 | .bss
|
---|
| 3631 | .even
|
---|
| 3632 | *
|
---|
| 3633 | * RAM data area
|
---|
| 3634 | * -------------
|
---|
| 3635 | * WARNING:
|
---|
| 3636 | * --------
|
---|
| 3637 | * The variables from timevec through rsarea are permanently assigned so
|
---|
| 3638 | * that we can link to certain bios variables without having to link to the
|
---|
| 3639 | * bios object file itself. Some of these get defined in hwdefs.s and in
|
---|
| 3640 | * hwdefs.s so beware of changing them.
|
---|
| 3641 | *
|
---|
| 3642 | * The area from timevec through biosram-1 is preserved around resets.
|
---|
| 3643 | * -------------------------------------------------------------------
|
---|
| 3644 | *
|
---|
| 3645 | timevec: ds.l 1 * $100 - System timer trap vector
|
---|
| 3646 | critvec: ds.l 1 * $101 - Critical error handler vector
|
---|
| 3647 | termvec: ds.l 1 * $102 - Process terminate vector
|
---|
| 3648 | resvec3: ds.l 1 * $103 - Reserved vector 3 (FPU)
|
---|
| 3649 | resvec4: ds.l 1 * $104 - Reserved vector 4 (VSDD)
|
---|
| 3650 | resvec5: ds.l 1 * $105 - Reserved vector 5
|
---|
| 3651 | resvec6: ds.l 1 * $106 - Reserved vector 6
|
---|
| 3652 | resvec7: ds.l 1 * $107 - Reserved vector 7
|
---|
| 3653 | *
|
---|
| 3654 | fc_sw: ds.w 1 * Frame clock switch (<0=dn, 0=off, >0=up)
|
---|
| 3655 | fc_val: ds.l 1 * Frame clock value (0..FCMAX)
|
---|
| 3656 | *
|
---|
| 3657 | * Crash dump area: these variables are set when a bad trap is encountered
|
---|
| 3658 | * ------------------------------------------------------------------------
|
---|
| 3659 | _wzcrsh: ds.w 1 * Crash area: flag for ROMP
|
---|
| 3660 | _crshsr: ds.w 1 * Crash area: SR
|
---|
| 3661 | _crshpc: ds.l 1 * Crash area: PC
|
---|
| 3662 | _crshsp: ds.l 1 * Crash area: SP
|
---|
| 3663 | _crshus: ds.l 1 * Crash area: USP
|
---|
| 3664 | _crshvc: ds.l 1 * Crash area: vector # in MS byte
|
---|
| 3665 | _crshrg: ds.l 16 * Crash area: registers
|
---|
| 3666 | _crshst: ds.w 16 * Crash area: top 16 words of stack
|
---|
| 3667 | *
|
---|
| 3668 | .page
|
---|
| 3669 | *
|
---|
| 3670 | * The area from biosram to SSTACK-1 is cleared on reset.
|
---|
| 3671 | * ------------------------------------------------------
|
---|
| 3672 | biosram .equ * * Start of BIOS RAM variables
|
---|
| 3673 | *
|
---|
| 3674 | _hz_1k: ds.l 1 * 1000 Hz clock
|
---|
| 3675 | _hz_200: ds.l 1 * 200 Hz clock
|
---|
| 3676 | frclock: ds.l 1 * 50 Hz clock
|
---|
| 3677 | t1count: ds.w 1 * Timer 1 count
|
---|
| 3678 | t2count: ds.w 1 * Timer 2 count
|
---|
| 3679 | t3count: ds.w 1 * Timer 3 count
|
---|
| 3680 | *
|
---|
| 3681 | seekrate: ds.w 1 * Seek rate
|
---|
| 3682 | cdev: ds.w 1 * Current drive
|
---|
| 3683 | ctrack: ds.w 1 * Current track
|
---|
| 3684 | csect: ds.w 1 * Current sector
|
---|
| 3685 | cside: ds.w 1 * Current side
|
---|
| 3686 | ccount: ds.w 1 * Current sector count
|
---|
| 3687 | spt: ds.w 1 * Sectors per track
|
---|
| 3688 | interlv: ds.w 1 * Sector interleave count
|
---|
| 3689 | virgin: ds.w 1 * Initial formatting data
|
---|
| 3690 | deferr: ds.w 1 * Default error number
|
---|
| 3691 | curerr: ds.w 1 * Current error number
|
---|
| 3692 | *
|
---|
| 3693 | cdma: ds.l 1 * Current DMA address
|
---|
| 3694 | edma: ds.l 1 * Ending DMA address
|
---|
| 3695 | tmpdma: ds.l 1 * Temporary DMA address
|
---|
| 3696 | *
|
---|
| 3697 | rseed: ds.l 1 * Random number seed
|
---|
| 3698 | *
|
---|
| 3699 | savptr: ds.l 1 * Pointer to register save area
|
---|
| 3700 | *
|
---|
| 3701 | _rsflag: ds.l 1 * Register save area overflow flag
|
---|
| 3702 | ds.l 18*32 * Register save area (32 levels)
|
---|
| 3703 | rsarea: ds.l 1 * Dummy long word at top of save area
|
---|
| 3704 | *
|
---|
| 3705 | * ***** end of the permanently assigned bios variables *****
|
---|
| 3706 | *
|
---|
| 3707 | .page
|
---|
| 3708 | *
|
---|
| 3709 | * Miscellaneous system variables
|
---|
| 3710 | * ------------------------------
|
---|
| 3711 | acctim: ds.l 2 * Accumulated disk time table
|
---|
| 3712 | maxactim: ds.l 1 * Maximum acctim value
|
---|
| 3713 | hdv_init: ds.l 1 * Disk init vector
|
---|
| 3714 | hdv_bpb: ds.l 1 * Disk get bpb vector
|
---|
| 3715 | hdv_rw: ds.l 1 * Disk r/w vector
|
---|
| 3716 | hdv_boot: ds.l 1 * Disk boot vector
|
---|
| 3717 | hdv_mchg: ds.l 1 * Disk media change vector
|
---|
| 3718 | drvbits: ds.l 1 * Drive map bits
|
---|
| 3719 | dskbufp: ds.l 1 * Disk buffer pointer
|
---|
| 3720 | *
|
---|
| 3721 | nflops: ds.w 1 * Number of drives
|
---|
| 3722 | disknum: ds.w 1 * Current disk number
|
---|
| 3723 | booted: ds.w 1 * Most recent boot device or -1
|
---|
| 3724 | flock: ds.w 1 * Floppy in-use flag for timer
|
---|
| 3725 | fverify: ds.w 1 * Floppy verify flag
|
---|
| 3726 | *
|
---|
| 3727 | tdiv1: ds.w 1 * Timer divider 1 (divides _hz_1k)
|
---|
| 3728 | tdiv2: ds.w 1 * Timer divider 2 (divides _hz_200)
|
---|
| 3729 | *
|
---|
| 3730 | retrycnt: ds.w 1 * Re-try count
|
---|
| 3731 | wpstatus: ds.w 1 * Write protect status table
|
---|
| 3732 | wplatch: ds.w 1 * Write protect latch table
|
---|
| 3733 | bootdev: ds.w 1 * Boot device number
|
---|
| 3734 | *
|
---|
| 3735 | motoron: ds.w 1 * Motor-on flag
|
---|
| 3736 | deslflag: ds.w 1 * Drive deselect flag
|
---|
| 3737 | *
|
---|
| 3738 | flpsrsv: ds.w 1 * Status register save area
|
---|
| 3739 | flpregs: ds.l 16 * Register save area
|
---|
| 3740 | *
|
---|
| 3741 | dsb0: ds.l 1 * Drive A DSB
|
---|
| 3742 | dsb1: ds.l 1 * Drive B DSB
|
---|
| 3743 | *
|
---|
| 3744 | dskmode: ds.b 2 * Disk change mode table
|
---|
| 3745 | dskerrs: ds.w 2 * Disk error code table
|
---|
| 3746 | drvbpbs: ds.w 16*2 * Disk BPB save area
|
---|
| 3747 | *
|
---|
| 3748 | .page
|
---|
| 3749 | *
|
---|
| 3750 | sr1ibuf: ds.b SR1IBS * Serial-1 input buffer
|
---|
| 3751 | sr1obuf: ds.b SR1OBS * Serial-1 output buffer
|
---|
| 3752 | sr2ibuf: ds.b SR2IBS * Serial-2 input buffer
|
---|
| 3753 | sr2obuf: ds.b SR2OBS * Serial-2 output buffer
|
---|
| 3754 | *
|
---|
| 3755 | mc1ibuf: ds.b MC1IBS * MIDI-1 input buffer
|
---|
| 3756 | mc1obuf: ds.b MC1OBS * MIDI-1 output buffer
|
---|
| 3757 | mc2ibuf: ds.b MC2IBS * MIDI-2 input buffer
|
---|
| 3758 | mc2obuf: ds.b MC2OBS * MIDI-2 output buffer
|
---|
| 3759 | *
|
---|
| 3760 | api_inp: ds.b 1 * Analog processor input byte
|
---|
| 3761 | api_bug: ds.b 1 * Analog processor signal # "bug trap"
|
---|
| 3762 | api_sv: ds.b 1 * Analog processor state
|
---|
| 3763 | api_svb: ds.b 1 * Analog processor state "bug trap"
|
---|
| 3764 | *
|
---|
| 3765 | .even
|
---|
| 3766 | *
|
---|
| 3767 | api_sig: ds.b 1 * Analog signal number
|
---|
| 3768 | api_val: ds.b 1 * Analog value
|
---|
| 3769 | *
|
---|
| 3770 | api_fi: ds.l 1 * Analog processor FIFO input pointer
|
---|
| 3771 | api_fo: ds.l 1 * Analog processor FIFO output pointer
|
---|
| 3772 | api_fum: ds.w APISIZE * Analog processor FIFO
|
---|
| 3773 | api_fe .equ * * End of analog processor FIFO
|
---|
| 3774 | *
|
---|
| 3775 | .even
|
---|
| 3776 | *
|
---|
| 3777 | basepage: ds.l 64 * Pseudo base page for ROMP
|
---|
| 3778 | *
|
---|
| 3779 | buffer: ds.b 1024 * Default disk buffer
|
---|
| 3780 | *
|
---|
| 3781 | biostop .equ * * End of BIOS RAM
|
---|
| 3782 | *
|
---|
| 3783 | .end
|
---|