1 /* socal.c: Sparc SUNW,socal (SOC+) Fibre Channel Sbus adapter support.
3 * Copyright (C) 1998,1999 Jakub Jelinek (jj@ultra.linux.cz)
6 * Fibre Channel Physical & Signaling Interface (FC-PH), dpANS, 1994
7 * dpANS Fibre Channel Protocol for SCSI (X3.269-199X), Rev. 012, 1995
8 * SOC+ Programming Guide 0.1
9 * Fibre Channel Arbitrated Loop (FC-AL), dpANS rev. 4.5, 1995
12 * On-board SOC+ adapters of Ultra Enterprise servers and sun4d.
15 static char *version
=
16 "socal.c: SOC+ driver v1.1 9/Feb/99 Jakub Jelinek (jj@ultra.linux.cz)\n";
18 #include <linux/module.h>
19 #include <linux/kernel.h>
20 #include <linux/sched.h>
21 #include <linux/types.h>
22 #include <linux/fcntl.h>
23 #include <linux/interrupt.h>
24 #include <linux/ptrace.h>
25 #include <linux/ioport.h>
27 #include <linux/malloc.h>
28 #include <linux/string.h>
29 #include <linux/init.h>
30 #include <asm/system.h>
31 #include <asm/bitops.h>
34 #include <linux/errno.h>
35 #include <asm/byteorder.h>
37 #include <asm/openprom.h>
38 #include <asm/oplib.h>
39 #include <asm/auxio.h>
40 #include <asm/pgtable.h>
43 /* #define SOCALDEBUG */
44 /* #define HAVE_SOCAL_UCODE */
45 /* #define USE_64BIT_MODE */
49 #ifdef HAVE_SOCAL_UCODE
50 #include "socal_asm.h"
53 #define socal_printk printk ("socal%d: ", s->socal_no); printk
56 #define SOD(x) socal_printk x;
61 #define for_each_socal(s) for (s = socals; s; s = s->next)
62 struct socal
*socals
= NULL
;
64 static void socal_copy_from_xram(void *d
, unsigned long xram
, long size
)
68 *dp
++ = sbus_readl(xram
);
74 static void socal_copy_to_xram(unsigned long xram
, void *s
, long size
)
79 sbus_writel(val
, xram
);
85 #ifdef HAVE_SOCAL_UCODE
86 static void socal_bzero(unsigned long xram
, int size
)
96 static inline void socal_disable(struct socal
*s
)
98 sbus_writel(0, s
->regs
+ IMASK
);
99 sbus_writel(SOCAL_CMD_SOFT_RESET
, s
->regs
+ CMD
);
102 static inline void socal_enable(struct socal
*s
)
104 SOD(("enable %08x\n", s
->cfg
))
105 sbus_writel(0, s
->regs
+ SAE
);
106 sbus_writel(s
->cfg
, s
->regs
+ CFG
);
107 sbus_writel(SOCAL_CMD_RSP_QALL
, s
->regs
+ CMD
);
108 SOCAL_SETIMASK(s
, SOCAL_IMASK_RSP_QALL
| SOCAL_IMASK_SAE
);
109 SOD(("imask %08x %08x\n", s
->imask
, sbus_readl(s
->regs
+ IMASK
)));
112 static void socal_reset(fc_channel
*fc
)
114 socal_port
*port
= (socal_port
*)fc
;
115 struct socal
*s
= port
->s
;
136 static void inline socal_solicited(struct socal
*s
, unsigned long qno
)
144 sw_cq
= &s
->rsp
[qno
];
146 /* Finally an improvement against old SOC :) */
147 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
148 SOD (("socal_solicited, %d packets arrived\n",
149 (sw_cq
->in
- sw_cq
->out
) & sw_cq
->last
))
151 hwrsp
= (socal_rsp
*)sw_cq
->pool
+ sw_cq
->out
;
152 SOD(("hwrsp %p out %d\n", hwrsp
, sw_cq
->out
))
154 #if defined(SOCALDEBUG) && 0
156 u32
*u
= (u32
*)hwrsp
;
157 SOD(("%08x.%08x.%08x.%08x.%08x.%08x.%08x.%08x\n",
158 u
[0],u
[1],u
[2],u
[3],u
[4],u
[5],u
[6],u
[7]))
160 SOD(("%08x.%08x.%08x.%08x.%08x.%08x.%08x.%08x\n",
161 u
[0],u
[1],u
[2],u
[3],u
[4],u
[5],u
[6],u
[7]))
163 while (u
< ((u32
*)s
->regs
)) {
164 if (sbus_readl(&u
[0]) == 0x00003000 ||
165 sbus_readl(&u
[0]) == 0x00003801) {
166 SOD(("Found at %04lx\n",
167 (unsigned long)u
- (unsigned long)s
->xram
))
168 SOD((" %08x.%08x.%08x.%08x.%08x.%08x.%08x.%08x\n",
169 sbus_readl(&u
[0]), sbus_readl(&u
[1]),
170 sbus_readl(&u
[2]), sbus_readl(&u
[3]),
171 sbus_readl(&u
[4]), sbus_readl(&u
[5]),
172 sbus_readl(&u
[6]), sbus_readl(&u
[7])))
174 SOD((" %08x.%08x.%08x.%08x.%08x.%08x.%08x.%08x\n",
175 sbus_readl(&u
[0]), sbus_readl(&u
[1]),
176 sbus_readl(&u
[2]), sbus_readl(&u
[3]),
177 sbus_readl(&u
[4]), sbus_readl(&u
[5]),
178 sbus_readl(&u
[6]), sbus_readl(&u
[7])))
186 token
= hwrsp
->shdr
.token
;
187 status
= hwrsp
->status
;
188 fc
= (fc_channel
*)(&s
->port
[(token
>> 11) & 1]);
190 SOD(("Solicited token %08x status %08x\n", token
, status
))
191 if (status
== SOCAL_OK
) {
192 fcp_receive_solicited(fc
, token
>> 12,
193 token
& ((1 << 11) - 1),
196 /* We have intentionally defined FC_STATUS_* constants
197 * to match SOCAL_* constants, otherwise we'd have to
200 fcp_receive_solicited(fc
, token
>> 12,
201 token
& ((1 << 11) - 1), status
, &hwrsp
->fchdr
);
204 if (++sw_cq
->out
> sw_cq
->last
) {
209 if (sw_cq
->out
== sw_cq
->in
) {
210 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
211 if (sw_cq
->out
== sw_cq
->in
) {
212 /* Tell the hardware about it */
213 sbus_writel((sw_cq
->out
<< 24) |
214 (SOCAL_CMD_RSP_QALL
&
215 ~(SOCAL_CMD_RSP_Q0
<< qno
)),
218 /* Read it, so that we're sure it has been updated */
219 sbus_readl(s
->regs
+ CMD
);
220 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
221 if (sw_cq
->out
== sw_cq
->in
)
228 static void inline socal_request (struct socal
*s
, u32 cmd
)
230 SOCAL_SETIMASK(s
, s
->imask
& ~(cmd
& SOCAL_CMD_REQ_QALL
));
231 SOD(("imask %08x %08x\n", s
->imask
, sbus_readl(s
->regs
+ IMASK
)));
233 SOD(("Queues available %08x OUT %X\n", cmd
, s
->regs
->reqpr
[0]))
234 if (s
->port
[s
->curr_port
].fc
.state
!= FC_STATE_OFFLINE
) {
235 fcp_queue_empty ((fc_channel
*)&(s
->port
[s
->curr_port
]));
236 if (((s
->req
[1].in
+ 1) & s
->req
[1].last
) != (s
->req
[1].out
))
237 fcp_queue_empty ((fc_channel
*)&(s
->port
[1 - s
->curr_port
]));
239 fcp_queue_empty ((fc_channel
*)&(s
->port
[1 - s
->curr_port
]));
241 if (s
->port
[1 - s
->curr_port
].fc
.state
!= FC_STATE_OFFLINE
)
245 static void inline socal_unsolicited (struct socal
*s
, unsigned long qno
)
247 socal_rsp
*hwrsp
, *hwrspc
;
254 sw_cq
= &s
->rsp
[qno
];
256 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
257 SOD (("socal_unsolicited, %d packets arrived, in %d\n",
258 (sw_cq
->in
- sw_cq
->out
) & sw_cq
->last
, sw_cq
->in
))
259 while (sw_cq
->in
!= sw_cq
->out
) {
260 /* ...real work per entry here... */
261 hwrsp
= (socal_rsp
*)sw_cq
->pool
+ sw_cq
->out
;
262 SOD(("hwrsp %p out %d\n", hwrsp
, sw_cq
->out
))
264 #if defined(SOCALDEBUG) && 0
266 u32
*u
= (u32
*)hwrsp
;
267 SOD(("%08x.%08x.%08x.%08x.%08x.%08x.%08x.%08x\n",
268 u
[0],u
[1],u
[2],u
[3],u
[4],u
[5],u
[6],u
[7]))
270 SOD(("%08x.%08x.%08x.%08x.%08x.%08x.%08x.%08x\n",
271 u
[0],u
[1],u
[2],u
[3],u
[4],u
[5],u
[6],u
[7]))
276 flags
= hwrsp
->shdr
.flags
;
277 count
= hwrsp
->count
;
278 fc
= (fc_channel
*)&s
->port
[flags
& SOCAL_PORT_B
];
279 SOD(("FC %08lx\n", (long)fc
))
282 /* Ugh, continuation entries */
286 printk("%s: Too many continuations entries %d\n",
293 in
+= sw_cq
->last
+ 1;
294 if (in
< sw_cq
->out
+ 2) {
295 /* Ask the hardware if they haven't arrived yet. */
296 sbus_writel((sw_cq
->out
<< 24) |
297 (SOCAL_CMD_RSP_QALL
&
298 ~(SOCAL_CMD_RSP_Q0
<< qno
)),
301 /* Read it, so that we're sure it has been updated */
302 sbus_readl(s
->regs
+ CMD
);
303 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
306 in
+= sw_cq
->last
+ 1;
307 if (in
< sw_cq
->out
+ 2) /* Nothing came, let us wait */
310 if (sw_cq
->out
== sw_cq
->last
)
311 hwrspc
= (socal_rsp
*)sw_cq
->pool
;
316 switch (flags
& ~SOCAL_PORT_B
) {
318 status
= hwrsp
->status
;
321 SOD(("State change to ONLINE\n"));
322 fcp_state_change(fc
, FC_STATE_ONLINE
);
324 case SOCAL_ONLINE_LOOP
:
325 SOD(("State change to ONLINE_LOOP\n"));
326 fcp_state_change(fc
, FC_STATE_ONLINE
);
329 SOD(("State change to OFFLINE\n"));
330 fcp_state_change(fc
, FC_STATE_OFFLINE
);
333 printk ("%s: Unknown STATUS no %d\n",
339 case (SOCAL_UNSOLICITED
|SOCAL_FC_HDR
):
341 int r_ctl
= *((u8
*)&hwrsp
->fchdr
);
344 if ((r_ctl
& 0xf0) == R_CTL_EXTENDED_SVC
) {
345 len
= hwrsp
->shdr
.bytecnt
;
346 if (len
< 4 || !hwrspc
) {
347 printk ("%s: Invalid R_CTL %02x "
348 "continuation entries\n",
353 if (*(u32
*)hwrspc
== LS_DISPLAY
) {
356 for (i
= 4; i
< len
; i
++)
357 if (((u8
*)hwrspc
)[i
] == '\n')
358 ((u8
*)hwrspc
)[i
] = ' ';
359 ((u8
*)hwrspc
)[len
] = 0;
360 printk ("%s message: %s\n",
361 fc
->name
, ((u8
*)hwrspc
) + 4);
363 printk ("%s: Unknown LS_CMD "
369 printk ("%s: Unsolicited R_CTL %02x "
370 "not handled\n", fc
->name
, r_ctl
);
375 printk ("%s: Unexpected flags %08x\n", fc
->name
, flags
);
379 if (++sw_cq
->out
> sw_cq
->last
) {
385 if (++sw_cq
->out
> sw_cq
->last
) {
391 if (sw_cq
->out
== sw_cq
->in
) {
392 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
393 if (sw_cq
->out
== sw_cq
->in
) {
394 /* Tell the hardware about it */
395 sbus_writel((sw_cq
->out
<< 24) |
396 (SOCAL_CMD_RSP_QALL
&
397 ~(SOCAL_CMD_RSP_Q0
<< qno
)),
400 /* Read it, so that we're sure it has been updated */
401 sbus_readl(s
->regs
+ CMD
);
402 sw_cq
->in
= sbus_readb(s
->regs
+ RESP
+ qno
);
408 static void socal_intr(int irq
, void *dev_id
, struct pt_regs
*regs
)
412 register struct socal
*s
= (struct socal
*)dev_id
;
414 spin_lock_irqsave(&io_request_lock
, flags
);
415 cmd
= sbus_readl(s
->regs
+ CMD
);
416 for (; (cmd
= SOCAL_INTR (s
, cmd
)); cmd
= sbus_readl(s
->regs
+ CMD
)) {
420 printk("soc_intr %08x\n", cmd
);
422 if (cmd
& SOCAL_CMD_RSP_Q2
)
423 socal_unsolicited (s
, SOCAL_UNSOLICITED_RSP_Q
);
424 if (cmd
& SOCAL_CMD_RSP_Q1
)
425 socal_unsolicited (s
, SOCAL_SOLICITED_BAD_RSP_Q
);
426 if (cmd
& SOCAL_CMD_RSP_Q0
)
427 socal_solicited (s
, SOCAL_SOLICITED_RSP_Q
);
428 if (cmd
& SOCAL_CMD_REQ_QALL
)
429 socal_request (s
, cmd
);
431 spin_unlock_irqrestore(&io_request_lock
, flags
);
434 #define TOKEN(proto, port, token) (((proto)<<12)|(token)|(port))
436 static int socal_hw_enque (fc_channel
*fc
, fcp_cmnd
*fcmd
)
438 socal_port
*port
= (socal_port
*)fc
;
439 struct socal
*s
= port
->s
;
447 if (fcmd
->proto
== TYPE_SCSI_FCP
)
451 SOD(("Putting a FCP packet type %d into hw queue %d\n", fcmd
->proto
, qno
))
452 if (s
->imask
& (SOCAL_IMASK_REQ_Q0
<< qno
)) {
453 SOD(("EIO %08x\n", s
->imask
))
456 sw_cq
= s
->req
+ qno
;
457 cq_next_in
= (sw_cq
->in
+ 1) & sw_cq
->last
;
459 if (cq_next_in
== sw_cq
->out
&&
460 cq_next_in
== (sw_cq
->out
= sbus_readb(s
->regs
+ REQP
+ qno
))) {
461 SOD(("%d IN %d OUT %d LAST %d\n",
463 sw_cq
->out
, sw_cq
->last
))
464 SOCAL_SETIMASK(s
, s
->imask
| (SOCAL_IMASK_REQ_Q0
<< qno
));
465 SOD(("imask %08x %08x\n", s
->imask
, sbus_readl(s
->regs
+ IMASK
)));
467 /* If queue is full, just say NO. */
471 request
= sw_cq
->pool
+ sw_cq
->in
;
472 fch
= &request
->fchdr
;
474 switch (fcmd
->proto
) {
476 request
->shdr
.token
= TOKEN(TYPE_SCSI_FCP
, port
->mask
, fcmd
->token
);
477 request
->data
[0].base
= fc
->dma_scsi_cmd
+ fcmd
->token
* sizeof(fcp_cmd
);
478 request
->data
[0].count
= sizeof(fcp_cmd
);
479 request
->data
[1].base
= fc
->dma_scsi_rsp
+ fcmd
->token
* fc
->rsp_size
;
480 request
->data
[1].count
= fc
->rsp_size
;
482 request
->shdr
.segcnt
= 3;
483 i
= fc
->scsi_cmd_pool
[fcmd
->token
].fcp_data_len
;
484 request
->shdr
.bytecnt
= i
;
485 request
->data
[2].base
= fcmd
->data
;
486 request
->data
[2].count
= i
;
487 request
->type
= (fc
->scsi_cmd_pool
[fcmd
->token
].fcp_cntl
& FCP_CNTL_WRITE
) ?
488 SOCAL_CQTYPE_IO_WRITE
: SOCAL_CQTYPE_IO_READ
;
490 request
->shdr
.segcnt
= 2;
491 request
->shdr
.bytecnt
= 0;
492 request
->data
[2].base
= 0;
493 request
->data
[2].count
= 0;
494 request
->type
= SOCAL_CQTYPE_SIMPLE
;
496 FILL_FCHDR_RCTL_DID(fch
, R_CTL_COMMAND
, fcmd
->did
);
497 FILL_FCHDR_SID(fch
, fc
->sid
);
498 FILL_FCHDR_TYPE_FCTL(fch
, TYPE_SCSI_FCP
, F_CTL_FIRST_SEQ
| F_CTL_SEQ_INITIATIVE
);
499 FILL_FCHDR_SEQ_DF_SEQ(fch
, 0, 0, 0);
500 FILL_FCHDR_OXRX(fch
, 0xffff, 0xffff);
502 request
->shdr
.flags
= port
->flags
;
503 request
->shdr
.class = fc
->posmap
? 3 : 2;
507 memset (request
, 0, sizeof(*request
));
508 request
->shdr
.token
= TOKEN(PROTO_OFFLINE
, port
->mask
, fcmd
->token
);
509 request
->type
= SOCAL_CQTYPE_OFFLINE
;
510 FILL_FCHDR_RCTL_DID(fch
, R_CTL_COMMAND
, fcmd
->did
);
511 FILL_FCHDR_SID(fch
, fc
->sid
);
512 FILL_FCHDR_TYPE_FCTL(fch
, TYPE_SCSI_FCP
, F_CTL_FIRST_SEQ
| F_CTL_SEQ_INITIATIVE
);
513 FILL_FCHDR_SEQ_DF_SEQ(fch
, 0, 0, 0);
514 FILL_FCHDR_OXRX(fch
, 0xffff, 0xffff);
515 request
->shdr
.flags
= port
->flags
;
518 case PROTO_REPORT_AL_MAP
:
519 memset (request
, 0, sizeof(*request
));
520 request
->shdr
.token
= TOKEN(PROTO_REPORT_AL_MAP
, port
->mask
, fcmd
->token
);
521 request
->type
= SOCAL_CQTYPE_REPORT_MAP
;
522 request
->shdr
.flags
= port
->flags
;
523 request
->shdr
.segcnt
= 1;
524 request
->shdr
.bytecnt
= sizeof(fc_al_posmap
);
525 request
->data
[0].base
= fcmd
->cmd
;
526 request
->data
[0].count
= sizeof(fc_al_posmap
);
530 request
->shdr
.token
= TOKEN(fcmd
->proto
, port
->mask
, fcmd
->token
);
531 request
->shdr
.class = fc
->posmap
? 3 : 2;
532 request
->shdr
.flags
= port
->flags
;
533 memcpy (fch
, &fcmd
->fch
, sizeof(fc_hdr
));
534 request
->data
[0].count
= fcmd
->cmdlen
;
535 request
->data
[1].count
= fcmd
->rsplen
;
536 request
->type
= fcmd
->class;
537 switch (fcmd
->class) {
538 case FC_CLASS_OUTBOUND
:
539 request
->data
[0].base
= fcmd
->cmd
;
540 request
->data
[0].count
= fcmd
->cmdlen
;
541 request
->type
= SOCAL_CQTYPE_OUTBOUND
;
542 request
->shdr
.bytecnt
= fcmd
->cmdlen
;
543 request
->shdr
.segcnt
= 1;
545 case FC_CLASS_INBOUND
:
546 request
->data
[0].base
= fcmd
->rsp
;
547 request
->data
[0].count
= fcmd
->rsplen
;
548 request
->type
= SOCAL_CQTYPE_INBOUND
;
549 request
->shdr
.bytecnt
= 0;
550 request
->shdr
.segcnt
= 1;
552 case FC_CLASS_SIMPLE
:
553 request
->data
[0].base
= fcmd
->cmd
;
554 request
->data
[1].base
= fcmd
->rsp
;
555 request
->data
[0].count
= fcmd
->cmdlen
;
556 request
->data
[1].count
= fcmd
->rsplen
;
557 request
->type
= SOCAL_CQTYPE_SIMPLE
;
558 request
->shdr
.bytecnt
= fcmd
->cmdlen
;
559 request
->shdr
.segcnt
= 2;
561 case FC_CLASS_IO_READ
:
562 case FC_CLASS_IO_WRITE
:
563 request
->data
[0].base
= fcmd
->cmd
;
564 request
->data
[1].base
= fcmd
->rsp
;
565 request
->data
[0].count
= fcmd
->cmdlen
;
566 request
->data
[1].count
= fcmd
->rsplen
;
567 request
->type
= (fcmd
->class == FC_CLASS_IO_READ
) ? SOCAL_CQTYPE_IO_READ
: SOCAL_CQTYPE_IO_WRITE
;
569 request
->data
[2].base
= fcmd
->data
;
570 request
->data
[2].count
= fcmd
->datalen
;
571 request
->shdr
.bytecnt
= fcmd
->datalen
;
572 request
->shdr
.segcnt
= 3;
574 request
->shdr
.bytecnt
= 0;
575 request
->shdr
.segcnt
= 2;
584 request
->seqno
= sw_cq
->seqno
;
586 SOD(("queueing token %08x\n", request
->shdr
.token
))
588 /* And now tell the SOCAL about it */
590 if (++sw_cq
->in
> sw_cq
->last
) {
595 SOD(("Putting %08x into cmd\n", SOCAL_CMD_RSP_QALL
| (sw_cq
->in
<< 24) | (SOCAL_CMD_REQ_Q0
<< qno
)))
597 sbus_writel(SOCAL_CMD_RSP_QALL
| (sw_cq
->in
<< 24) | (SOCAL_CMD_REQ_Q0
<< qno
),
600 /* Read so that command is completed */
601 sbus_readl(s
->regs
+ CMD
);
606 static inline void socal_download_fw(struct socal
*s
)
608 #ifdef HAVE_SOCAL_UCODE
609 SOD(("Loading %ld bytes from %p to %p\n", sizeof(socal_ucode
), socal_ucode
, s
->xram
))
610 socal_copy_to_xram(s
->xram
, socal_ucode
, sizeof(socal_ucode
));
611 SOD(("Clearing the rest of memory\n"))
612 socal_bzero (s
->xram
+ sizeof(socal_ucode
), 65536 - sizeof(socal_ucode
));
617 /* Check for what the best SBUS burst we can use happens
618 * to be on this machine.
620 static inline void socal_init_bursts(struct socal
*s
, struct sbus_dev
*sdev
)
622 int bsizes
, bsizes_more
;
625 bsizes
= (prom_getintdefault(sdev
->prom_node
,"burst-sizes",0xff) & 0xff);
626 bsizes_more
= (prom_getintdefault(sdev
->bus
->prom_node
, "burst-sizes", 0xff) & 0xff);
627 bsizes
&= bsizes_more
;
628 #ifdef USE_64BIT_MODE
630 mmu_set_sbus64(sdev
, bsizes
>> 16);
633 if ((bsizes
& 0x7f) == 0x7f)
634 cfg
= SOCAL_CFG_BURST_64
;
635 else if ((bsizes
& 0x3f) == 0x3f)
636 cfg
= SOCAL_CFG_BURST_32
;
637 else if ((bsizes
& 0x1f) == 0x1f)
638 cfg
= SOCAL_CFG_BURST_16
;
640 cfg
= SOCAL_CFG_BURST_4
;
641 #ifdef USE_64BIT_MODE
643 /* What is BURST_128? -jj */
644 if ((bsizes
& 0x780000) == 0x780000)
645 cfg
|= (SOCAL_CFG_BURST_64
<< 8) | SOCAL_CFG_SBUS_ENHANCED
;
646 else if ((bsizes
& 0x380000) == 0x380000)
647 cfg
|= (SOCAL_CFG_BURST_32
<< 8) | SOCAL_CFG_SBUS_ENHANCED
;
648 else if ((bsizes
& 0x180000) == 0x180000)
649 cfg
|= (SOCAL_CFG_BURST_16
<< 8) | SOCAL_CFG_SBUS_ENHANCED
;
651 cfg
|= (SOCAL_CFG_BURST_8
<< 8) | SOCAL_CFG_SBUS_ENHANCED
;
657 static inline void socal_init(struct sbus_dev
*sdev
, int no
)
659 unsigned char tmp
[60];
662 static unsigned version_printed
= 0;
667 s
= kmalloc (sizeof (struct socal
), GFP_KERNEL
);
669 memset (s
, 0, sizeof(struct socal
));
672 SOD(("socals %08lx socal_intr %08lx socal_hw_enque %08lx\n",
673 (long)socals
, (long)socal_intr
, (long)socal_hw_enque
))
674 if (version_printed
++ == 0)
677 s
->port
[0].fc
.module
= &__this_module
;
678 s
->port
[1].fc
.module
= &__this_module
;
680 s
->port
[0].fc
.module
= NULL
;
681 s
->port
[1].fc
.module
= NULL
;
686 s
->port
[0].fc
.dev
= sdev
;
687 s
->port
[1].fc
.dev
= sdev
;
691 s
->port
[0].fc
.next
= &s
->port
[1].fc
;
693 /* World Wide Name of SOCAL */
694 propl
= prom_getproperty (sdev
->prom_node
, "wwn", tmp
, sizeof(tmp
));
695 if (propl
!= sizeof (fc_wwn
)) {
696 s
->wwn
.naaid
= NAAID_IEEE_REG
;
697 s
->wwn
.nportid
= 0x123;
699 s
->wwn
.lo
= 0x12345678;
701 memcpy (&s
->wwn
, tmp
, sizeof (fc_wwn
));
703 memcpy (&s
->port
[0].fc
.wwn_nport
, &s
->wwn
, sizeof (fc_wwn
));
704 s
->port
[0].fc
.wwn_nport
.lo
++;
705 memcpy (&s
->port
[1].fc
.wwn_nport
, &s
->wwn
, sizeof (fc_wwn
));
706 s
->port
[1].fc
.wwn_nport
.lo
+=2;
708 node
= prom_getchild (sdev
->prom_node
);
709 while (node
&& (node
= prom_searchsiblings (node
, "sf"))) {
712 port
= prom_getintdefault(node
, "port#", -1);
716 if (prom_getproplen(node
, "port-wwn") == sizeof (fc_wwn
))
717 prom_getproperty (node
, "port-wwn",
718 (char *)&s
->port
[port
].fc
.wwn_nport
,
725 node
= prom_getsibling(node
);
728 memcpy (&s
->port
[0].fc
.wwn_node
, &s
->wwn
, sizeof (fc_wwn
));
729 memcpy (&s
->port
[1].fc
.wwn_node
, &s
->wwn
, sizeof (fc_wwn
));
730 SOD(("Got wwns %08x%08x ports %08x%08x and %08x%08x\n",
731 *(u32
*)&s
->port
[0].fc
.wwn_node
, s
->port
[0].fc
.wwn_node
.lo
,
732 *(u32
*)&s
->port
[0].fc
.wwn_nport
, s
->port
[0].fc
.wwn_nport
.lo
,
733 *(u32
*)&s
->port
[1].fc
.wwn_nport
, s
->port
[1].fc
.wwn_nport
.lo
))
735 s
->port
[0].fc
.sid
= 1;
736 s
->port
[1].fc
.sid
= 17;
737 s
->port
[0].fc
.did
= 2;
738 s
->port
[1].fc
.did
= 18;
740 s
->port
[0].fc
.reset
= socal_reset
;
741 s
->port
[1].fc
.reset
= socal_reset
;
743 if (sdev
->num_registers
== 1) {
744 s
->eeprom
= sbus_ioremap(&sdev
->resource
[0], 0,
745 sdev
->reg_addrs
[0].reg_size
, "socal xram");
746 if (sdev
->reg_addrs
[0].reg_size
> 0x20000)
747 s
->xram
= s
->eeprom
+ 0x10000UL
;
750 s
->regs
= (s
->xram
+ 0x10000UL
);
752 /* E.g. starfire presents 3 registers for SOCAL */
753 s
->xram
= sbus_ioremap(&sdev
->resource
[1], 0,
754 sdev
->reg_addrs
[1].reg_size
, "socal xram");
755 s
->regs
= sbus_ioremap(&sdev
->resource
[2], 0,
756 sdev
->reg_addrs
[2].reg_size
, "socal regs");
759 socal_init_bursts(s
, sdev
);
761 SOD(("Disabling SOCAL\n"))
767 if (request_irq (irq
, socal_intr
, SA_SHIRQ
, "SOCAL", (void *)s
)) {
768 socal_printk ("Cannot order irq %d to go\n", irq
);
773 SOD(("SOCAL uses IRQ %s\n", __irq_itoa(irq
)))
775 s
->port
[0].fc
.irq
= irq
;
776 s
->port
[1].fc
.irq
= irq
;
778 sprintf (s
->port
[0].fc
.name
, "socal%d port A", no
);
779 sprintf (s
->port
[1].fc
.name
, "socal%d port B", no
);
780 s
->port
[0].flags
= SOCAL_FC_HDR
| SOCAL_PORT_A
;
781 s
->port
[1].flags
= SOCAL_FC_HDR
| SOCAL_PORT_B
;
782 s
->port
[1].mask
= (1 << 11);
784 s
->port
[0].fc
.hw_enque
= socal_hw_enque
;
785 s
->port
[1].fc
.hw_enque
= socal_hw_enque
;
787 socal_download_fw (s
);
789 SOD(("Downloaded firmware\n"))
791 /* Now setup xram circular queues */
792 memset (cq
, 0, sizeof(cq
));
794 size
= (SOCAL_CQ_REQ0_SIZE
+ SOCAL_CQ_REQ1_SIZE
+
795 SOCAL_CQ_RSP0_SIZE
+ SOCAL_CQ_RSP1_SIZE
+
796 SOCAL_CQ_RSP2_SIZE
) * sizeof(socal_req
);
797 s
->req_cpu
= sbus_alloc_consistent(sdev
, size
, &s
->req_dvma
);
798 s
->req
[0].pool
= s
->req_cpu
;
799 cq
[0].address
= s
->req_dvma
;
800 s
->req
[1].pool
= s
->req
[0].pool
+ SOCAL_CQ_REQ0_SIZE
;
801 s
->rsp
[0].pool
= s
->req
[1].pool
+ SOCAL_CQ_REQ1_SIZE
;
802 s
->rsp
[1].pool
= s
->rsp
[0].pool
+ SOCAL_CQ_RSP0_SIZE
;
803 s
->rsp
[2].pool
= s
->rsp
[1].pool
+ SOCAL_CQ_RSP1_SIZE
;
805 s
->req
[0].hw_cq
= (socal_hw_cq
*)(s
->xram
+ SOCAL_CQ_REQ_OFFSET
);
806 s
->req
[1].hw_cq
= (socal_hw_cq
*)(s
->xram
+ SOCAL_CQ_REQ_OFFSET
+ sizeof(socal_hw_cq
));
807 s
->rsp
[0].hw_cq
= (socal_hw_cq
*)(s
->xram
+ SOCAL_CQ_RSP_OFFSET
);
808 s
->rsp
[1].hw_cq
= (socal_hw_cq
*)(s
->xram
+ SOCAL_CQ_RSP_OFFSET
+ sizeof(socal_hw_cq
));
809 s
->rsp
[2].hw_cq
= (socal_hw_cq
*)(s
->xram
+ SOCAL_CQ_RSP_OFFSET
+ 2 * sizeof(socal_hw_cq
));
811 cq
[1].address
= cq
[0].address
+ (SOCAL_CQ_REQ0_SIZE
* sizeof(socal_req
));
812 cq
[4].address
= cq
[1].address
+ (SOCAL_CQ_REQ1_SIZE
* sizeof(socal_req
));
813 cq
[5].address
= cq
[4].address
+ (SOCAL_CQ_RSP0_SIZE
* sizeof(socal_req
));
814 cq
[6].address
= cq
[5].address
+ (SOCAL_CQ_RSP1_SIZE
* sizeof(socal_req
));
816 cq
[0].last
= SOCAL_CQ_REQ0_SIZE
- 1;
817 cq
[1].last
= SOCAL_CQ_REQ1_SIZE
- 1;
818 cq
[4].last
= SOCAL_CQ_RSP0_SIZE
- 1;
819 cq
[5].last
= SOCAL_CQ_RSP1_SIZE
- 1;
820 cq
[6].last
= SOCAL_CQ_RSP2_SIZE
- 1;
821 for (i
= 0; i
< 8; i
++)
824 s
->req
[0].last
= SOCAL_CQ_REQ0_SIZE
- 1;
825 s
->req
[1].last
= SOCAL_CQ_REQ1_SIZE
- 1;
826 s
->rsp
[0].last
= SOCAL_CQ_RSP0_SIZE
- 1;
827 s
->rsp
[1].last
= SOCAL_CQ_RSP1_SIZE
- 1;
828 s
->rsp
[2].last
= SOCAL_CQ_RSP2_SIZE
- 1;
836 socal_copy_to_xram(s
->xram
+ SOCAL_CQ_REQ_OFFSET
, cq
, sizeof(cq
));
838 SOD(("Setting up params\n"))
840 /* Make our sw copy of SOCAL service parameters */
841 socal_copy_from_xram(s
->serv_params
, s
->xram
+ 0x280, sizeof (s
->serv_params
));
843 s
->port
[0].fc
.common_svc
= (common_svc_parm
*)s
->serv_params
;
844 s
->port
[0].fc
.class_svcs
= (svc_parm
*)(s
->serv_params
+ 0x20);
845 s
->port
[1].fc
.common_svc
= (common_svc_parm
*)&s
->serv_params
;
846 s
->port
[1].fc
.class_svcs
= (svc_parm
*)(s
->serv_params
+ 0x20);
850 SOD(("Enabled SOCAL\n"))
854 int __init
socal_probe(void)
856 int init_module(void)
859 struct sbus_bus
*sbus
;
860 struct sbus_dev
*sdev
= 0;
864 for_each_sbus(sbus
) {
865 for_each_sbusdev(sdev
, sbus
) {
866 if(!strcmp(sdev
->prom_name
, "SUNW,socal")) {
867 socal_init(sdev
, cards
);
877 s
->port
[1].fc
.next
= &s
->next
->port
[0].fc
;
879 fcp_init (&socals
->port
[0].fc
);
886 void cleanup_module(void)
890 struct sbus_dev
*sdev
;
893 irq
= s
->port
[0].fc
.irq
;
897 fcp_release(&(s
->port
[0].fc
), 2);
899 sdev
= s
->port
[0].fc
.dev
;
900 if (sdev
->num_registers
== 1) {
901 sbus_iounmap(s
->eeprom
, sdev
->reg_addrs
[0].reg_size
);
903 sbus_iounmap(s
->xram
, sdev
->reg_addrs
[1].reg_size
);
904 sbus_iounmap(s
->regs
, sdev
->reg_addrs
[2].reg_size
);
906 sbus_free_consistent(sdev
,
907 (SOCAL_CQ_REQ0_SIZE
+ SOCAL_CQ_REQ1_SIZE
+
908 SOCAL_CQ_RSP0_SIZE
+ SOCAL_CQ_RSP1_SIZE
+
909 SOCAL_CQ_RSP2_SIZE
) * sizeof(socal_req
),
910 s
->req_cpu
, s
->req_dvma
);