siop.ss revision 1.19 1 ; $NetBSD: siop.ss,v 1.19 2005/02/27 00:27:29 perry 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 siop_common_xfer
34 ABSOLUTE t_id = 40;
35 ABSOLUTE t_msg_in = 48;
36 ABSOLUTE t_ext_msg_in = 56;
37 ABSOLUTE t_ext_msg_data = 64;
38 ABSOLUTE t_msg_out = 72;
39 ABSOLUTE t_cmd = 80;
40 ABSOLUTE t_status = 88;
41 ABSOLUTE t_data = 96;
42
43 ;; interrupt codes
44 ; interrupts that need a valid DSA
45 ABSOLUTE int_done = 0xff00;
46 ABSOLUTE int_msgin = 0xff01;
47 ABSOLUTE int_extmsgin = 0xff02;
48 ABSOLUTE int_extmsgdata = 0xff03;
49 ABSOLUTE int_disc = 0xff04;
50 ; interrupts that don't have a valid DSA
51 ABSOLUTE int_reseltarg = 0xff80;
52 ABSOLUTE int_resellun = 0xff81;
53 ABSOLUTE int_reseltag = 0xff82;
54 ABSOLUTE int_resfail = 0xff83;
55 ABSOLUTE int_err = 0xffff;
56
57 ; flags for scratcha0
58 ABSOLUTE flag_sdp = 0x01 ; got save data pointer
59 ABSOLUTE flag_data = 0x02 ; we're in data phase
60 ABSOLUTE flag_data_mask = 0xfd ; ~flag_data
61
62 ; main script symbols
63
64 ENTRY waitphase;
65 ENTRY send_msgout;
66 ENTRY msgout;
67 ENTRY msgin;
68 ENTRY handle_msgin;
69 ENTRY msgin_ack;
70 ENTRY dataout;
71 ENTRY datain;
72 ENTRY cmdout;
73 ENTRY status;
74 ENTRY disconnect;
75 ENTRY reselect;
76 ENTRY reselected;
77 ENTRY selected;
78 ENTRY script_sched;
79 ENTRY script_sched_slot0;
80 ENTRY get_extmsgdata;
81 ENTRY resel_targ0;
82 ENTRY msgin_space;
83 ENTRY lunsw_return;
84 ENTRY led_on1;
85 ENTRY led_on2;
86 ENTRY led_off;
87 EXTERN abs_script_sched_slot0;
88 EXTERN abs_targ0;
89 EXTERN abs_msgin;
90
91 ; lun switch symbols
92 ENTRY lun_switch_entry;
93 ENTRY resel_lun0;
94 ENTRY restore_scntl3;
95 EXTERN abs_lunsw_return;
96
97 ; tag switch symbols
98 ENTRY tag_switch_entry;
99 ENTRY resel_tag0;
100 EXTERN abs_tag0;
101
102 ; command reselect script symbols
103 ENTRY rdsa0;
104 ENTRY rdsa1;
105 ENTRY rdsa2;
106 ENTRY rdsa3;
107 ENTRY ldsa_reload_dsa;
108 ENTRY ldsa_select;
109 ENTRY ldsa_data;
110
111 EXTERN ldsa_abs_reselected;
112 EXTERN ldsa_abs_reselect;
113 EXTERN ldsa_abs_selected;
114 EXTERN ldsa_abs_data;
115 EXTERN ldsa_abs_slot;
116
117 ; main script
118
119 PROC siop_script:
120
121 reselected:
122 ; starting a new session, init 'local variables'
123 MOVE 0 to SCRATCHA0 ; flags
124 MOVE 0 to SCRATCHA1 ; DSA offset (for S/G save data pointer)
125 MOVE SCRATCHA3 to SFBR ; pending message ?
126 JUMP REL(handle_msgin), IF not 0x20;
127 waitphase:
128 JUMP REL(msgout), WHEN MSG_OUT;
129 JUMP REL(msgin), WHEN MSG_IN;
130 JUMP REL(dataout), WHEN DATA_OUT;
131 JUMP REL(datain), WHEN DATA_IN;
132 JUMP REL(cmdout), WHEN CMD;
133 JUMP REL(status), WHEN STATUS;
134 INT int_err;
135
136 reselect_fail:
137 ; check that host asserted SIGP, this'll clear SIGP in ISTAT
138 MOVE CTEST2 & 0x40 TO SFBR;
139 INT int_resfail, IF 0x00;
140 ; a NOP by default; patched with MOVE GPREG & 0xfe to GPREG on compile-time
141 ; option "SIOP_SYMLED"
142 led_on1:
143 NOP;
144 script_sched:
145 ; Clear DSA and init status
146 MOVE 0xff to DSA0;
147 MOVE 0xff to DSA1;
148 MOVE 0xff to DSA2;
149 MOVE 0xff to DSA3;
150 MOVE 0 to SCRATCHA0 ; flags
151 MOVE 0 to SCRATCHA1 ; DSA offset (for S/G save data pointer)
152 ; the script scheduler: siop_start() we set the absolute jump addr, and then
153 ; changes the FALSE to TRUE. The select script will change it back to false
154 ; once the target is selected.
155 ; The RAM could hold 370 slot entry, we limit it to 40. Should be more than
156 ; enough.
157 script_sched_slot0:
158 JUMP abs_script_sched_slot0, IF FALSE;
159 JUMP abs_script_sched_slot0, IF FALSE;
160 JUMP abs_script_sched_slot0, IF FALSE;
161 JUMP abs_script_sched_slot0, IF FALSE;
162 JUMP abs_script_sched_slot0, IF FALSE;
163 JUMP abs_script_sched_slot0, IF FALSE;
164 JUMP abs_script_sched_slot0, IF FALSE;
165 JUMP abs_script_sched_slot0, IF FALSE;
166 JUMP abs_script_sched_slot0, IF FALSE;
167 JUMP abs_script_sched_slot0, IF FALSE;
168 JUMP abs_script_sched_slot0, IF FALSE;
169 JUMP abs_script_sched_slot0, IF FALSE;
170 JUMP abs_script_sched_slot0, IF FALSE;
171 JUMP abs_script_sched_slot0, IF FALSE;
172 JUMP abs_script_sched_slot0, IF FALSE;
173 JUMP abs_script_sched_slot0, IF FALSE;
174 JUMP abs_script_sched_slot0, IF FALSE;
175 JUMP abs_script_sched_slot0, IF FALSE;
176 JUMP abs_script_sched_slot0, IF FALSE;
177 JUMP abs_script_sched_slot0, IF FALSE;
178 JUMP abs_script_sched_slot0, IF FALSE;
179 JUMP abs_script_sched_slot0, IF FALSE;
180 JUMP abs_script_sched_slot0, IF FALSE;
181 JUMP abs_script_sched_slot0, IF FALSE;
182 JUMP abs_script_sched_slot0, IF FALSE;
183 JUMP abs_script_sched_slot0, IF FALSE;
184 JUMP abs_script_sched_slot0, IF FALSE;
185 JUMP abs_script_sched_slot0, IF FALSE;
186 JUMP abs_script_sched_slot0, IF FALSE;
187 JUMP abs_script_sched_slot0, IF FALSE;
188 JUMP abs_script_sched_slot0, IF FALSE;
189 JUMP abs_script_sched_slot0, IF FALSE;
190 JUMP abs_script_sched_slot0, IF FALSE;
191 JUMP abs_script_sched_slot0, IF FALSE;
192 JUMP abs_script_sched_slot0, IF FALSE;
193 JUMP abs_script_sched_slot0, IF FALSE;
194 JUMP abs_script_sched_slot0, IF FALSE;
195 JUMP abs_script_sched_slot0, IF FALSE;
196 JUMP abs_script_sched_slot0, IF FALSE;
197 JUMP abs_script_sched_slot0, IF FALSE;
198 ; Nothing to do, wait for reselect
199 reselect:
200 ; Clear DSA and init status
201 MOVE 0xff to DSA0;
202 MOVE 0xff to DSA1;
203 MOVE 0xff to DSA2;
204 MOVE 0xff to DSA3;
205 MOVE 0x00 to SCRATCHA2; no tag
206 MOVE 0x20 to SCRATCHA3; simple tag msg, ignored by reselected:
207 ; a NOP by default; patched with MOVE GPREG | 0x01 to GPREG on compile-time
208 ; option "SIOP_SYMLED"
209 led_off:
210 NOP;
211 WAIT RESELECT REL(reselect_fail)
212 ; a NOP by default; patched with MOVE GPREG & 0xfe to GPREG on compile-time
213 ; option "SIOP_SYMLED"
214 led_on2:
215 NOP;
216 MOVE SSID & 0x8f to SFBR
217 MOVE SFBR to SCRATCHA0 ; save reselect ID
218 ; find the right param for this target
219 resel_targ0:
220 JUMP abs_targ0, IF 0xff;
221 JUMP abs_targ0, IF 0xff;
222 JUMP abs_targ0, IF 0xff;
223 JUMP abs_targ0, IF 0xff;
224 JUMP abs_targ0, IF 0xff;
225 JUMP abs_targ0, IF 0xff;
226 JUMP abs_targ0, IF 0xff;
227 JUMP abs_targ0, IF 0xff;
228 JUMP abs_targ0, IF 0xff;
229 JUMP abs_targ0, IF 0xff;
230 JUMP abs_targ0, IF 0xff;
231 JUMP abs_targ0, IF 0xff;
232 JUMP abs_targ0, IF 0xff;
233 JUMP abs_targ0, IF 0xff;
234 JUMP abs_targ0, IF 0xff;
235 INT int_reseltarg;
236 lunsw_return:
237 MOVE 1, abs_msgin, WHEN MSG_IN;
238 MOVE SFBR & 0x07 to SCRATCHA1; save LUN
239 CLEAR ACK;
240 RETURN, WHEN NOT MSG_IN; If no more message, jump to lun sw
241 MOVE 1, abs_msgin, WHEN MSG_IN;
242 CLEAR ACK;
243 MOVE SFBR to SCRATCHA3; save message
244 RETURN, IF NOT 0x20; jump to lun sw if not simple tag msg
245 MOVE 1, abs_msgin, WHEN MSG_IN; get tag
246 CLEAR ACK;
247 MOVE SFBR to SCRATCHA2; save tag
248 RETURN; jump to lun sw
249
250 handle_sdp:
251 CLEAR ACK;
252 MOVE SCRATCHA0 | flag_sdp TO SCRATCHA0;
253 ; should get a disconnect message now
254 msgin:
255 CLEAR ATN
256 MOVE FROM t_msg_in, WHEN MSG_IN;
257 handle_msgin:
258 JUMP REL(handle_cmpl), IF 0x00 ; command complete message
259 JUMP REL(handle_sdp), IF 0x02 ; save data pointer message
260 JUMP REL(handle_extin), IF 0x01 ; extended message
261 INT int_msgin, IF not 0x04;
262 CALL REL(disconnect) ; disconnect message;
263 ; if we didn't get sdp, no need to interrupt
264 MOVE SCRATCHA0 & flag_sdp TO SFBR;
265 JUMP REL(script_sched), if 0x00;
266 ; Ok, we need to save data pointers
267 INT int_disc;
268 msgin_ack:
269 selected:
270 CLEAR ACK;
271 JUMP REL(waitphase);
272
273 ; entry point for msgout after a msgin or status phase
274 send_msgout:
275 SET ATN;
276 CLEAR ACK;
277 msgout:
278 MOVE FROM t_msg_out, WHEN MSG_OUT;
279 CLEAR ATN;
280 JUMP REL(waitphase);
281 cmdout:
282 MOVE FROM t_cmd, WHEN CMD;
283 JUMP REL(waitphase);
284 status:
285 MOVE FROM t_status, WHEN STATUS;
286 JUMP REL(waitphase);
287 datain:
288 CALL REL(savedsa);
289 MOVE SCRATCHA0 | flag_data TO SCRATCHA0;
290 datain_loop:
291 MOVE FROM t_data, WHEN DATA_IN;
292 MOVE SCRATCHA1 + 1 TO SCRATCHA1 ; adjust offset
293 MOVE DSA0 + 8 to DSA0;
294 MOVE DSA1 + 0 to DSA1 WITH CARRY;
295 MOVE DSA2 + 0 to DSA2 WITH CARRY;
296 MOVE DSA3 + 0 to DSA3 WITH CARRY;
297 JUMP REL(datain_loop), WHEN DATA_IN;
298 CALL REL(restoredsa);
299 MOVE SCRATCHA0 & flag_data_mask TO SCRATCHA0;
300 JUMP REL(waitphase);
301
302 dataout:
303 CALL REL(savedsa);
304 MOVE SCRATCHA0 | flag_data TO SCRATCHA0;
305 dataout_loop:
306 MOVE FROM t_data, WHEN DATA_OUT;
307 MOVE SCRATCHA1 + 1 TO SCRATCHA1 ; adjust offset
308 MOVE DSA0 + 8 to DSA0;
309 MOVE DSA1 + 0 to DSA1 WITH CARRY;
310 MOVE DSA2 + 0 to DSA2 WITH CARRY;
311 MOVE DSA3 + 0 to DSA3 WITH CARRY;
312 JUMP REL(dataout_loop), WHEN DATA_OUT;
313 CALL REL(restoredsa);
314 MOVE SCRATCHA0 & flag_data_mask TO SCRATCHA0;
315 JUMP REL(waitphase);
316
317 savedsa:
318 MOVE DSA0 to SFBR;
319 MOVE SFBR to SCRATCHB0;
320 MOVE DSA1 to SFBR;
321 MOVE SFBR to SCRATCHB1;
322 MOVE DSA2 to SFBR;
323 MOVE SFBR to SCRATCHB2;
324 MOVE DSA3 to SFBR;
325 MOVE SFBR to SCRATCHB3;
326 RETURN;
327
328 restoredsa:
329 MOVE SCRATCHB0 TO SFBR;
330 MOVE SFBR TO DSA0;
331 MOVE SCRATCHB1 TO SFBR;
332 MOVE SFBR TO DSA1;
333 MOVE SCRATCHB2 TO SFBR;
334 MOVE SFBR TO DSA2;
335 MOVE SCRATCHB3 TO SFBR;
336 MOVE SFBR TO DSA3;
337 RETURN;
338
339 disconnect:
340 MOVE SCNTL2 & 0x7f TO SCNTL2;
341 CLEAR ATN;
342 CLEAR ACK;
343 WAIT DISCONNECT;
344 RETURN;
345
346 handle_cmpl:
347 CALL REL(disconnect);
348 INT int_done;
349
350 handle_extin:
351 CLEAR ACK;
352 MOVE FROM t_ext_msg_in, WHEN MSG_IN;
353 INT int_extmsgin; /* let host fill in t_ext_msg_data */
354 get_extmsgdata:
355 CLEAR ACK;
356 MOVE FROM t_ext_msg_data, WHEN MSG_IN;
357 INT int_extmsgdata;
358 msgin_space:
359 NOP; space to store msgin when reselect
360
361
362 ;; per-target switch script for LUNs
363 ; hack: we first do a call to the target-specific code, so that a return
364 ; in the main switch will jump to the lun switch.
365 PROC lun_switch:
366 restore_scntl3:
367 MOVE 0xff TO SCNTL3;
368 MOVE 0xff TO SXFER;
369 JUMP abs_lunsw_return;
370 lun_switch_entry:
371 CALL REL(restore_scntl3);
372 MOVE SCRATCHA1 TO SFBR;
373 resel_lun0:
374 INT int_resellun;
375
376 ;; Per-device switch script for tag
377 PROC tag_switch:
378 tag_switch_entry:
379 MOVE SCRATCHA2 TO SFBR; restore tag
380 resel_tag0:
381 JUMP abs_tag0, IF 0x00;
382 JUMP abs_tag0, IF 0x01;
383 JUMP abs_tag0, IF 0x02;
384 JUMP abs_tag0, IF 0x03;
385 JUMP abs_tag0, IF 0x04;
386 JUMP abs_tag0, IF 0x05;
387 JUMP abs_tag0, IF 0x06;
388 JUMP abs_tag0, IF 0x07;
389 JUMP abs_tag0, IF 0x08;
390 JUMP abs_tag0, IF 0x09;
391 JUMP abs_tag0, IF 0x0a;
392 JUMP abs_tag0, IF 0x0b;
393 JUMP abs_tag0, IF 0x0c;
394 JUMP abs_tag0, IF 0x0d;
395 JUMP abs_tag0, IF 0x0e;
396 JUMP abs_tag0, IF 0x0f;
397 INT int_reseltag;
398
399 ;; per-command script: select, and called after a reselect to load DSA
400
401 PROC load_dsa:
402 ; Can't use MOVE MEMORY to load DSA, doesn't work I/O mapped
403 rdsa0:
404 MOVE 0xf0 to DSA0;
405 rdsa1:
406 MOVE 0xf1 to DSA1;
407 rdsa2:
408 MOVE 0xf2 to DSA2;
409 rdsa3:
410 MOVE 0xf3 to DSA3;
411 RETURN;
412 ldsa_reload_dsa:
413 CALL REL(rdsa0);
414 JUMP ldsa_abs_reselected;
415 ldsa_select:
416 CALL REL(rdsa0);
417 SELECT ATN FROM t_id, ldsa_abs_reselect;
418 MOVE MEMORY 4, ldsa_abs_data, ldsa_abs_slot;
419 JUMP ldsa_abs_selected;
420 ldsa_data:
421 NOP; contains data used by the MOVE MEMORY
422
423 PROC siop_led_on:
424 MOVE GPREG & 0xfe TO GPREG;
425
426 PROC siop_led_off:
427 MOVE GPREG | 0x01 TO GPREG;
428