aboutsummaryrefslogtreecommitdiffstats
path: root/drivers
diff options
context:
space:
mode:
authorJiri Slaby <jirislaby@gmail.com>2007-05-08 03:36:09 -0400
committerLinus Torvalds <torvalds@woody.linux-foundation.org>2007-05-08 14:15:23 -0400
commitd407c78188c718c00e997ce7f8b8d45e92ee2dd6 (patch)
tree8a0a4103bbbc9fbc59f6002fb10697dd1d11d338 /drivers
parent7e92b4fc345f5b6f57585fbe5ffdb0f24d7c9b26 (diff)
Char: cyclades, create cy_init_Ze
Move Ze init code into new cy_init_Ze, because we will need it in another place and it will make the code totally unreadable. Signed-off-by: Jiri Slaby <jirislaby@gmail.com> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Diffstat (limited to 'drivers')
-rw-r--r--drivers/char/cyclades.c163
1 files changed, 90 insertions, 73 deletions
diff --git a/drivers/char/cyclades.c b/drivers/char/cyclades.c
index 962a36303d5e..1430e136d44d 100644
--- a/drivers/char/cyclades.c
+++ b/drivers/char/cyclades.c
@@ -4711,6 +4711,92 @@ static void plx_init(void __iomem * addr, __u32 initctl)
4711 cy_writel(addr + initctl, readl(addr + initctl) & ~0x20000000); 4711 cy_writel(addr + initctl, readl(addr + initctl) & ~0x20000000);
4712} 4712}
4713 4713
4714static int __devinit cy_init_Ze(unsigned long cy_pci_phys0,
4715 unsigned long cy_pci_phys2,
4716 struct RUNTIME_9060 __iomem *cy_pci_addr0,
4717 void __iomem *cy_pci_addr2, int cy_pci_irq,
4718 struct pci_dev *pdev)
4719{
4720 unsigned int j;
4721 unsigned short cy_pci_nchan;
4722
4723 readl(&cy_pci_addr0->mail_box_0);
4724#ifdef CY_PCI_DEBUG
4725 printk("Cyclades-Z/PCI: relocate winaddr=0x%lx ctladdr=0x%lx\n",
4726 (ulong)cy_pci_addr2, (ulong)cy_pci_addr0);
4727 printk("Cyclades-Z/PCI: New Cyclades-Z board. FPGA not "
4728 "loaded\n");
4729#endif
4730 /* This must be the new Cyclades-Ze/PCI. */
4731 cy_pci_nchan = ZE_V1_NPORTS;
4732
4733 if ((cy_next_channel + cy_pci_nchan) > NR_PORTS) {
4734 printk("Cyclades-Ze/PCI found at 0x%lx but no channels "
4735 "are available.\nChange NR_PORTS in cyclades.c "
4736 "and recompile kernel.\n",
4737 (ulong) cy_pci_phys2);
4738 return -EIO;
4739 }
4740
4741 /* fill the next cy_card structure available */
4742 for (j = 0; j < NR_CARDS; j++) {
4743 if (cy_card[j].base_addr == 0)
4744 break;
4745 }
4746 if (j == NR_CARDS) { /* no more cy_cards available */
4747 printk("Cyclades-Ze/PCI found at 0x%lx but no more "
4748 "cards can be used.\nChange NR_CARDS in "
4749 "cyclades.c and recompile kernel.\n",
4750 (ulong) cy_pci_phys2);
4751 return -EIO;
4752 }
4753#ifdef CONFIG_CYZ_INTR
4754 /* allocate IRQ only if board has an IRQ */
4755 if ((cy_pci_irq != 0) && (cy_pci_irq != 255)) {
4756 if (request_irq(cy_pci_irq, cyz_interrupt,
4757 IRQF_SHARED, "Cyclades-Z",
4758 &cy_card[j])) {
4759 printk("Cyclom-Ze/PCI found at 0x%lx ",
4760 (ulong) cy_pci_phys2);
4761 printk("but could not allocate IRQ%d.\n",
4762 cy_pci_irq);
4763 return -EIO;
4764 }
4765 }
4766#endif /* CONFIG_CYZ_INTR */
4767
4768 /* set cy_card */
4769 cy_card[j].base_phys = cy_pci_phys2;
4770 cy_card[j].ctl_phys = cy_pci_phys0;
4771 cy_card[j].base_addr = cy_pci_addr2;
4772 cy_card[j].ctl_addr = cy_pci_addr0;
4773 cy_card[j].irq = (int)cy_pci_irq;
4774 cy_card[j].bus_index = 1;
4775 cy_card[j].first_line = cy_next_channel;
4776 cy_card[j].num_chips = -1;
4777 cy_card[j].pdev = pdev;
4778
4779 /* print message */
4780#ifdef CONFIG_CYZ_INTR
4781 /* don't report IRQ if board is no IRQ */
4782 if ((cy_pci_irq != 0) && (cy_pci_irq != 255))
4783 printk("Cyclades-Ze/PCI #%d: 0x%lx-0x%lx, IRQ%d, ",
4784 j + 1, (ulong) cy_pci_phys2,
4785 (ulong) (cy_pci_phys2 + CyPCI_Ze_win - 1),
4786 (int)cy_pci_irq);
4787 else
4788#endif /* CONFIG_CYZ_INTR */
4789 printk("Cyclades-Ze/PCI #%d: 0x%lx-0x%lx, ",
4790 j + 1, (ulong) cy_pci_phys2,
4791 (ulong) (cy_pci_phys2 + CyPCI_Ze_win - 1));
4792
4793 printk("%d channels starting from port %d.\n",
4794 cy_pci_nchan, cy_next_channel);
4795 cy_next_channel += cy_pci_nchan;
4796
4797 return 0;
4798}
4799
4714/* 4800/*
4715 * --------------------------------------------------------------------- 4801 * ---------------------------------------------------------------------
4716 * cy_detect_pci() - Test PCI bus presence and Cyclom-Ye/PCI. 4802 * cy_detect_pci() - Test PCI bus presence and Cyclom-Ye/PCI.
@@ -4734,6 +4820,7 @@ static int __init cy_detect_pci(void)
4734 __u32 Ze_phys0[NR_CARDS], Ze_phys2[NR_CARDS]; 4820 __u32 Ze_phys0[NR_CARDS], Ze_phys2[NR_CARDS];
4735 unsigned char Ze_irq[NR_CARDS]; 4821 unsigned char Ze_irq[NR_CARDS];
4736 struct pci_dev *Ze_pdev[NR_CARDS]; 4822 struct pci_dev *Ze_pdev[NR_CARDS];
4823 int retval;
4737 4824
4738 for (i = 0; i < NR_CARDS; i++) { 4825 for (i = 0; i < NR_CARDS; i++) {
4739 /* look for a Cyclades card by vendor and device id */ 4826 /* look for a Cyclades card by vendor and device id */
@@ -5095,80 +5182,10 @@ static int __init cy_detect_pci(void)
5095 Ze_pdev[j] = Ze_pdev[j + 1]; 5182 Ze_pdev[j] = Ze_pdev[j + 1];
5096 } 5183 }
5097 ZeIndex--; 5184 ZeIndex--;
5098 mailbox = (__u32)readl(&((struct RUNTIME_9060 __iomem *) 5185 retval = cy_init_Ze(cy_pci_phys0, cy_pci_phys2, cy_pci_addr0,
5099 cy_pci_addr0)->mail_box_0); 5186 cy_pci_addr2, cy_pci_irq, pdev);
5100#ifdef CY_PCI_DEBUG 5187 if (retval < 0)
5101 printk("Cyclades-Z/PCI: relocate winaddr=0x%lx ctladdr=0x%lx\n",
5102 (ulong)cy_pci_addr2, (ulong)cy_pci_addr0);
5103 printk("Cyclades-Z/PCI: New Cyclades-Z board. FPGA not "
5104 "loaded\n");
5105#endif
5106 /* This must be the new Cyclades-Ze/PCI. */
5107 cy_pci_nchan = ZE_V1_NPORTS;
5108
5109 if ((cy_next_channel + cy_pci_nchan) > NR_PORTS) {
5110 printk("Cyclades-Ze/PCI found at 0x%lx but no channels "
5111 "are available.\nChange NR_PORTS in cyclades.c "
5112 "and recompile kernel.\n",
5113 (ulong) cy_pci_phys2);
5114 return i;
5115 }
5116
5117 /* fill the next cy_card structure available */
5118 for (j = 0; j < NR_CARDS; j++) {
5119 if (cy_card[j].base_addr == 0)
5120 break;
5121 }
5122 if (j == NR_CARDS) { /* no more cy_cards available */
5123 printk("Cyclades-Ze/PCI found at 0x%lx but no more "
5124 "cards can be used.\nChange NR_CARDS in "
5125 "cyclades.c and recompile kernel.\n",
5126 (ulong) cy_pci_phys2);
5127 return i; 5188 return i;
5128 }
5129#ifdef CONFIG_CYZ_INTR
5130 /* allocate IRQ only if board has an IRQ */
5131 if ((cy_pci_irq != 0) && (cy_pci_irq != 255)) {
5132 if (request_irq(cy_pci_irq, cyz_interrupt,
5133 IRQF_SHARED, "Cyclades-Z",
5134 &cy_card[j])) {
5135 printk("Cyclom-Ze/PCI found at 0x%lx ",
5136 (ulong) cy_pci_phys2);
5137 printk("but could not allocate IRQ%d.\n",
5138 cy_pci_irq);
5139 return i;
5140 }
5141 }
5142#endif /* CONFIG_CYZ_INTR */
5143
5144 /* set cy_card */
5145 cy_card[j].base_phys = cy_pci_phys2;
5146 cy_card[j].ctl_phys = cy_pci_phys0;
5147 cy_card[j].base_addr = cy_pci_addr2;
5148 cy_card[j].ctl_addr = cy_pci_addr0;
5149 cy_card[j].irq = (int)cy_pci_irq;
5150 cy_card[j].bus_index = 1;
5151 cy_card[j].first_line = cy_next_channel;
5152 cy_card[j].num_chips = -1;
5153 cy_card[j].pdev = pdev;
5154
5155 /* print message */
5156#ifdef CONFIG_CYZ_INTR
5157 /* don't report IRQ if board is no IRQ */
5158 if ((cy_pci_irq != 0) && (cy_pci_irq != 255))
5159 printk("Cyclades-Ze/PCI #%d: 0x%lx-0x%lx, IRQ%d, ",
5160 j + 1, (ulong) cy_pci_phys2,
5161 (ulong) (cy_pci_phys2 + CyPCI_Ze_win - 1),
5162 (int)cy_pci_irq);
5163 else
5164#endif /* CONFIG_CYZ_INTR */
5165 printk("Cyclades-Ze/PCI #%d: 0x%lx-0x%lx, ",
5166 j + 1, (ulong) cy_pci_phys2,
5167 (ulong) (cy_pci_phys2 + CyPCI_Ze_win - 1));
5168
5169 printk("%d channels starting from port %d.\n",
5170 cy_pci_nchan, cy_next_channel);
5171 cy_next_channel += cy_pci_nchan;
5172 } 5189 }
5173 if (ZeIndex != 0) { 5190 if (ZeIndex != 0) {
5174 printk("Cyclades-Ze/PCI found at 0x%x but no more cards can be " 5191 printk("Cyclades-Ze/PCI found at 0x%x but no more cards can be "