1 /* $NetBSD: bsd_fdintr.s,v 1.28 2010/12/20 00:25:43 matt Exp $ */ 2 3 /* 4 * Copyright (c) 1995 Paul Kranenburg 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 3. All advertising materials mentioning features or use of this software 16 * must display the following acknowledgement: 17 * This product includes software developed by Paul Kranenburg. 18 * 4. The name of the author may not be used to endorse or promote products 19 * derived from this software without specific prior written permission 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 22 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 23 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 24 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 26 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 30 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 31 * 32 */ 33 34 #ifndef FDC_C_HANDLER 35 #include "assym.h" 36 #include <machine/param.h> 37 #include <machine/asm.h> 38 #include <machine/intr.h> 39 #include <machine/psl.h> 40 #include <sparc/sparc/intreg.h> 41 #include <sparc/sparc/auxreg.h> 42 #include <sparc/sparc/vaddrs.h> 43 #include <sparc/dev/fdreg.h> 44 #include <sparc/dev/fdvar.h> 45 46 #define FD_SET_SWINTR_4C \ 47 sethi %hi(INTRREG_VA), %l5; \ 48 ldub [%l5 + %lo(INTRREG_VA)], %l6; \ 49 or %l6, IE_L4, %l6; \ 50 stb %l6, [%l5 + %lo(INTRREG_VA)] 51 52 ! raise(0,IPL_SOFTFDC) ! NOTE: CPU#0 53 #define FD_SET_SWINTR_4M \ 54 sethi %hi(PINTR_SINTRLEV(IPL_SOFTFDC)), %l5; \ 55 set ICR_PI_SET, %l6; \ 56 st %l5, [%l6] 57 58 /* set software interrupt */ 59 #if (defined(SUN4) || defined(SUN4C)) && !defined(SUN4M) 60 #define FD_SET_SWINTR FD_SET_SWINTR_4C 61 #elif !(defined(SUN4) || defined(SUN4C)) && defined(SUN4M) 62 #define FD_SET_SWINTR FD_SET_SWINTR_4M 63 #else 64 #define FD_SET_SWINTR \ 65 sethi %hi(_C_LABEL(cputyp)), %l5; \ 66 ld [%l5 + %lo(_C_LABEL(cputyp))], %l5; \ 67 cmp %l5, CPU_SUN4M; \ 68 be 8f; \ 69 FD_SET_SWINTR_4C; \ 70 ba,a 9f; \ 71 8: \ 72 FD_SET_SWINTR_4M; \ 73 9: 74 #endif 75 76 ! flip TC bit in auxreg 77 ! assumes %l6 remains unchanged between ASSERT and DEASSERT 78 #define FD_ASSERT_TC_4C \ 79 sethi %hi(AUXREG_VA), %l6; \ 80 ldub [%l6 + %lo(AUXREG_VA) + 3], %l7; \ 81 or %l7, AUXIO4C_MB1|AUXIO4C_FTC, %l7; \ 82 stb %l7, [%l6 + %lo(AUXREG_VA) + 3]; 83 84 #define FD_DEASSERT_TC_4C \ 85 ldub [%l6 + %lo(AUXREG_VA) + 3], %l7; \ 86 andn %l7, AUXIO4C_FTC, %l7; \ 87 or %l7, AUXIO4C_MB1, %l7; \ 88 stb %l7, [%l6 + %lo(AUXREG_VA) + 3]; 89 90 ! flip TC bit in auxreg 91 #define FD_ASSERT_TC_4M \ 92 sethi %hi(AUXREG_VA), %l6; \ 93 ldub [%l6 + %lo(AUXREG_VA) + 3], %l7; \ 94 or %l7, AUXIO4M_MB1|AUXIO4M_FTC, %l7; \ 95 stb %l7, [%l6 + %lo(AUXREG_VA) + 3]; 96 97 #define FD_DEASSERT_TC_4M 98 99 /* 100 * flip TC bit in auxreg 101 * assumes %l5 remains unchanged between ASSERT and DEASSERT 102 */ 103 #if (defined(SUN4) || defined(SUN4C)) && !defined(SUN4M) 104 #define FD_ASSERT_TC FD_ASSERT_TC_4C 105 #define FD_DEASSERT_TC FD_DEASSERT_TC_4C 106 #elif !(defined(SUN4) || defined(SUN4C)) && defined(SUN4M) 107 #define FD_ASSERT_TC FD_ASSERT_TC_4M 108 #define FD_DEASSERT_TC FD_DEASSERT_TC_4M 109 #else 110 #define FD_ASSERT_TC \ 111 sethi %hi(_C_LABEL(cputyp)), %l5; \ 112 ld [%l5 + %lo(_C_LABEL(cputyp))], %l5; \ 113 cmp %l5, CPU_SUN4M; \ 114 be 8f; \ 115 nop; \ 116 FD_ASSERT_TC_4C; \ 117 ba,a 9f; \ 118 8: \ 119 FD_ASSERT_TC_4M; \ 120 9: 121 #define FD_DEASSERT_TC \ 122 cmp %l5, CPU_SUN4M; \ 123 be 8f; \ 124 nop; \ 125 FD_DEASSERT_TC_4C; \ 126 ba,a 9f; \ 127 8: \ 128 FD_DEASSERT_TC_4M; \ 129 9: 130 #endif 131 132 133 /* Timeout waiting for chip ready */ 134 #define POLL_TIMO 100000 135 136 /* 137 * register mnemonics. note overlapping assignments. 138 */ 139 #define R_fdc %l0 140 #define R_msr %l1 141 #define R_fifo %l2 142 #define R_buf %l3 143 #define R_tc %l4 144 #define R_stat %l3 145 #define R_nstat %l4 146 #define R_stcnt %l5 147 /* use %l6 and %l7 as short-term temporaries */ 148 149 150 .seg "data" 151 .align 8 152 /* A save haven for three precious registers */ 153 save_l: 154 .word 0 155 .word 0 156 .word 0 157 /* Pointer to a `struct fdcio', set in fd.c */ 158 .global _C_LABEL(fdciop) 159 _C_LABEL(fdciop): 160 .word 0 161 162 .seg "text" 163 .align 4 164 165 _ENTRY(_C_LABEL(fdchwintr)) 166 set save_l, %l7 167 std %l0, [%l7] 168 st %l2, [%l7 + 8] 169 170 ! tally interrupt (curcpu()->cpu_data.cpu_nintr++) 171 INCR64X(CPUINFO_VA+CPUINFO_NINTR, %l4, %l5, %l7) 172 173 ! load fdc, if it's NULL there's nothing to do: schedule soft interrupt 174 sethi %hi(_C_LABEL(fdciop)), %l7 175 ld [%l7 + %lo(_C_LABEL(fdciop))], R_fdc 176 177 ! tally interrupt (fdcio_intrcnt.ev_count++) 178 ldd [R_fdc + FDC_EVCNT], %l6 179 addcc %l7, 1, %l7 180 addx %l6, 0, %l6 181 std %l6, [R_fdc + FDC_EVCNT] 182 183 /* 184 * load chips register addresses 185 * NOTE: we ignore the bus tag here and assume the bus handle 186 * is the virtual address of the chip's registers. 187 */ 188 ld [R_fdc + FDC_REG_HANDLE], %l7 ! get chip registers bus handle 189 ld [R_fdc + FDC_REG_MSR], R_msr ! get chip MSR reg addr 190 add R_msr, %l7, R_msr 191 ld [R_fdc + FDC_REG_FIFO], R_fifo ! get chip FIFO reg addr 192 add R_fifo, %l7, R_fifo 193 !!ld [R_fdc + FDC_REG_DOR], R_dor ! get chip DOR reg addr 194 !!add R_dor, %l7, R_dor 195 196 ! find out what we are supposed to do 197 ld [R_fdc + FDC_ITASK], %l7 ! get task from fdc 198 cmp %l7, FDC_ITASK_SENSEI 199 be sensei 200 !nop 201 cmp %l7, FDC_ITASK_RESULT 202 be resultphase 203 !nop 204 cmp %l7, FDC_ITASK_DMA 205 bne,a ssi ! a spurious interrupt 206 mov FDC_ISTATUS_SPURIOUS, %l7 ! set status and post sw intr 207 208 ! pseudo DMA 209 ld [R_fdc + FDC_TC], R_tc ! residual count 210 ld [R_fdc + FDC_DATA], R_buf ! IO buffer 211 212 ldub [R_msr], %l7 ! get MSR value 213 nextc: 214 btst NE7_RQM, %l7 ! room in fifo? 215 bnz,a 0f 216 btst NE7_NDM, %l7 ! execution finished? 217 218 ! we filled/emptied the FIFO; update fdc->sc_buf & fdc->sc_tc 219 st R_tc, [R_fdc + FDC_TC] 220 b x 221 st R_buf, [R_fdc + FDC_DATA] 222 223 0: 224 bz resultphase 225 226 tst R_tc 227 bnz 0f 228 nop 229 230 !! panic("fdc: overrun") 231 sethi %hi(.Lpanic_msg), %o0 232 call _C_LABEL(panic) 233 or %lo(.Lpanic_msg), %o0, %o0 234 /* NOTREACHED */ 235 236 0: btst NE7_DIO, %l7 ! IO direction 237 bz 1f 238 deccc R_tc 239 ldub [R_fifo], %l7 ! reading: 240 b 2f 241 stb %l7, [R_buf] ! *fdc->sc_bufp = *reg_fifo 242 243 1: 244 ldub [R_buf], %l7 ! writing: 245 stb %l7, [R_fifo] ! *reg_fifo = *fdc->sc_bufp 246 2: 247 inc R_buf ! fdc->sc_bufp++ 248 bne,a nextc ! if (--fdc->sc_tc) goto ... 249 ldub [R_msr], %l7 ! get MSR value 250 251 ! xfer done: update fdc->sc_buf & fdc->sc_tc, mark istate DONE 252 st R_tc, [R_fdc + FDC_TC] 253 st R_buf, [R_fdc + FDC_DATA] 254 255 ! flip TC bit in auxreg 256 FD_ASSERT_TC 257 nop; nop; nop ! XXX 258 FD_DEASSERT_TC 259 b,a x 260 261 262 sensei: 263 ldub [R_msr], %l7 264 set POLL_TIMO, %l6 265 1: deccc %l6 ! timeout? 266 be,a ssi ! if so, set status 267 mov FDC_ISTATUS_ERROR, %l7 ! and post sw interrupt 268 and %l7, (NE7_RQM | NE7_DIO | NE7_CB), %l7 269 cmp %l7, NE7_RQM 270 bne,a 1b ! loop till chip ready 271 ldub [R_msr], %l7 272 mov NE7CMD_SENSEI, %l7 273 stb %l7, [R_fifo] 274 275 resultphase: 276 ! prepare for result phase 277 add R_fdc, FDC_STATUS, R_stat ! &fdc->sc_status[0] 278 mov -1, %l7 279 st %l7, [R_fdc + FDC_NSTAT] ! fdc->sc_nstat = -1; 280 281 resultphase1: 282 clr R_stcnt 283 ldub [R_msr], %l7 284 set POLL_TIMO, %l6 285 1: deccc %l6 ! timeout? 286 be,a ssi ! if so, set status 287 mov FDC_ISTATUS_ERROR, %l7 ! and post sw interrupt 288 and %l7, (NE7_RQM | NE7_DIO | NE7_CB), %l7 289 cmp %l7, NE7_RQM 290 be 3f ! done 291 cmp %l7, (NE7_RQM | NE7_DIO | NE7_CB) 292 bne,a 1b ! loop till chip ready 293 ldub [R_msr], %l7 294 295 cmp R_stcnt, FDC_NSTATUS ! status overrun? 296 bge 2f ! if so, load but dont store 297 ldub [R_fifo], %l7 ! load the status byte 298 stb %l7, [R_stat] 299 inc R_stat 300 inc R_stcnt 301 2: b 1b 302 ldub [R_msr], %l7 303 304 3: 305 ! got status, update sc_nstat and mark istate DONE 306 st R_stcnt, [R_fdc + FDC_NSTAT] 307 mov FDC_ISTATUS_DONE, %l7 308 309 ssi: 310 ! set software interrupt 311 ! enter here with status in %l7 312 ! SMP: consider which CPU to ping? 313 st %l7, [R_fdc + FDC_ISTATUS] 314 FD_SET_SWINTR 315 316 x: 317 /* 318 * Restore psr -- note: psr delay honored by pc restore loads. 319 */ 320 set save_l, %l7 321 ldd [%l7], %l0 322 mov %l0, %psr 323 nop 324 ld [%l7 + 8], %l2 325 jmp %l1 326 rett %l2 327 328 329 .Lpanic_msg: 330 .asciz "fdc: overrun" 331 #endif 332
Indexes created Mon Sep 22 13:09:51 GMT 2025