| @@ -1,173 +0,0 @@ |
| 1 | #include <linux/slab.h> | | |
| 2 | #include <linux/module.h> | | |
| 3 | #include <linux/kernel.h> | | |
| 4 | #include <linux/pci.h> | | |
| 5 | | | |
| 6 | #include <pcmcia/ss.h> | | |
| 7 | #include <pcmcia/cistpl.h> | | |
| 8 | #include "cs_internal.h" | | |
| 9 | | | |
| 10 | | | |
| 11 | struct pcmcia_align_data { | | |
| 12 | unsigned long mask; | | |
| 13 | unsigned long offset; | | |
| 14 | }; | | |
| 15 | | | |
| 16 | static resource_size_t pcmcia_align(void *align_data, | | |
| 17 | const struct resource *res, | | |
| 18 | resource_size_t size, resource_size_t align) | | |
| 19 | { | | |
| 20 | struct pcmcia_align_data *data = align_data; | | |
| 21 | resource_size_t start; | | |
| 22 | | | |
| 23 | start = (res->start & ~data->mask) + data->offset; | | |
| 24 | if (start < res->start) | | |
| 25 | start += data->mask + 1; | | |
| 26 | return start; | | |
| 27 | } | | |
| 28 | | | |
| 29 | static struct resource *find_io_region(struct pcmcia_socket *s, | | |
| 30 | unsigned long base, int num, | | |
| 31 | unsigned long align) | | |
| 32 | { | | |
| 33 | struct resource *res = pcmcia_make_resource(0, num, IORESOURCE_IO, | | |
| 34 | dev_name(&s->dev)); | | |
| 35 | struct pcmcia_align_data data; | | |
| 36 | int ret; | | |
| 37 | | | |
| 38 | data.mask = align - 1; | | |
| 39 | data.offset = base & data.mask; | | |
| 40 | | | |
| 41 | ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1, | | |
| 42 | base, 0, pcmcia_align, &data); | | |
| 43 | if (ret != 0) { | | |
| 44 | kfree(res); | | |
| 45 | res = NULL; | | |
| 46 | } | | |
| 47 | return res; | | |
| 48 | } | | |
| 49 | | | |
| 50 | static int res_pci_find_io(struct pcmcia_socket *s, unsigned int attr, | | |
| 51 | unsigned int *base, unsigned int num, | | |
| 52 | unsigned int align, struct resource **parent) | | |
| 53 | { | | |
| 54 | int i, ret = 0; | | |
| 55 | | | |
| 56 | /* Check for an already-allocated window that must conflict with | | |
| 57 | * what was asked for. It is a hack because it does not catch all | | |
| 58 | * potential conflicts, just the most obvious ones. | | |
| 59 | */ | | |
| 60 | for (i = 0; i < MAX_IO_WIN; i++) { | | |
| 61 | if (!s->io[i].res) | | |
| 62 | continue; | | |
| 63 | | | |
| 64 | if (!*base) | | |
| 65 | continue; | | |
| 66 | | | |
| 67 | if ((s->io[i].res->start & (align-1)) == *base) | | |
| 68 | return -EBUSY; | | |
| 69 | } | | |
| 70 | | | |
| 71 | for (i = 0; i < MAX_IO_WIN; i++) { | | |
| 72 | struct resource *res = s->io[i].res; | | |
| 73 | unsigned int try; | | |
| 74 | | | |
| 75 | if (res && (res->flags & IORESOURCE_BITS) != | | |
| 76 | (attr & IORESOURCE_BITS)) | | |
| 77 | continue; | | |
| 78 | | | |
| 79 | if (!res) { | | |
| 80 | if (align == 0) | | |
| 81 | align = 0x10000; | | |
| 82 | | | |
| 83 | res = s->io[i].res = find_io_region(s, *base, num, | | |
| 84 | align); | | |
| 85 | if (!res) | | |
| 86 | return -EINVAL; | | |
| 87 | | | |
| 88 | *base = res->start; | | |
| 89 | s->io[i].res->flags = | | |
| 90 | ((res->flags & ~IORESOURCE_BITS) | | | |
| 91 | (attr & IORESOURCE_BITS)); | | |
| 92 | s->io[i].InUse = num; | | |
| 93 | *parent = res; | | |
| 94 | return 0; | | |
| 95 | } | | |
| 96 | | | |
| 97 | /* Try to extend top of window */ | | |
| 98 | try = res->end + 1; | | |
| 99 | if ((*base == 0) || (*base == try)) { | | |
| 100 | ret = adjust_resource(s->io[i].res, res->start, | | |
| 101 | resource_size(res) + num); | | |
| 102 | if (ret) | | |
| 103 | continue; | | |
| 104 | *base = try; | | |
| 105 | s->io[i].InUse += num; | | |
| 106 | *parent = res; | | |
| 107 | return 0; | | |
| 108 | } | | |
| 109 | | | |
| 110 | /* Try to extend bottom of window */ | | |
| 111 | try = res->start - num; | | |
| 112 | if ((*base == 0) || (*base == try)) { | | |
| 113 | ret = adjust_resource(s->io[i].res, | | |
| 114 | res->start - num, | | |
| 115 | resource_size(res) + num); | | |
| 116 | if (ret) | | |
| 117 | continue; | | |
| 118 | *base = try; | | |
| 119 | s->io[i].InUse += num; | | |
| 120 | *parent = res; | | |
| 121 | return 0; | | |
| 122 | } | | |
| 123 | } | | |
| 124 | return -EINVAL; | | |
| 125 | } | | |
| 126 | | | |
| 127 | static struct resource *res_pci_find_mem(u_long base, u_long num, | | |
| 128 | u_long align, int low, struct pcmcia_socket *s) | | |
| 129 | { | | |
| 130 | struct resource *res = pcmcia_make_resource(0, num, IORESOURCE_MEM, | | |
| 131 | dev_name(&s->dev)); | | |
| 132 | struct pcmcia_align_data data; | | |
| 133 | unsigned long min; | | |
| 134 | int ret; | | |
| 135 | | | |
| 136 | if (align < 0x20000) | | |
| 137 | align = 0x20000; | | |
| 138 | data.mask = align - 1; | | |
| 139 | data.offset = base & data.mask; | | |
| 140 | | | |
| 141 | min = 0; | | |
| 142 | if (!low) | | |
| 143 | min = 0x100000UL; | | |
| 144 | | | |
| 145 | ret = pci_bus_alloc_resource(s->cb_dev->bus, | | |
| 146 | res, num, 1, min, 0, | | |
| 147 | pcmcia_align, &data); | | |
| 148 | | | |
| 149 | if (ret != 0) { | | |
| 150 | kfree(res); | | |
| 151 | res = NULL; | | |
| 152 | } | | |
| 153 | return res; | | |
| 154 | } | | |
| 155 | | | |
| 156 | | | |
| 157 | static int res_pci_init(struct pcmcia_socket *s) | | |
| 158 | { | | |
| 159 | if (!s->cb_dev || !(s->features & SS_CAP_PAGE_REGS)) { | | |
| 160 | dev_err(&s->dev, "not supported by res_pci\n"); | | |
| 161 | return -EOPNOTSUPP; | | |
| 162 | } | | |
| 163 | return 0; | | |
| 164 | } | | |
| 165 | | | |
| 166 | struct pccard_resource_ops pccard_nonstatic_ops = { | | |
| 167 | .validate_mem = NULL, | | |
| 168 | .find_io = res_pci_find_io, | | |
| 169 | .find_mem = res_pci_find_mem, | | |
| 170 | .init = res_pci_init, | | |
| 171 | .exit = NULL, | | |
| 172 | }; | | |
| 173 | EXPORT_SYMBOL(pccard_nonstatic_ops); | | |