2 * linux/arch/alpha/kernel/sys_marvel.c
7 #include <linux/kernel.h>
8 #include <linux/types.h>
10 #include <linux/sched.h>
11 #include <linux/pci.h>
12 #include <linux/init.h>
13 #include <linux/bitops.h>
15 #include <asm/ptrace.h>
16 #include <asm/system.h>
19 #include <asm/mmu_context.h>
21 #include <asm/pgtable.h>
22 #include <asm/core_marvel.h>
23 #include <asm/hwrpb.h>
24 #include <asm/tlbflush.h>
32 #include "machvec_impl.h"
34 #if NR_IRQS < MARVEL_NR_IRQS
35 # error NR_IRQS < MARVEL_NR_IRQS !!!
43 io7_device_interrupt(unsigned long vector
)
49 * Vector is 0x800 + (interrupt)
51 * where (interrupt) is:
53 * ...16|15 14|13 4|3 0
54 * -----+-----+--------+---
59 * 0x0800 - 0x0ff0 - 0x0800 + (LSI id << 4)
60 * 0x1000 - 0x2ff0 - 0x1000 + (MSI_DAT<8:0> << 4)
63 irq
= ((vector
& 0xffff) - 0x800) >> 4;
65 irq
+= 16; /* offset for legacy */
66 irq
&= MARVEL_IRQ_VEC_IRQ_MASK
; /* not too many bits */
67 irq
|= pid
<< MARVEL_IRQ_VEC_PE_SHIFT
; /* merge the pid */
72 static volatile unsigned long *
73 io7_get_irq_ctl(unsigned int irq
, struct io7
**pio7
)
75 volatile unsigned long *ctl
;
79 pid
= irq
>> MARVEL_IRQ_VEC_PE_SHIFT
;
81 if (!(io7
= marvel_find_io7(pid
))) {
83 "%s for nonexistent io7 -- vec %x, pid %d\n",
88 irq
&= MARVEL_IRQ_VEC_IRQ_MASK
; /* isolate the vector */
89 irq
-= 16; /* subtract legacy bias */
93 "%s for invalid irq -- pid %d adjusted irq %x\n",
98 ctl
= &io7
->csrs
->PO7_LSI_CTL
[irq
& 0xff].csr
; /* assume LSI */
99 if (irq
>= 0x80) /* MSI */
100 ctl
= &io7
->csrs
->PO7_MSI_CTL
[((irq
- 0x80) >> 5) & 0x0f].csr
;
102 if (pio7
) *pio7
= io7
;
107 io7_enable_irq(unsigned int irq
)
109 volatile unsigned long *ctl
;
112 ctl
= io7_get_irq_ctl(irq
, &io7
);
114 printk(KERN_ERR
"%s: get_ctl failed for irq %x\n",
119 spin_lock(&io7
->irq_lock
);
123 spin_unlock(&io7
->irq_lock
);
127 io7_disable_irq(unsigned int irq
)
129 volatile unsigned long *ctl
;
132 ctl
= io7_get_irq_ctl(irq
, &io7
);
134 printk(KERN_ERR
"%s: get_ctl failed for irq %x\n",
139 spin_lock(&io7
->irq_lock
);
140 *ctl
&= ~(1UL << 24);
143 spin_unlock(&io7
->irq_lock
);
147 io7_startup_irq(unsigned int irq
)
150 return 0; /* never anything pending */
154 io7_end_irq(unsigned int irq
)
156 if (!(irq_desc
[irq
].status
& (IRQ_DISABLED
|IRQ_INPROGRESS
)))
161 marvel_irq_noop(unsigned int irq
)
167 marvel_irq_noop_return(unsigned int irq
)
172 static struct irq_chip marvel_legacy_irq_type
= {
173 .typename
= "LEGACY",
174 .startup
= marvel_irq_noop_return
,
175 .shutdown
= marvel_irq_noop
,
176 .enable
= marvel_irq_noop
,
177 .disable
= marvel_irq_noop
,
178 .ack
= marvel_irq_noop
,
179 .end
= marvel_irq_noop
,
182 static struct irq_chip io7_lsi_irq_type
= {
184 .startup
= io7_startup_irq
,
185 .shutdown
= io7_disable_irq
,
186 .enable
= io7_enable_irq
,
187 .disable
= io7_disable_irq
,
188 .ack
= io7_disable_irq
,
192 static struct irq_chip io7_msi_irq_type
= {
194 .startup
= io7_startup_irq
,
195 .shutdown
= io7_disable_irq
,
196 .enable
= io7_enable_irq
,
197 .disable
= io7_disable_irq
,
198 .ack
= marvel_irq_noop
,
203 io7_redirect_irq(struct io7
*io7
,
204 volatile unsigned long *csr
,
210 val
&= ~(0x1ffUL
<< 24); /* clear the target pid */
211 val
|= ((unsigned long)where
<< 24); /* set the new target pid */
219 io7_redirect_one_lsi(struct io7
*io7
, unsigned int which
, unsigned int where
)
224 * LSI_CTL has target PID @ 14
226 val
= io7
->csrs
->PO7_LSI_CTL
[which
].csr
;
227 val
&= ~(0x1ffUL
<< 14); /* clear the target pid */
228 val
|= ((unsigned long)where
<< 14); /* set the new target pid */
230 io7
->csrs
->PO7_LSI_CTL
[which
].csr
= val
;
232 io7
->csrs
->PO7_LSI_CTL
[which
].csr
;
236 io7_redirect_one_msi(struct io7
*io7
, unsigned int which
, unsigned int where
)
241 * MSI_CTL has target PID @ 14
243 val
= io7
->csrs
->PO7_MSI_CTL
[which
].csr
;
244 val
&= ~(0x1ffUL
<< 14); /* clear the target pid */
245 val
|= ((unsigned long)where
<< 14); /* set the new target pid */
247 io7
->csrs
->PO7_MSI_CTL
[which
].csr
= val
;
249 io7
->csrs
->PO7_MSI_CTL
[which
].csr
;
253 init_one_io7_lsi(struct io7
*io7
, unsigned int which
, unsigned int where
)
256 * LSI_CTL has target PID @ 14
258 io7
->csrs
->PO7_LSI_CTL
[which
].csr
= ((unsigned long)where
<< 14);
260 io7
->csrs
->PO7_LSI_CTL
[which
].csr
;
264 init_one_io7_msi(struct io7
*io7
, unsigned int which
, unsigned int where
)
267 * MSI_CTL has target PID @ 14
269 io7
->csrs
->PO7_MSI_CTL
[which
].csr
= ((unsigned long)where
<< 14);
271 io7
->csrs
->PO7_MSI_CTL
[which
].csr
;
275 init_io7_irqs(struct io7
*io7
,
276 struct irq_chip
*lsi_ops
,
277 struct irq_chip
*msi_ops
)
279 long base
= (io7
->pe
<< MARVEL_IRQ_VEC_PE_SHIFT
) + 16;
282 printk("Initializing interrupts for IO7 at PE %u - base %lx\n",
286 * Where should interrupts from this IO7 go?
288 * They really should be sent to the local CPU to avoid having to
289 * traverse the mesh, but if it's not an SMP kernel, they have to
290 * go to the boot CPU. Send them all to the boot CPU for now,
291 * as each secondary starts, it can redirect it's local device
294 printk(" Interrupts reported to CPU at PE %u\n", boot_cpuid
);
296 spin_lock(&io7
->irq_lock
);
298 /* set up the error irqs */
299 io7_redirect_irq(io7
, &io7
->csrs
->HLT_CTL
.csr
, boot_cpuid
);
300 io7_redirect_irq(io7
, &io7
->csrs
->HPI_CTL
.csr
, boot_cpuid
);
301 io7_redirect_irq(io7
, &io7
->csrs
->CRD_CTL
.csr
, boot_cpuid
);
302 io7_redirect_irq(io7
, &io7
->csrs
->STV_CTL
.csr
, boot_cpuid
);
303 io7_redirect_irq(io7
, &io7
->csrs
->HEI_CTL
.csr
, boot_cpuid
);
305 /* Set up the lsi irqs. */
306 for (i
= 0; i
< 128; ++i
) {
307 irq_desc
[base
+ i
].status
= IRQ_DISABLED
| IRQ_LEVEL
;
308 irq_desc
[base
+ i
].chip
= lsi_ops
;
311 /* Disable the implemented irqs in hardware. */
312 for (i
= 0; i
< 0x60; ++i
)
313 init_one_io7_lsi(io7
, i
, boot_cpuid
);
315 init_one_io7_lsi(io7
, 0x74, boot_cpuid
);
316 init_one_io7_lsi(io7
, 0x75, boot_cpuid
);
319 /* Set up the msi irqs. */
320 for (i
= 128; i
< (128 + 512); ++i
) {
321 irq_desc
[base
+ i
].status
= IRQ_DISABLED
| IRQ_LEVEL
;
322 irq_desc
[base
+ i
].chip
= msi_ops
;
325 for (i
= 0; i
< 16; ++i
)
326 init_one_io7_msi(io7
, i
, boot_cpuid
);
328 spin_unlock(&io7
->irq_lock
);
332 marvel_init_irq(void)
335 struct io7
*io7
= NULL
;
337 /* Reserve the legacy irqs. */
338 for (i
= 0; i
< 16; ++i
) {
339 irq_desc
[i
].status
= IRQ_DISABLED
;
340 irq_desc
[i
].chip
= &marvel_legacy_irq_type
;
343 /* Init the io7 irqs. */
344 for (io7
= NULL
; (io7
= marvel_next_io7(io7
)) != NULL
; )
345 init_io7_irqs(io7
, &io7_lsi_irq_type
, &io7_msi_irq_type
);
349 marvel_map_irq(struct pci_dev
*dev
, u8 slot
, u8 pin
)
351 struct pci_controller
*hose
= dev
->sysdata
;
352 struct io7_port
*io7_port
= hose
->sysdata
;
353 struct io7
*io7
= io7_port
->io7
;
354 int msi_loc
, msi_data_off
;
360 pci_read_config_byte(dev
, PCI_INTERRUPT_LINE
, &intline
);
363 msi_loc
= pci_find_capability(dev
, PCI_CAP_ID_MSI
);
366 pci_read_config_word(dev
, msi_loc
+ PCI_MSI_FLAGS
, &msg_ctl
);
368 if (msg_ctl
& PCI_MSI_FLAGS_ENABLE
) {
369 msi_data_off
= PCI_MSI_DATA_32
;
370 if (msg_ctl
& PCI_MSI_FLAGS_64BIT
)
371 msi_data_off
= PCI_MSI_DATA_64
;
372 pci_read_config_word(dev
, msi_loc
+ msi_data_off
, &msg_dat
);
374 irq
= msg_dat
& 0x1ff; /* we use msg_data<8:0> */
375 irq
+= 0x80; /* offset for lsi */
378 printk("PCI:%d:%d:%d (hose %d) is using MSI\n",
380 PCI_SLOT(dev
->devfn
),
381 PCI_FUNC(dev
->devfn
),
383 printk(" %d message(s) from 0x%04x\n",
384 1 << ((msg_ctl
& PCI_MSI_FLAGS_QSIZE
) >> 4),
386 printk(" reporting on %d IRQ(s) from %d (0x%x)\n",
387 1 << ((msg_ctl
& PCI_MSI_FLAGS_QSIZE
) >> 4),
388 (irq
+ 16) | (io7
->pe
<< MARVEL_IRQ_VEC_PE_SHIFT
),
389 (irq
+ 16) | (io7
->pe
<< MARVEL_IRQ_VEC_PE_SHIFT
));
393 pci_write_config_word(dev
, msi_loc
+ PCI_MSI_FLAGS
,
394 msg_ctl
& ~PCI_MSI_FLAGS_ENABLE
);
395 pci_read_config_byte(dev
, PCI_INTERRUPT_LINE
, &intline
);
398 printk(" forcing LSI interrupt on irq %d [0x%x]\n", irq
, irq
);
402 irq
+= 16; /* offset for legacy */
403 irq
|= io7
->pe
<< MARVEL_IRQ_VEC_PE_SHIFT
; /* merge the pid */
409 marvel_init_pci(void)
413 marvel_register_error_handlers();
417 locate_and_init_vga(NULL
);
419 /* Clear any io7 errors. */
420 for (io7
= NULL
; (io7
= marvel_next_io7(io7
)) != NULL
; )
421 io7_clear_errors(io7
);
425 marvel_init_rtc(void)
430 struct marvel_rtc_time
{
431 struct rtc_time
*time
;
437 smp_get_rtc_time(void *data
)
439 struct marvel_rtc_time
*mrt
= data
;
440 mrt
->retval
= __get_rtc_time(mrt
->time
);
444 smp_set_rtc_time(void *data
)
446 struct marvel_rtc_time
*mrt
= data
;
447 mrt
->retval
= __set_rtc_time(mrt
->time
);
452 marvel_get_rtc_time(struct rtc_time
*time
)
455 struct marvel_rtc_time mrt
;
457 if (smp_processor_id() != boot_cpuid
) {
459 smp_call_function_single(boot_cpuid
, smp_get_rtc_time
, &mrt
, 1);
463 return __get_rtc_time(time
);
467 marvel_set_rtc_time(struct rtc_time
*time
)
470 struct marvel_rtc_time mrt
;
472 if (smp_processor_id() != boot_cpuid
) {
474 smp_call_function_single(boot_cpuid
, smp_set_rtc_time
, &mrt
, 1);
478 return __set_rtc_time(time
);
482 marvel_smp_callin(void)
484 int cpuid
= hard_smp_processor_id();
485 struct io7
*io7
= marvel_find_io7(cpuid
);
492 * There is a local IO7 - redirect all of its interrupts here.
494 printk("Redirecting IO7 interrupts to local CPU at PE %u\n", cpuid
);
496 /* Redirect the error IRQS here. */
497 io7_redirect_irq(io7
, &io7
->csrs
->HLT_CTL
.csr
, cpuid
);
498 io7_redirect_irq(io7
, &io7
->csrs
->HPI_CTL
.csr
, cpuid
);
499 io7_redirect_irq(io7
, &io7
->csrs
->CRD_CTL
.csr
, cpuid
);
500 io7_redirect_irq(io7
, &io7
->csrs
->STV_CTL
.csr
, cpuid
);
501 io7_redirect_irq(io7
, &io7
->csrs
->HEI_CTL
.csr
, cpuid
);
503 /* Redirect the implemented LSIs here. */
504 for (i
= 0; i
< 0x60; ++i
)
505 io7_redirect_one_lsi(io7
, i
, cpuid
);
507 io7_redirect_one_lsi(io7
, 0x74, cpuid
);
508 io7_redirect_one_lsi(io7
, 0x75, cpuid
);
510 /* Redirect the MSIs here. */
511 for (i
= 0; i
< 16; ++i
)
512 io7_redirect_one_msi(io7
, i
, cpuid
);
518 struct alpha_machine_vector marvel_ev7_mv __initmv
= {
519 .vector_name
= "MARVEL/EV7",
522 .rtc_get_time
= marvel_get_rtc_time
,
523 .rtc_set_time
= marvel_set_rtc_time
,
525 .machine_check
= marvel_machine_check
,
526 .max_isa_dma_address
= ALPHA_MAX_ISA_DMA_ADDRESS
,
527 .min_io_address
= DEFAULT_IO_BASE
,
528 .min_mem_address
= DEFAULT_MEM_BASE
,
529 .pci_dac_offset
= IO7_DAC_OFFSET
,
531 .nr_irqs
= MARVEL_NR_IRQS
,
532 .device_interrupt
= io7_device_interrupt
,
534 .agp_info
= marvel_agp_info
,
536 .smp_callin
= marvel_smp_callin
,
537 .init_arch
= marvel_init_arch
,
538 .init_irq
= marvel_init_irq
,
539 .init_rtc
= marvel_init_rtc
,
540 .init_pci
= marvel_init_pci
,
541 .kill_arch
= marvel_kill_arch
,
542 .pci_map_irq
= marvel_map_irq
,
543 .pci_swizzle
= common_swizzle
,
545 .pa_to_nid
= marvel_pa_to_nid
,
546 .cpuid_to_nid
= marvel_cpuid_to_nid
,
547 .node_mem_start
= marvel_node_mem_start
,
548 .node_mem_size
= marvel_node_mem_size
,