siop.ss revision 1.7 1 ; $NetBSD: siop.ss,v 1.7 2000/06/13 13:59:15 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 ABSOLUTE int_done = 0xff00;
46 ABSOLUTE int_msgin = 0xff01;
47 ABSOLUTE int_extmsgin = 0xff02;
48 ABSOLUTE int_extmsgdata = 0xff03;
49 ABSOLUTE int_resel = 0xff04;
50 ABSOLUTE int_reseltag = 0xff05;
51 ABSOLUTE int_resfail = 0xff06;
52 ABSOLUTE int_disc = 0xff07;
53 ABSOLUTE int_err = 0xffff;
54
55 ; flags for scratcha0
56 ABSOLUTE flag_sdp = 0x01 ; got save data pointer
57 ABSOLUTE flag_data = 0x02 ; we're in data phase
58 ABSOLUTE flag_data_mask = 0xfd ; ~flag_data
59
60 ENTRY waitphase;
61 ENTRY send_msgout;
62 ENTRY msgout;
63 ENTRY msgin;
64 ENTRY msgin_ack;
65 ENTRY dataout;
66 ENTRY datain;
67 ENTRY cmdout;
68 ENTRY status;
69 ENTRY disconnect;
70 ENTRY reselect;
71 ENTRY selected;
72 ENTRY get_extmsgdata;
73 ENTRY slot;
74 ENTRY idsa0;
75 ENTRY idsa1;
76 ENTRY idsa2;
77 ENTRY idsa3;
78 ENTRY slotdata;
79 ENTRY nextslot;
80 ENTRY endslot;
81
82 EXTERN script_abs_shed;
83 EXTERN slot_nextp;
84 EXTERN slot_shed_addrsrc;
85 EXTERN slot_abs_reselect;
86 EXTERN slot_abs_selected;
87
88 EXTERN endslot_abs_reselect;
89
90 PROC siop_script:
91
92 selected:
93 ; starting a new session, init 'local variables'
94 MOVE 0 to SCRATCHA0 ; flags
95 MOVE 0 to SCRATCHA1 ; DSA offset (for S/G save data pointer)
96 CLEAR ACK;
97 waitphase:
98 JUMP REL(msgout), WHEN MSG_OUT;
99 JUMP REL(msgin), WHEN MSG_IN;
100 JUMP REL(dataout), WHEN DATA_OUT;
101 JUMP REL(datain), WHEN DATA_IN;
102 JUMP REL(cmdout), WHEN CMD;
103 JUMP REL(status), WHEN STATUS;
104 err:
105 INT int_err;
106
107 reselect:
108 WAIT RESELECT REL(reselect_fail)
109 MOVE SSID & 0x8f to SFBR
110 MOVE SFBR to SCRATCHA0 ; save reselect ID
111 INT int_err, WHEN NOT MSG_IN;
112 MOVE FROM t_msg_in, WHEN MSG_IN;
113 INT int_resel;
114
115 reselect_fail:
116 ; check that host asserted SIGP, this'll clear SIGP in ISTAT
117 MOVE CTEST2 & 0x40 TO SFBR;
118 INT int_resfail, IF 0x00;
119 JUMP script_abs_shed;
120
121 msgin:
122 CLEAR ATN
123 MOVE FROM t_msg_in, WHEN MSG_IN;
124 JUMP REL(handle_dis), IF 0x04 ; disconnect message
125 JUMP REL(handle_cmpl), IF 0x00 ; command complete message
126 JUMP REL(handle_sdp), IF 0x02 ; save data pointer message
127 JUMP REL(handle_extin), IF 0x01 ; extended message
128 INT int_msgin;
129 msgin_ack:
130 CLEAR ACK;
131 JUMP REL(waitphase);
132
133 ; entry point for msgout after a msgin or status phase
134 send_msgout:
135 SET ATN;
136 CLEAR ACK;
137 msgout:
138 MOVE FROM t_msg_out, WHEN MSG_OUT;
139 CLEAR ATN;
140 JUMP REL(waitphase);
141 cmdout:
142 MOVE FROM t_cmd, WHEN CMD;
143 JUMP REL(waitphase);
144 status:
145 MOVE FROM t_status, WHEN STATUS;
146 JUMP REL(waitphase);
147 datain:
148 CALL REL(savedsa);
149 MOVE SCRATCHA0 | flag_data TO SCRATCHA0;
150 datain_loop:
151 MOVE FROM t_data, WHEN DATA_IN;
152 MOVE SCRATCHA1 + 1 TO SCRATCHA1 ; adjust offset
153 MOVE DSA0 + 8 to DSA0;
154 MOVE DSA1 + 0 to DSA1 WITH CARRY;
155 MOVE DSA2 + 0 to DSA2 WITH CARRY;
156 MOVE DSA3 + 0 to DSA3 WITH CARRY;
157 JUMP REL(datain_loop), WHEN DATA_IN;
158 CALL REL(restoredsa);
159 MOVE SCRATCHA0 & flag_data_mask TO SCRATCHA0;
160 JUMP REL(waitphase);
161
162 dataout:
163 CALL REL(savedsa);
164 MOVE SCRATCHA0 | flag_data TO SCRATCHA0;
165 dataout_loop:
166 MOVE FROM t_data, WHEN DATA_OUT;
167 MOVE SCRATCHA1 + 1 TO SCRATCHA1 ; adjust offset
168 MOVE DSA0 + 8 to DSA0;
169 MOVE DSA1 + 0 to DSA1 WITH CARRY;
170 MOVE DSA2 + 0 to DSA2 WITH CARRY;
171 MOVE DSA3 + 0 to DSA3 WITH CARRY;
172 JUMP REL(dataout_loop), WHEN DATA_OUT;
173 CALL REL(restoredsa);
174 MOVE SCRATCHA0 & flag_data_mask TO SCRATCHA0;
175 JUMP REL(waitphase);
176
177 savedsa:
178 MOVE DSA0 to SFBR;
179 MOVE SFBR to SCRATCHB0;
180 MOVE DSA1 to SFBR;
181 MOVE SFBR to SCRATCHB1;
182 MOVE DSA2 to SFBR;
183 MOVE SFBR to SCRATCHB2;
184 MOVE DSA3 to SFBR;
185 MOVE SFBR to SCRATCHB3;
186 RETURN;
187
188 restoredsa:
189 MOVE SCRATCHB0 TO SFBR;
190 MOVE SFBR TO DSA0;
191 MOVE SCRATCHB1 TO SFBR;
192 MOVE SFBR TO DSA1;
193 MOVE SCRATCHB2 TO SFBR;
194 MOVE SFBR TO DSA2;
195 MOVE SCRATCHB3 TO SFBR;
196 MOVE SFBR TO DSA3;
197 RETURN;
198
199 disconnect:
200 MOVE SCNTL2 & 0x7f TO SCNTL2;
201 CLEAR ATN;
202 CLEAR ACK;
203 WAIT DISCONNECT;
204 RETURN;
205
206 handle_dis:
207 CALL REL(disconnect);
208 ; if we didn't get sdp, or if offset is 0, no need to interrupt
209 MOVE SCRATCHA0 & flag_sdp TO SFBR;
210 JUMP script_abs_shed, if 0x00;
211 MOVE SCRATCHA1 TO SFBR;
212 JUMP script_abs_shed, if 0x00;
213 ; Ok, we need to save data pointers
214 INT int_disc;
215
216 handle_cmpl:
217 CALL REL(disconnect);
218 INT int_done;
219 handle_sdp:
220 CLEAR ACK;
221 MOVE SCRATCHA0 | flag_sdp TO SCRATCHA0;
222 JUMP REL(msgin) ; should get a disconnect message now
223
224 handle_extin:
225 CLEAR ACK;
226 INT int_err, IF NOT MSG_IN;
227 MOVE FROM t_ext_msg_in, WHEN MSG_IN;
228 INT int_extmsgin; /* let host fill in t_ext_msg_data */
229 get_extmsgdata:
230 CLEAR ACK;
231 INT int_err, IF NOT MSG_IN;
232 MOVE FROM t_ext_msg_data, WHEN MSG_IN;
233 INT int_extmsgdata;
234
235 ; script used for the scheduler: when a slot is free the JUMP points to
236 ; the next slot so that instructions for this slot are not run.
237 ; once the CPU has set up the slot variables (DSA address) it changes
238 ; the JUMP address to 0 (so that it'll jump to the next instruction) and
239 ; this command will be processed next time the scheduler is executed.
240 ; When the target has been successfully selected the script changes the jump
241 ; addr back to the next slot, so that it's ignored the next time.
242 ;
243
244 PROC slot_script:
245 slot:
246 JUMP REL(nextslot);
247 idsa0:
248 MOVE 0x00 to dsa0;
249 idsa1:
250 MOVE 0x01 to dsa1;
251 idsa2:
252 MOVE 0x02 to dsa2;
253 idsa3:
254 MOVE 0x03 to dsa3;
255 SELECT ATN FROM t_id, slot_abs_reselect;
256 MOVE MEMORY 4, slot_shed_addrsrc, slot_nextp;
257 JUMP slot_abs_selected;
258 slotdata:
259 NOP; slot variables: dsa & jumppatchp
260 nextslot: NOP; /* will be changed to the next slot entry
261
262 PROC endslot_script:
263 JUMP endslot_abs_reselect;
264