diff options
author | Jeff Garzik <jeff@garzik.org> | 2007-10-03 15:27:22 -0400 |
---|---|---|
committer | Jeff Garzik <jeff@garzik.org> | 2007-10-12 09:16:48 -0400 |
commit | 1e5d82e18b7204545737a5ef96bc34180a8df844 (patch) | |
tree | 3431e9546930c8814473f3e511d17dd62b297d50 /drivers/isdn/hisax | |
parent | 2fbde4c0923f53bca9975a46059b5c481a3551ba (diff) |
[ISDN] HiSax elsa: split huge setup function into four smaller functions
Prep for hotplug API conversion. Just code movement (+glue).
Signed-off-by: Jeff Garzik <jgarzik@redhat.com>
Diffstat (limited to 'drivers/isdn/hisax')
-rw-r--r-- | drivers/isdn/hisax/elsa.c | 494 |
1 files changed, 278 insertions, 216 deletions
diff --git a/drivers/isdn/hisax/elsa.c b/drivers/isdn/hisax/elsa.c index fab3e4ea0595..0c1351b23840 100644 --- a/drivers/isdn/hisax/elsa.c +++ b/drivers/isdn/hisax/elsa.c | |||
@@ -30,8 +30,6 @@ | |||
30 | #include <linux/serial.h> | 30 | #include <linux/serial.h> |
31 | #include <linux/serial_reg.h> | 31 | #include <linux/serial_reg.h> |
32 | 32 | ||
33 | extern const char *CardType[]; | ||
34 | |||
35 | static const char *Elsa_revision = "$Revision: 2.32.2.4 $"; | 33 | static const char *Elsa_revision = "$Revision: 2.32.2.4 $"; |
36 | static const char *Elsa_Types[] = | 34 | static const char *Elsa_Types[] = |
37 | {"None", "PC", "PCC-8", "PCC-16", "PCF", "PCF-Pro", | 35 | {"None", "PC", "PCC-8", "PCC-16", "PCF", "PCF-Pro", |
@@ -832,8 +830,75 @@ probe_elsa(struct IsdnCardState *cs) | |||
832 | return (CARD_portlist[i]); | 830 | return (CARD_portlist[i]); |
833 | } | 831 | } |
834 | 832 | ||
835 | static struct pci_dev *dev_qs1000 __devinitdata = NULL; | 833 | static int __devinit |
836 | static struct pci_dev *dev_qs3000 __devinitdata = NULL; | 834 | setup_elsa_isa(struct IsdnCard *card) |
835 | { | ||
836 | struct IsdnCardState *cs = card->cs; | ||
837 | u_char val; | ||
838 | |||
839 | cs->hw.elsa.base = card->para[0]; | ||
840 | printk(KERN_INFO "Elsa: Microlink IO probing\n"); | ||
841 | if (cs->hw.elsa.base) { | ||
842 | if (!(cs->subtyp = probe_elsa_adr(cs->hw.elsa.base, | ||
843 | cs->typ))) { | ||
844 | printk(KERN_WARNING | ||
845 | "Elsa: no Elsa Microlink at %#lx\n", | ||
846 | cs->hw.elsa.base); | ||
847 | return (0); | ||
848 | } | ||
849 | } else | ||
850 | cs->hw.elsa.base = probe_elsa(cs); | ||
851 | |||
852 | if (!cs->hw.elsa.base) { | ||
853 | printk(KERN_WARNING | ||
854 | "No Elsa Microlink found\n"); | ||
855 | return (0); | ||
856 | } | ||
857 | |||
858 | cs->hw.elsa.cfg = cs->hw.elsa.base + ELSA_CONFIG; | ||
859 | cs->hw.elsa.ctrl = cs->hw.elsa.base + ELSA_CONTROL; | ||
860 | cs->hw.elsa.ale = cs->hw.elsa.base + ELSA_ALE; | ||
861 | cs->hw.elsa.isac = cs->hw.elsa.base + ELSA_ISAC; | ||
862 | cs->hw.elsa.itac = cs->hw.elsa.base + ELSA_ITAC; | ||
863 | cs->hw.elsa.hscx = cs->hw.elsa.base + ELSA_HSCX; | ||
864 | cs->hw.elsa.trig = cs->hw.elsa.base + ELSA_TRIG_IRQ; | ||
865 | cs->hw.elsa.timer = cs->hw.elsa.base + ELSA_START_TIMER; | ||
866 | val = bytein(cs->hw.elsa.cfg); | ||
867 | if (cs->subtyp == ELSA_PC) { | ||
868 | const u_char CARD_IrqTab[8] = | ||
869 | {7, 3, 5, 9, 0, 0, 0, 0}; | ||
870 | cs->irq = CARD_IrqTab[(val & ELSA_IRQ_IDX_PC) >> 2]; | ||
871 | } else if (cs->subtyp == ELSA_PCC8) { | ||
872 | const u_char CARD_IrqTab[8] = | ||
873 | {7, 3, 5, 9, 0, 0, 0, 0}; | ||
874 | cs->irq = CARD_IrqTab[(val & ELSA_IRQ_IDX_PCC8) >> 4]; | ||
875 | } else { | ||
876 | const u_char CARD_IrqTab[8] = | ||
877 | {15, 10, 15, 3, 11, 5, 11, 9}; | ||
878 | cs->irq = CARD_IrqTab[(val & ELSA_IRQ_IDX) >> 3]; | ||
879 | } | ||
880 | val = bytein(cs->hw.elsa.ale) & ELSA_HW_RELEASE; | ||
881 | if (val < 3) | ||
882 | val |= 8; | ||
883 | val += 'A' - 3; | ||
884 | if (val == 'B' || val == 'C') | ||
885 | val ^= 1; | ||
886 | if ((cs->subtyp == ELSA_PCFPRO) && (val = 'G')) | ||
887 | val = 'C'; | ||
888 | printk(KERN_INFO | ||
889 | "Elsa: %s found at %#lx Rev.:%c IRQ %d\n", | ||
890 | Elsa_Types[cs->subtyp], | ||
891 | cs->hw.elsa.base, | ||
892 | val, cs->irq); | ||
893 | val = bytein(cs->hw.elsa.ale) & ELSA_S0_POWER_BAD; | ||
894 | if (val) { | ||
895 | printk(KERN_WARNING | ||
896 | "Elsa: Microlink S0 bus power bad\n"); | ||
897 | cs->hw.elsa.status |= ELSA_BAD_PWR; | ||
898 | } | ||
899 | |||
900 | return (1); | ||
901 | } | ||
837 | 902 | ||
838 | #ifdef __ISAPNP__ | 903 | #ifdef __ISAPNP__ |
839 | static struct isapnp_device_id elsa_ids[] __devinitdata = { | 904 | static struct isapnp_device_id elsa_ids[] __devinitdata = { |
@@ -848,233 +913,194 @@ static struct isapnp_device_id elsa_ids[] __devinitdata = { | |||
848 | 913 | ||
849 | static struct isapnp_device_id *ipid __devinitdata = &elsa_ids[0]; | 914 | static struct isapnp_device_id *ipid __devinitdata = &elsa_ids[0]; |
850 | static struct pnp_card *pnp_c __devinitdata = NULL; | 915 | static struct pnp_card *pnp_c __devinitdata = NULL; |
851 | #endif | 916 | #endif /* __ISAPNP__ */ |
852 | 917 | ||
853 | int __devinit | 918 | static int __devinit |
854 | setup_elsa(struct IsdnCard *card) | 919 | setup_elsa_isapnp(struct IsdnCard *card) |
855 | { | 920 | { |
856 | int bytecnt; | ||
857 | u_char val; | ||
858 | struct IsdnCardState *cs = card->cs; | 921 | struct IsdnCardState *cs = card->cs; |
859 | char tmp[64]; | ||
860 | 922 | ||
861 | strcpy(tmp, Elsa_revision); | ||
862 | printk(KERN_INFO "HiSax: Elsa driver Rev. %s\n", HiSax_getrev(tmp)); | ||
863 | cs->hw.elsa.ctrl_reg = 0; | ||
864 | cs->hw.elsa.status = 0; | ||
865 | cs->hw.elsa.MFlag = 0; | ||
866 | cs->subtyp = 0; | ||
867 | if (cs->typ == ISDN_CTYPE_ELSA) { | ||
868 | cs->hw.elsa.base = card->para[0]; | ||
869 | printk(KERN_INFO "Elsa: Microlink IO probing\n"); | ||
870 | if (cs->hw.elsa.base) { | ||
871 | if (!(cs->subtyp = probe_elsa_adr(cs->hw.elsa.base, | ||
872 | cs->typ))) { | ||
873 | printk(KERN_WARNING | ||
874 | "Elsa: no Elsa Microlink at %#lx\n", | ||
875 | cs->hw.elsa.base); | ||
876 | return (0); | ||
877 | } | ||
878 | } else | ||
879 | cs->hw.elsa.base = probe_elsa(cs); | ||
880 | if (cs->hw.elsa.base) { | ||
881 | cs->hw.elsa.cfg = cs->hw.elsa.base + ELSA_CONFIG; | ||
882 | cs->hw.elsa.ctrl = cs->hw.elsa.base + ELSA_CONTROL; | ||
883 | cs->hw.elsa.ale = cs->hw.elsa.base + ELSA_ALE; | ||
884 | cs->hw.elsa.isac = cs->hw.elsa.base + ELSA_ISAC; | ||
885 | cs->hw.elsa.itac = cs->hw.elsa.base + ELSA_ITAC; | ||
886 | cs->hw.elsa.hscx = cs->hw.elsa.base + ELSA_HSCX; | ||
887 | cs->hw.elsa.trig = cs->hw.elsa.base + ELSA_TRIG_IRQ; | ||
888 | cs->hw.elsa.timer = cs->hw.elsa.base + ELSA_START_TIMER; | ||
889 | val = bytein(cs->hw.elsa.cfg); | ||
890 | if (cs->subtyp == ELSA_PC) { | ||
891 | const u_char CARD_IrqTab[8] = | ||
892 | {7, 3, 5, 9, 0, 0, 0, 0}; | ||
893 | cs->irq = CARD_IrqTab[(val & ELSA_IRQ_IDX_PC) >> 2]; | ||
894 | } else if (cs->subtyp == ELSA_PCC8) { | ||
895 | const u_char CARD_IrqTab[8] = | ||
896 | {7, 3, 5, 9, 0, 0, 0, 0}; | ||
897 | cs->irq = CARD_IrqTab[(val & ELSA_IRQ_IDX_PCC8) >> 4]; | ||
898 | } else { | ||
899 | const u_char CARD_IrqTab[8] = | ||
900 | {15, 10, 15, 3, 11, 5, 11, 9}; | ||
901 | cs->irq = CARD_IrqTab[(val & ELSA_IRQ_IDX) >> 3]; | ||
902 | } | ||
903 | val = bytein(cs->hw.elsa.ale) & ELSA_HW_RELEASE; | ||
904 | if (val < 3) | ||
905 | val |= 8; | ||
906 | val += 'A' - 3; | ||
907 | if (val == 'B' || val == 'C') | ||
908 | val ^= 1; | ||
909 | if ((cs->subtyp == ELSA_PCFPRO) && (val = 'G')) | ||
910 | val = 'C'; | ||
911 | printk(KERN_INFO | ||
912 | "Elsa: %s found at %#lx Rev.:%c IRQ %d\n", | ||
913 | Elsa_Types[cs->subtyp], | ||
914 | cs->hw.elsa.base, | ||
915 | val, cs->irq); | ||
916 | val = bytein(cs->hw.elsa.ale) & ELSA_S0_POWER_BAD; | ||
917 | if (val) { | ||
918 | printk(KERN_WARNING | ||
919 | "Elsa: Microlink S0 bus power bad\n"); | ||
920 | cs->hw.elsa.status |= ELSA_BAD_PWR; | ||
921 | } | ||
922 | } else { | ||
923 | printk(KERN_WARNING | ||
924 | "No Elsa Microlink found\n"); | ||
925 | return (0); | ||
926 | } | ||
927 | } else if (cs->typ == ISDN_CTYPE_ELSA_PNP) { | ||
928 | #ifdef __ISAPNP__ | 923 | #ifdef __ISAPNP__ |
929 | if (!card->para[1] && isapnp_present()) { | 924 | if (!card->para[1] && isapnp_present()) { |
930 | struct pnp_dev *pnp_d; | 925 | struct pnp_dev *pnp_d; |
931 | while(ipid->card_vendor) { | 926 | while(ipid->card_vendor) { |
932 | if ((pnp_c = pnp_find_card(ipid->card_vendor, | 927 | if ((pnp_c = pnp_find_card(ipid->card_vendor, |
933 | ipid->card_device, pnp_c))) { | 928 | ipid->card_device, pnp_c))) { |
934 | pnp_d = NULL; | 929 | pnp_d = NULL; |
935 | if ((pnp_d = pnp_find_dev(pnp_c, | 930 | if ((pnp_d = pnp_find_dev(pnp_c, |
936 | ipid->vendor, ipid->function, pnp_d))) { | 931 | ipid->vendor, ipid->function, pnp_d))) { |
937 | int err; | 932 | int err; |
938 | 933 | ||
939 | printk(KERN_INFO "HiSax: %s detected\n", | 934 | printk(KERN_INFO "HiSax: %s detected\n", |
940 | (char *)ipid->driver_data); | 935 | (char *)ipid->driver_data); |
936 | pnp_disable_dev(pnp_d); | ||
937 | err = pnp_activate_dev(pnp_d); | ||
938 | if (err<0) { | ||
939 | printk(KERN_WARNING "%s: pnp_activate_dev ret(%d)\n", | ||
940 | __FUNCTION__, err); | ||
941 | return(0); | ||
942 | } | ||
943 | card->para[1] = pnp_port_start(pnp_d, 0); | ||
944 | card->para[0] = pnp_irq(pnp_d, 0); | ||
945 | |||
946 | if (!card->para[0] || !card->para[1]) { | ||
947 | printk(KERN_ERR "Elsa PnP:some resources are missing %ld/%lx\n", | ||
948 | card->para[0], card->para[1]); | ||
941 | pnp_disable_dev(pnp_d); | 949 | pnp_disable_dev(pnp_d); |
942 | err = pnp_activate_dev(pnp_d); | ||
943 | if (err<0) { | ||
944 | printk(KERN_WARNING "%s: pnp_activate_dev ret(%d)\n", | ||
945 | __FUNCTION__, err); | ||
946 | return(0); | ||
947 | } | ||
948 | card->para[1] = pnp_port_start(pnp_d, 0); | ||
949 | card->para[0] = pnp_irq(pnp_d, 0); | ||
950 | |||
951 | if (!card->para[0] || !card->para[1]) { | ||
952 | printk(KERN_ERR "Elsa PnP:some resources are missing %ld/%lx\n", | ||
953 | card->para[0], card->para[1]); | ||
954 | pnp_disable_dev(pnp_d); | ||
955 | return(0); | ||
956 | } | ||
957 | if (ipid->function == ISAPNP_FUNCTION(0x133)) | ||
958 | cs->subtyp = ELSA_QS1000; | ||
959 | else | ||
960 | cs->subtyp = ELSA_QS3000; | ||
961 | break; | ||
962 | } else { | ||
963 | printk(KERN_ERR "Elsa PnP: PnP error card found, no device\n"); | ||
964 | return(0); | 950 | return(0); |
965 | } | 951 | } |
952 | if (ipid->function == ISAPNP_FUNCTION(0x133)) | ||
953 | cs->subtyp = ELSA_QS1000; | ||
954 | else | ||
955 | cs->subtyp = ELSA_QS3000; | ||
956 | break; | ||
957 | } else { | ||
958 | printk(KERN_ERR "Elsa PnP: PnP error card found, no device\n"); | ||
959 | return(0); | ||
966 | } | 960 | } |
967 | ipid++; | ||
968 | pnp_c=NULL; | ||
969 | } | ||
970 | if (!ipid->card_vendor) { | ||
971 | printk(KERN_INFO "Elsa PnP: no ISAPnP card found\n"); | ||
972 | return(0); | ||
973 | } | 961 | } |
962 | ipid++; | ||
963 | pnp_c=NULL; | ||
964 | } | ||
965 | if (!ipid->card_vendor) { | ||
966 | printk(KERN_INFO "Elsa PnP: no ISAPnP card found\n"); | ||
967 | return(0); | ||
974 | } | 968 | } |
975 | #endif | 969 | } |
976 | if (card->para[1] && card->para[0]) { | 970 | #endif /* __ISAPNP__ */ |
977 | cs->hw.elsa.base = card->para[1]; | 971 | |
978 | cs->irq = card->para[0]; | 972 | if (card->para[1] && card->para[0]) { |
979 | if (!cs->subtyp) | ||
980 | cs->subtyp = ELSA_QS1000; | ||
981 | } else { | ||
982 | printk(KERN_ERR "Elsa PnP: no parameter\n"); | ||
983 | } | ||
984 | cs->hw.elsa.cfg = cs->hw.elsa.base + ELSA_CONFIG; | ||
985 | cs->hw.elsa.ale = cs->hw.elsa.base + ELSA_ALE; | ||
986 | cs->hw.elsa.isac = cs->hw.elsa.base + ELSA_ISAC; | ||
987 | cs->hw.elsa.hscx = cs->hw.elsa.base + ELSA_HSCX; | ||
988 | cs->hw.elsa.trig = cs->hw.elsa.base + ELSA_TRIG_IRQ; | ||
989 | cs->hw.elsa.timer = cs->hw.elsa.base + ELSA_START_TIMER; | ||
990 | cs->hw.elsa.ctrl = cs->hw.elsa.base + ELSA_CONTROL; | ||
991 | printk(KERN_INFO | ||
992 | "Elsa: %s defined at %#lx IRQ %d\n", | ||
993 | Elsa_Types[cs->subtyp], | ||
994 | cs->hw.elsa.base, | ||
995 | cs->irq); | ||
996 | } else if (cs->typ == ISDN_CTYPE_ELSA_PCMCIA) { | ||
997 | cs->hw.elsa.base = card->para[1]; | 973 | cs->hw.elsa.base = card->para[1]; |
998 | cs->irq = card->para[0]; | 974 | cs->irq = card->para[0]; |
999 | val = readreg(cs->hw.elsa.base + 0, cs->hw.elsa.base + 2, IPAC_ID); | 975 | if (!cs->subtyp) |
1000 | if ((val == 1) || (val == 2)) { /* IPAC version 1.1/1.2 */ | 976 | cs->subtyp = ELSA_QS1000; |
1001 | cs->subtyp = ELSA_PCMCIA_IPAC; | 977 | } else { |
1002 | cs->hw.elsa.ale = cs->hw.elsa.base + 0; | 978 | printk(KERN_ERR "Elsa PnP: no parameter\n"); |
1003 | cs->hw.elsa.isac = cs->hw.elsa.base + 2; | 979 | } |
1004 | cs->hw.elsa.hscx = cs->hw.elsa.base + 2; | 980 | cs->hw.elsa.cfg = cs->hw.elsa.base + ELSA_CONFIG; |
1005 | test_and_set_bit(HW_IPAC, &cs->HW_Flags); | 981 | cs->hw.elsa.ale = cs->hw.elsa.base + ELSA_ALE; |
1006 | } else { | 982 | cs->hw.elsa.isac = cs->hw.elsa.base + ELSA_ISAC; |
1007 | cs->subtyp = ELSA_PCMCIA; | 983 | cs->hw.elsa.hscx = cs->hw.elsa.base + ELSA_HSCX; |
1008 | cs->hw.elsa.ale = cs->hw.elsa.base + ELSA_ALE_PCM; | 984 | cs->hw.elsa.trig = cs->hw.elsa.base + ELSA_TRIG_IRQ; |
1009 | cs->hw.elsa.isac = cs->hw.elsa.base + ELSA_ISAC_PCM; | 985 | cs->hw.elsa.timer = cs->hw.elsa.base + ELSA_START_TIMER; |
1010 | cs->hw.elsa.hscx = cs->hw.elsa.base + ELSA_HSCX; | 986 | cs->hw.elsa.ctrl = cs->hw.elsa.base + ELSA_CONTROL; |
1011 | } | 987 | printk(KERN_INFO |
1012 | cs->hw.elsa.timer = 0; | 988 | "Elsa: %s defined at %#lx IRQ %d\n", |
1013 | cs->hw.elsa.trig = 0; | 989 | Elsa_Types[cs->subtyp], |
1014 | cs->hw.elsa.ctrl = 0; | 990 | cs->hw.elsa.base, |
1015 | cs->irq_flags |= IRQF_SHARED; | 991 | cs->irq); |
1016 | printk(KERN_INFO | 992 | |
1017 | "Elsa: %s defined at %#lx IRQ %d\n", | 993 | return (1); |
1018 | Elsa_Types[cs->subtyp], | 994 | } |
1019 | cs->hw.elsa.base, | 995 | |
1020 | cs->irq); | 996 | static void __devinit |
1021 | } else if (cs->typ == ISDN_CTYPE_ELSA_PCI) { | 997 | setup_elsa_pcmcia(struct IsdnCard *card) |
998 | { | ||
999 | struct IsdnCardState *cs = card->cs; | ||
1000 | u_char val; | ||
1001 | |||
1002 | cs->hw.elsa.base = card->para[1]; | ||
1003 | cs->irq = card->para[0]; | ||
1004 | val = readreg(cs->hw.elsa.base + 0, cs->hw.elsa.base + 2, IPAC_ID); | ||
1005 | if ((val == 1) || (val == 2)) { /* IPAC version 1.1/1.2 */ | ||
1006 | cs->subtyp = ELSA_PCMCIA_IPAC; | ||
1007 | cs->hw.elsa.ale = cs->hw.elsa.base + 0; | ||
1008 | cs->hw.elsa.isac = cs->hw.elsa.base + 2; | ||
1009 | cs->hw.elsa.hscx = cs->hw.elsa.base + 2; | ||
1010 | test_and_set_bit(HW_IPAC, &cs->HW_Flags); | ||
1011 | } else { | ||
1012 | cs->subtyp = ELSA_PCMCIA; | ||
1013 | cs->hw.elsa.ale = cs->hw.elsa.base + ELSA_ALE_PCM; | ||
1014 | cs->hw.elsa.isac = cs->hw.elsa.base + ELSA_ISAC_PCM; | ||
1015 | cs->hw.elsa.hscx = cs->hw.elsa.base + ELSA_HSCX; | ||
1016 | } | ||
1017 | cs->hw.elsa.timer = 0; | ||
1018 | cs->hw.elsa.trig = 0; | ||
1019 | cs->hw.elsa.ctrl = 0; | ||
1020 | cs->irq_flags |= IRQF_SHARED; | ||
1021 | printk(KERN_INFO | ||
1022 | "Elsa: %s defined at %#lx IRQ %d\n", | ||
1023 | Elsa_Types[cs->subtyp], | ||
1024 | cs->hw.elsa.base, | ||
1025 | cs->irq); | ||
1026 | } | ||
1027 | |||
1022 | #ifdef CONFIG_PCI | 1028 | #ifdef CONFIG_PCI |
1023 | cs->subtyp = 0; | 1029 | static struct pci_dev *dev_qs1000 __devinitdata = NULL; |
1024 | if ((dev_qs1000 = pci_find_device(PCI_VENDOR_ID_ELSA, | 1030 | static struct pci_dev *dev_qs3000 __devinitdata = NULL; |
1025 | PCI_DEVICE_ID_ELSA_MICROLINK, dev_qs1000))) { | 1031 | |
1026 | if (pci_enable_device(dev_qs1000)) | 1032 | static int __devinit |
1027 | return(0); | 1033 | setup_elsa_pci(struct IsdnCard *card) |
1028 | cs->subtyp = ELSA_QS1000PCI; | 1034 | { |
1029 | cs->irq = dev_qs1000->irq; | 1035 | struct IsdnCardState *cs = card->cs; |
1030 | cs->hw.elsa.cfg = pci_resource_start(dev_qs1000, 1); | 1036 | |
1031 | cs->hw.elsa.base = pci_resource_start(dev_qs1000, 3); | 1037 | cs->subtyp = 0; |
1032 | } else if ((dev_qs3000 = pci_find_device(PCI_VENDOR_ID_ELSA, | 1038 | if ((dev_qs1000 = pci_find_device(PCI_VENDOR_ID_ELSA, |
1033 | PCI_DEVICE_ID_ELSA_QS3000, dev_qs3000))) { | 1039 | PCI_DEVICE_ID_ELSA_MICROLINK, dev_qs1000))) { |
1034 | if (pci_enable_device(dev_qs3000)) | 1040 | if (pci_enable_device(dev_qs1000)) |
1035 | return(0); | ||
1036 | cs->subtyp = ELSA_QS3000PCI; | ||
1037 | cs->irq = dev_qs3000->irq; | ||
1038 | cs->hw.elsa.cfg = pci_resource_start(dev_qs3000, 1); | ||
1039 | cs->hw.elsa.base = pci_resource_start(dev_qs3000, 3); | ||
1040 | } else { | ||
1041 | printk(KERN_WARNING "Elsa: No PCI card found\n"); | ||
1042 | return(0); | 1041 | return(0); |
1043 | } | 1042 | cs->subtyp = ELSA_QS1000PCI; |
1044 | if (!cs->irq) { | 1043 | cs->irq = dev_qs1000->irq; |
1045 | printk(KERN_WARNING "Elsa: No IRQ for PCI card found\n"); | 1044 | cs->hw.elsa.cfg = pci_resource_start(dev_qs1000, 1); |
1045 | cs->hw.elsa.base = pci_resource_start(dev_qs1000, 3); | ||
1046 | } else if ((dev_qs3000 = pci_find_device(PCI_VENDOR_ID_ELSA, | ||
1047 | PCI_DEVICE_ID_ELSA_QS3000, dev_qs3000))) { | ||
1048 | if (pci_enable_device(dev_qs3000)) | ||
1046 | return(0); | 1049 | return(0); |
1047 | } | 1050 | cs->subtyp = ELSA_QS3000PCI; |
1051 | cs->irq = dev_qs3000->irq; | ||
1052 | cs->hw.elsa.cfg = pci_resource_start(dev_qs3000, 1); | ||
1053 | cs->hw.elsa.base = pci_resource_start(dev_qs3000, 3); | ||
1054 | } else { | ||
1055 | printk(KERN_WARNING "Elsa: No PCI card found\n"); | ||
1056 | return(0); | ||
1057 | } | ||
1058 | if (!cs->irq) { | ||
1059 | printk(KERN_WARNING "Elsa: No IRQ for PCI card found\n"); | ||
1060 | return(0); | ||
1061 | } | ||
1062 | |||
1063 | if (!(cs->hw.elsa.base && cs->hw.elsa.cfg)) { | ||
1064 | printk(KERN_WARNING "Elsa: No IO-Adr for PCI card found\n"); | ||
1065 | return(0); | ||
1066 | } | ||
1067 | if ((cs->hw.elsa.cfg & 0xff) || (cs->hw.elsa.base & 0xf)) { | ||
1068 | printk(KERN_WARNING "Elsa: You may have a wrong PCI bios\n"); | ||
1069 | printk(KERN_WARNING "Elsa: If your system hangs now, read\n"); | ||
1070 | printk(KERN_WARNING "Elsa: Documentation/isdn/README.HiSax\n"); | ||
1071 | } | ||
1072 | cs->hw.elsa.ale = cs->hw.elsa.base; | ||
1073 | cs->hw.elsa.isac = cs->hw.elsa.base +1; | ||
1074 | cs->hw.elsa.hscx = cs->hw.elsa.base +1; | ||
1075 | test_and_set_bit(HW_IPAC, &cs->HW_Flags); | ||
1076 | cs->hw.elsa.timer = 0; | ||
1077 | cs->hw.elsa.trig = 0; | ||
1078 | cs->irq_flags |= IRQF_SHARED; | ||
1079 | printk(KERN_INFO | ||
1080 | "Elsa: %s defined at %#lx/0x%x IRQ %d\n", | ||
1081 | Elsa_Types[cs->subtyp], | ||
1082 | cs->hw.elsa.base, | ||
1083 | cs->hw.elsa.cfg, | ||
1084 | cs->irq); | ||
1085 | |||
1086 | return (1); | ||
1087 | } | ||
1048 | 1088 | ||
1049 | if (!(cs->hw.elsa.base && cs->hw.elsa.cfg)) { | ||
1050 | printk(KERN_WARNING "Elsa: No IO-Adr for PCI card found\n"); | ||
1051 | return(0); | ||
1052 | } | ||
1053 | if ((cs->hw.elsa.cfg & 0xff) || (cs->hw.elsa.base & 0xf)) { | ||
1054 | printk(KERN_WARNING "Elsa: You may have a wrong PCI bios\n"); | ||
1055 | printk(KERN_WARNING "Elsa: If your system hangs now, read\n"); | ||
1056 | printk(KERN_WARNING "Elsa: Documentation/isdn/README.HiSax\n"); | ||
1057 | } | ||
1058 | cs->hw.elsa.ale = cs->hw.elsa.base; | ||
1059 | cs->hw.elsa.isac = cs->hw.elsa.base +1; | ||
1060 | cs->hw.elsa.hscx = cs->hw.elsa.base +1; | ||
1061 | test_and_set_bit(HW_IPAC, &cs->HW_Flags); | ||
1062 | cs->hw.elsa.timer = 0; | ||
1063 | cs->hw.elsa.trig = 0; | ||
1064 | cs->irq_flags |= IRQF_SHARED; | ||
1065 | printk(KERN_INFO | ||
1066 | "Elsa: %s defined at %#lx/0x%x IRQ %d\n", | ||
1067 | Elsa_Types[cs->subtyp], | ||
1068 | cs->hw.elsa.base, | ||
1069 | cs->hw.elsa.cfg, | ||
1070 | cs->irq); | ||
1071 | #else | 1089 | #else |
1072 | printk(KERN_WARNING "Elsa: Elsa PCI and NO_PCI_BIOS\n"); | 1090 | |
1073 | printk(KERN_WARNING "Elsa: unable to config Elsa PCI\n"); | 1091 | static void __devinit |
1074 | return (0); | 1092 | setup_elsa_pci(struct IsdnCard *card) |
1093 | { | ||
1094 | return (1); | ||
1095 | } | ||
1075 | #endif /* CONFIG_PCI */ | 1096 | #endif /* CONFIG_PCI */ |
1076 | } else | 1097 | |
1077 | return (0); | 1098 | static int __devinit |
1099 | setup_elsa_common(struct IsdnCard *card) | ||
1100 | { | ||
1101 | struct IsdnCardState *cs = card->cs; | ||
1102 | u_char val; | ||
1103 | int bytecnt; | ||
1078 | 1104 | ||
1079 | switch (cs->subtyp) { | 1105 | switch (cs->subtyp) { |
1080 | case ELSA_PC: | 1106 | case ELSA_PC: |
@@ -1104,8 +1130,7 @@ setup_elsa(struct IsdnCard *card) | |||
1104 | here, it would fail. */ | 1130 | here, it would fail. */ |
1105 | if (cs->typ != ISDN_CTYPE_ELSA_PCMCIA && !request_region(cs->hw.elsa.base, bytecnt, "elsa isdn")) { | 1131 | if (cs->typ != ISDN_CTYPE_ELSA_PCMCIA && !request_region(cs->hw.elsa.base, bytecnt, "elsa isdn")) { |
1106 | printk(KERN_WARNING | 1132 | printk(KERN_WARNING |
1107 | "HiSax: %s config port %#lx-%#lx already in use\n", | 1133 | "HiSax: ELSA config port %#lx-%#lx already in use\n", |
1108 | CardType[card->typ], | ||
1109 | cs->hw.elsa.base, | 1134 | cs->hw.elsa.base, |
1110 | cs->hw.elsa.base + bytecnt); | 1135 | cs->hw.elsa.base + bytecnt); |
1111 | return (0); | 1136 | return (0); |
@@ -1113,8 +1138,7 @@ setup_elsa(struct IsdnCard *card) | |||
1113 | if ((cs->subtyp == ELSA_QS1000PCI) || (cs->subtyp == ELSA_QS3000PCI)) { | 1138 | if ((cs->subtyp == ELSA_QS1000PCI) || (cs->subtyp == ELSA_QS3000PCI)) { |
1114 | if (!request_region(cs->hw.elsa.cfg, 0x80, "elsa isdn pci")) { | 1139 | if (!request_region(cs->hw.elsa.cfg, 0x80, "elsa isdn pci")) { |
1115 | printk(KERN_WARNING | 1140 | printk(KERN_WARNING |
1116 | "HiSax: %s pci port %x-%x already in use\n", | 1141 | "HiSax: ELSA pci port %x-%x already in use\n", |
1117 | CardType[card->typ], | ||
1118 | cs->hw.elsa.cfg, | 1142 | cs->hw.elsa.cfg, |
1119 | cs->hw.elsa.cfg + 0x80); | 1143 | cs->hw.elsa.cfg + 0x80); |
1120 | release_region(cs->hw.elsa.base, bytecnt); | 1144 | release_region(cs->hw.elsa.base, bytecnt); |
@@ -1186,3 +1210,41 @@ setup_elsa(struct IsdnCard *card) | |||
1186 | } | 1210 | } |
1187 | return (1); | 1211 | return (1); |
1188 | } | 1212 | } |
1213 | |||
1214 | int __devinit | ||
1215 | setup_elsa(struct IsdnCard *card) | ||
1216 | { | ||
1217 | int rc; | ||
1218 | struct IsdnCardState *cs = card->cs; | ||
1219 | char tmp[64]; | ||
1220 | |||
1221 | strcpy(tmp, Elsa_revision); | ||
1222 | printk(KERN_INFO "HiSax: Elsa driver Rev. %s\n", HiSax_getrev(tmp)); | ||
1223 | cs->hw.elsa.ctrl_reg = 0; | ||
1224 | cs->hw.elsa.status = 0; | ||
1225 | cs->hw.elsa.MFlag = 0; | ||
1226 | cs->subtyp = 0; | ||
1227 | |||
1228 | if (cs->typ == ISDN_CTYPE_ELSA) { | ||
1229 | rc = setup_elsa_isa(card); | ||
1230 | if (!rc) | ||
1231 | return (0); | ||
1232 | |||
1233 | } else if (cs->typ == ISDN_CTYPE_ELSA_PNP) { | ||
1234 | rc = setup_elsa_isapnp(card); | ||
1235 | if (!rc) | ||
1236 | return (0); | ||
1237 | |||
1238 | } else if (cs->typ == ISDN_CTYPE_ELSA_PCMCIA) | ||
1239 | setup_elsa_pcmcia(card); | ||
1240 | |||
1241 | else if (cs->typ == ISDN_CTYPE_ELSA_PCI) { | ||
1242 | rc = setup_elsa_pci(card); | ||
1243 | if (!rc) | ||
1244 | return (0); | ||
1245 | |||
1246 | } else | ||
1247 | return (0); | ||
1248 | |||
1249 | return setup_elsa_common(card); | ||
1250 | } | ||