siop.ss revision 1.10
1 ; $NetBSD: siop.ss,v 1.10 2000/10/18 17:01:13 bouyer Exp $ 2 3 ; 4 ; Copyright (c) 2000 Manuel Bouyer. 5 ; 6 ; Redistribution and use in source and binary forms, with or without 7 ; modification, are permitted provided that the following conditions 8 ; are met: 9 ; 1. Redistributions of source code must retain the above copyright 10 ; notice, this list of conditions and the following disclaimer. 11 ; 2. Redistributions in binary form must reproduce the above copyright 12 ; notice, this list of conditions and the following disclaimer in the 13 ; documentation and/or other materials provided with the distribution. 14 ; 3. All advertising materials mentioning features or use of this software 15 ; must display the following acknowledgement: 16 ; This product includes software developed by Manuel Bouyer 17 ; 4. The name of the author may not be used to endorse or promote products 18 ; derived from this software without specific prior written permission. 19 ; 20 ; THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 21 ; IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 22 ; OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 23 ; IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 24 ; INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 25 ; NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 26 ; DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 27 ; THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 28 ; (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 29 ; THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 30 31 ARCH 720 32 33 ; offsets in sym_xfer 34 ABSOLUTE t_id = 24; 35 ABSOLUTE t_msg_in = 32; 36 ABSOLUTE t_ext_msg_in = 40; 37 ABSOLUTE t_ext_msg_data = 48; 38 ABSOLUTE t_msg_tag = 56; 39 ABSOLUTE t_msg_out = 64; 40 ABSOLUTE t_cmd = 72; 41 ABSOLUTE t_status = 80; 42 ABSOLUTE t_data = 88; 43 44 ;; interrupt codes 45 ; interrupts that need a valid DSA 46 ABSOLUTE int_done = 0xff00; 47 ABSOLUTE int_msgin = 0xff01; 48 ABSOLUTE int_extmsgin = 0xff02; 49 ABSOLUTE int_extmsgdata = 0xff03; 50 ABSOLUTE int_disc = 0xff04; 51 ; interrupts that don't have a valid DSA 52 ABSOLUTE int_reseltarg = 0xff80; 53 ABSOLUTE int_resellun = 0xff81; 54 ABSOLUTE int_reseltag = 0xff82; 55 ABSOLUTE int_resfail = 0xff83; 56 ABSOLUTE int_err = 0xffff; 57 58 ; flags for scratcha0 59 ABSOLUTE flag_sdp = 0x01 ; got save data pointer 60 ABSOLUTE flag_data = 0x02 ; we're in data phase 61 ABSOLUTE flag_data_mask = 0xfd ; ~flag_data 62 63 ; main script symbols 64 65 ENTRY waitphase; 66 ENTRY send_msgout; 67 ENTRY msgout; 68 ENTRY msgin; 69 ENTRY handle_msgin; 70 ENTRY msgin_ack; 71 ENTRY dataout; 72 ENTRY datain; 73 ENTRY cmdout; 74 ENTRY status; 75 ENTRY disconnect; 76 ENTRY reselect; 77 ENTRY reselected; 78 ENTRY selected; 79 ENTRY script_sched; 80 ENTRY get_extmsgdata; 81 ENTRY resel_targ0; 82 ENTRY msgin_space; 83 ENTRY lunsw_return; 84 EXTERN abs_targ0; 85 EXTERN abs_msgin; 86 87 ; lun switch symbols 88 ENTRY resel_lun0; 89 ENTRY restore_scntl3; 90 EXTERN abs_lun0; 91 EXTERN abs_lunsw_return; 92 93 ; command reselect script symbols 94 ENTRY rdsa0; 95 ENTRY rdsa1; 96 ENTRY rdsa2; 97 ENTRY rdsa3; 98 ENTRY reload_dsa; 99 100 EXTERN resel_abs_reselected; 101 102 ; command scheduler symbols 103 ENTRY slot; 104 ENTRY slotdata; 105 ENTRY nextslot; 106 107 EXTERN script_abs_sched; 108 EXTERN slot_nextp; 109 EXTERN slot_sched_addrsrc; 110 EXTERN slot_abs_reselect; 111 EXTERN slot_abs_selected; 112 EXTERN slot_abs_loaddsa; 113 114 EXTERN endslot_abs_reselect; 115 116 ; main script 117 118 PROC siop_script: 119 120 reselected: 121 ; starting a new session, init 'local variables' 122 MOVE 0 to SCRATCHA0 ; flags 123 MOVE 0 to SCRATCHA1 ; DSA offset (for S/G save data pointer) 124 MOVE SCRATCHA3 to SFBR ; pending message ? 125 JUMP REL(handle_msgin), IF not 0x08; 126 waitphase: 127 JUMP REL(msgout), WHEN MSG_OUT; 128 JUMP REL(msgin), WHEN MSG_IN; 129 JUMP REL(dataout), WHEN DATA_OUT; 130 JUMP REL(datain), WHEN DATA_IN; 131 JUMP REL(cmdout), WHEN CMD; 132 JUMP REL(status), WHEN STATUS; 133 err: 134 INT int_err; 135 136 reselect: 137 ; Clear DSA and init status 138 MOVE 0xff to DSA0; 139 MOVE 0xff to DSA1; 140 MOVE 0xff to DSA2; 141 MOVE 0xff to DSA3; 142 MOVE 0xff to SCRATCHA2; no tag 143 MOVE 0x08 to SCRATCHA3; NOP message 144 WAIT RESELECT REL(reselect_fail) 145 MOVE SSID & 0x8f to SFBR 146 MOVE SFBR to SCRATCHA0 ; save reselect ID 147 ; find the rigth param for this target 148 resel_targ0: 149 JUMP abs_targ0, IF 0xff; 150 JUMP abs_targ0, IF 0xff; 151 JUMP abs_targ0, IF 0xff; 152 JUMP abs_targ0, IF 0xff; 153 JUMP abs_targ0, IF 0xff; 154 JUMP abs_targ0, IF 0xff; 155 JUMP abs_targ0, IF 0xff; 156 JUMP abs_targ0, IF 0xff; 157 JUMP abs_targ0, IF 0xff; 158 JUMP abs_targ0, IF 0xff; 159 JUMP abs_targ0, IF 0xff; 160 JUMP abs_targ0, IF 0xff; 161 JUMP abs_targ0, IF 0xff; 162 JUMP abs_targ0, IF 0xff; 163 JUMP abs_targ0, IF 0xff; 164 INT int_reseltarg; 165 lunsw_return: 166 INT int_err, WHEN NOT MSG_IN; 167 MOVE 1, abs_msgin, WHEN MSG_IN; 168 MOVE SFBR & 0x07 to SCRATCHA1; save LUN 169 CLEAR ACK; 170 RETURN, WHEN NOT MSG_IN; If no more message, jump to lun sw 171 MOVE 1, abs_msgin, WHEN MSG_IN; 172 CLEAR ACK; 173 JUMP REL(gettag), IF 0x20; simple tag message ? 174 MOVE SFBR to SCRATCHA3; save message 175 RETURN; jump to lun sw and handle message 176 gettag: 177 INT int_err, WHEN NOT MSG_IN; 178 MOVE 1, abs_msgin, WHEN MSG_IN; get tag 179 CLEAR ACK; 180 MOVE SFBR to SCRATCHA2; save tag 181 RETURN; jump to lun sw 182 183 reselect_fail: 184 ; check that host asserted SIGP, this'll clear SIGP in ISTAT 185 MOVE CTEST2 & 0x40 TO SFBR; 186 INT int_resfail, IF 0x00; 187 script_sched: 188 ; Clear DSA and init status 189 MOVE 0xff to DSA0; 190 MOVE 0xff to DSA1; 191 MOVE 0xff to DSA2; 192 MOVE 0xff to DSA3; 193 MOVE 0 to SCRATCHA0 ; flags 194 MOVE 0 to SCRATCHA1 ; DSA offset (for S/G save data pointer) 195 JUMP script_abs_sched; 196 197 handle_sdp: 198 CLEAR ACK; 199 MOVE SCRATCHA0 | flag_sdp TO SCRATCHA0; 200 ; should get a disconnect message now 201 msgin: 202 CLEAR ATN 203 MOVE FROM t_msg_in, WHEN MSG_IN; 204 handle_msgin: 205 JUMP REL(handle_dis), IF 0x04 ; disconnect message 206 JUMP REL(handle_cmpl), IF 0x00 ; command complete message 207 JUMP REL(handle_sdp), IF 0x02 ; save data pointer message 208 JUMP REL(handle_extin), IF 0x01 ; extended message 209 INT int_msgin; 210 msgin_ack: 211 selected: 212 CLEAR ACK; 213 JUMP REL(waitphase); 214 215 ; entry point for msgout after a msgin or status phase 216 send_msgout: 217 SET ATN; 218 CLEAR ACK; 219 msgout: 220 MOVE FROM t_msg_out, WHEN MSG_OUT; 221 CLEAR ATN; 222 JUMP REL(waitphase); 223 cmdout: 224 MOVE FROM t_cmd, WHEN CMD; 225 JUMP REL(waitphase); 226 status: 227 MOVE FROM t_status, WHEN STATUS; 228 JUMP REL(waitphase); 229 datain: 230 CALL REL(savedsa); 231 MOVE SCRATCHA0 | flag_data TO SCRATCHA0; 232 datain_loop: 233 MOVE FROM t_data, WHEN DATA_IN; 234 MOVE SCRATCHA1 + 1 TO SCRATCHA1 ; adjust offset 235 MOVE DSA0 + 8 to DSA0; 236 MOVE DSA1 + 0 to DSA1 WITH CARRY; 237 MOVE DSA2 + 0 to DSA2 WITH CARRY; 238 MOVE DSA3 + 0 to DSA3 WITH CARRY; 239 JUMP REL(datain_loop), WHEN DATA_IN; 240 CALL REL(restoredsa); 241 MOVE SCRATCHA0 & flag_data_mask TO SCRATCHA0; 242 JUMP REL(waitphase); 243 244 dataout: 245 CALL REL(savedsa); 246 MOVE SCRATCHA0 | flag_data TO SCRATCHA0; 247 dataout_loop: 248 MOVE FROM t_data, WHEN DATA_OUT; 249 MOVE SCRATCHA1 + 1 TO SCRATCHA1 ; adjust offset 250 MOVE DSA0 + 8 to DSA0; 251 MOVE DSA1 + 0 to DSA1 WITH CARRY; 252 MOVE DSA2 + 0 to DSA2 WITH CARRY; 253 MOVE DSA3 + 0 to DSA3 WITH CARRY; 254 JUMP REL(dataout_loop), WHEN DATA_OUT; 255 CALL REL(restoredsa); 256 MOVE SCRATCHA0 & flag_data_mask TO SCRATCHA0; 257 JUMP REL(waitphase); 258 259 savedsa: 260 MOVE DSA0 to SFBR; 261 MOVE SFBR to SCRATCHB0; 262 MOVE DSA1 to SFBR; 263 MOVE SFBR to SCRATCHB1; 264 MOVE DSA2 to SFBR; 265 MOVE SFBR to SCRATCHB2; 266 MOVE DSA3 to SFBR; 267 MOVE SFBR to SCRATCHB3; 268 RETURN; 269 270 restoredsa: 271 MOVE SCRATCHB0 TO SFBR; 272 MOVE SFBR TO DSA0; 273 MOVE SCRATCHB1 TO SFBR; 274 MOVE SFBR TO DSA1; 275 MOVE SCRATCHB2 TO SFBR; 276 MOVE SFBR TO DSA2; 277 MOVE SCRATCHB3 TO SFBR; 278 MOVE SFBR TO DSA3; 279 RETURN; 280 281 disconnect: 282 MOVE SCNTL2 & 0x7f TO SCNTL2; 283 CLEAR ATN; 284 CLEAR ACK; 285 WAIT DISCONNECT; 286 RETURN; 287 288 handle_dis: 289 CALL REL(disconnect); 290 ; if we didn't get sdp, or if offset is 0, no need to interrupt 291 MOVE SCRATCHA0 & flag_sdp TO SFBR; 292 JUMP REL(script_sched), if 0x00; 293 MOVE SCRATCHA1 TO SFBR; 294 JUMP REL(script_sched), if 0x00; 295 ; Ok, we need to save data pointers 296 INT int_disc; 297 298 handle_cmpl: 299 CALL REL(disconnect); 300 INT int_done; 301 302 handle_extin: 303 CLEAR ACK; 304 INT int_err, IF NOT MSG_IN; 305 MOVE FROM t_ext_msg_in, WHEN MSG_IN; 306 INT int_extmsgin; /* let host fill in t_ext_msg_data */ 307 get_extmsgdata: 308 CLEAR ACK; 309 INT int_err, IF NOT MSG_IN; 310 MOVE FROM t_ext_msg_data, WHEN MSG_IN; 311 INT int_extmsgdata; 312 msgin_space: 313 NOP; space to store msgin when reselect 314 315 316 ; script used for the scheduler: when a slot is free the JUMP points to 317 ; the next slot so that instructions for this slot are not run. 318 ; once the CPU has set up the slot variables (DSA address) it changes 319 ; the JUMP address to 0 (so that it'll jump to the next instruction) and 320 ; this command will be processed next time the scheduler is executed. 321 ; When the target has been successfully selected the script changes the jump 322 ; addr back to the next slot, so that it's ignored the next time. 323 ; 324 325 PROC slot_script: 326 slot: 327 JUMP REL(nextslot); 328 CALL slot_abs_loaddsa; 329 SELECT ATN FROM t_id, slot_abs_reselect; 330 MOVE MEMORY 4, slot_sched_addrsrc, slot_nextp; 331 JUMP slot_abs_selected; 332 slotdata: 333 NOP; slot variables: jumppatchp 334 nextslot: 335 NOP; /* will be changed to the next slot entry 336 337 PROC endslot_script: 338 JUMP endslot_abs_reselect; 339 340 ;; per-target switch script for LUNs 341 ; hack: we first to a call to the target-specific code, so that a return 342 ; in the main switch will jump to the lun switch. 343 PROC lun_switch: 344 CALL REL(restore_scntl3); 345 MOVE SCRATCHA1 TO SFBR; 346 resel_lun0: 347 JUMP abs_lun0, IF 0x00; 348 JUMP abs_lun0, IF 0x01; 349 JUMP abs_lun0, IF 0x02; 350 JUMP abs_lun0, IF 0x03; 351 JUMP abs_lun0, IF 0x04; 352 JUMP abs_lun0, IF 0x05; 353 JUMP abs_lun0, IF 0x06; 354 JUMP abs_lun0, IF 0x07; 355 INT int_resellun; 356 restore_scntl3: 357 MOVE 0xff TO SCNTL3; 358 MOVE 0xff TO SXFER; 359 JUMP abs_lunsw_return; 360 361 ;; script used to load the DSA after a reselect. 362 363 PROC load_dsa: 364 ; Can't use MOVE MEMORY to load DSA, doesn't work I/O mapped 365 rdsa0: 366 MOVE 0xf0 to DSA0; 367 rdsa1: 368 MOVE 0xf1 to DSA1; 369 rdsa2: 370 MOVE 0xf2 to DSA2; 371 rdsa3: 372 MOVE 0xf3 to DSA3; 373 RETURN; 374 reload_dsa: 375 CALL REL(rdsa0); 376 JUMP resel_abs_reselected; 377
Indexes created Tue Sep 30 20:09:53 GMT 2025