Lines Matching +full:if +full:- +full:idx
1 // SPDX-License-Identifier: GPL-2.0-only
9 * Bosch CC770 and Intel AN82527 CAN controllers on the ISA or PC-104 bus.
32 * Note: for clk, cir, bcr and cor, the first argument re-defines the
61 MODULE_DESCRIPTION("Socket-CAN driver for CC770 on the ISA bus");
72 static u8 cir[MAXDEV] = {[0 ... (MAXDEV - 1)] = 0xff};
73 static u8 cor[MAXDEV] = {[0 ... (MAXDEV - 1)] = 0xff};
74 static u8 bcr[MAXDEV] = {[0 ... (MAXDEV - 1)] = 0xff};
75 static int indirect[MAXDEV] = {[0 ... (MAXDEV - 1)] = -1};
114 return readb(priv->reg_base + reg); in cc770_isa_mem_read_reg()
120 writeb(val, priv->reg_base + reg); in cc770_isa_mem_write_reg()
125 return inb((unsigned long)priv->reg_base + reg); in cc770_isa_port_read_reg()
131 outb(val, (unsigned long)priv->reg_base + reg); in cc770_isa_port_write_reg()
137 unsigned long base = (unsigned long)priv->reg_base; in cc770_isa_port_read_reg_indirect()
152 unsigned long base = (unsigned long)priv->reg_base; in cc770_isa_port_write_reg_indirect()
167 int idx = pdev->id; in cc770_isa_probe() local
171 dev_dbg(&pdev->dev, "probing idx=%d: port=%#lx, mem=%#lx, irq=%d\n", in cc770_isa_probe()
172 idx, port[idx], mem[idx], irq[idx]); in cc770_isa_probe()
173 if (mem[idx]) { in cc770_isa_probe()
174 if (!request_mem_region(mem[idx], iosize, KBUILD_MODNAME)) { in cc770_isa_probe()
175 err = -EBUSY; in cc770_isa_probe()
178 base = ioremap(mem[idx], iosize); in cc770_isa_probe()
179 if (!base) { in cc770_isa_probe()
180 err = -ENOMEM; in cc770_isa_probe()
184 if (indirect[idx] > 0 || in cc770_isa_probe()
185 (indirect[idx] == -1 && indirect[0] > 0)) in cc770_isa_probe()
187 if (!request_region(port[idx], iosize, KBUILD_MODNAME)) { in cc770_isa_probe()
188 err = -EBUSY; in cc770_isa_probe()
194 if (!dev) { in cc770_isa_probe()
195 err = -ENOMEM; in cc770_isa_probe()
200 dev->irq = irq[idx]; in cc770_isa_probe()
201 priv->irq_flags = IRQF_SHARED; in cc770_isa_probe()
202 if (mem[idx]) { in cc770_isa_probe()
203 priv->reg_base = base; in cc770_isa_probe()
204 dev->base_addr = mem[idx]; in cc770_isa_probe()
205 priv->read_reg = cc770_isa_mem_read_reg; in cc770_isa_probe()
206 priv->write_reg = cc770_isa_mem_write_reg; in cc770_isa_probe()
208 priv->reg_base = (void __iomem *)port[idx]; in cc770_isa_probe()
209 dev->base_addr = port[idx]; in cc770_isa_probe()
211 if (iosize == CC770_IOSIZE_INDIRECT) { in cc770_isa_probe()
212 priv->read_reg = cc770_isa_port_read_reg_indirect; in cc770_isa_probe()
213 priv->write_reg = cc770_isa_port_write_reg_indirect; in cc770_isa_probe()
215 priv->read_reg = cc770_isa_port_read_reg; in cc770_isa_probe()
216 priv->write_reg = cc770_isa_port_write_reg; in cc770_isa_probe()
220 if (clk[idx]) in cc770_isa_probe()
221 clktmp = clk[idx]; in cc770_isa_probe()
222 else if (clk[0]) in cc770_isa_probe()
226 priv->can.clock.freq = clktmp; in cc770_isa_probe()
228 if (cir[idx] != 0xff) { in cc770_isa_probe()
229 priv->cpu_interface = cir[idx]; in cc770_isa_probe()
230 } else if (cir[0] != 0xff) { in cc770_isa_probe()
231 priv->cpu_interface = cir[0]; in cc770_isa_probe()
234 if (clktmp > 10000000) { in cc770_isa_probe()
235 priv->cpu_interface |= CPUIF_DSC; in cc770_isa_probe()
239 if (clktmp > 8000000) in cc770_isa_probe()
240 priv->cpu_interface |= CPUIF_DMC; in cc770_isa_probe()
243 if (priv->cpu_interface & CPUIF_DSC) in cc770_isa_probe()
244 priv->can.clock.freq /= 2; in cc770_isa_probe()
246 if (bcr[idx] != 0xff) in cc770_isa_probe()
247 priv->bus_config = bcr[idx]; in cc770_isa_probe()
248 else if (bcr[0] != 0xff) in cc770_isa_probe()
249 priv->bus_config = bcr[0]; in cc770_isa_probe()
251 priv->bus_config = BCR_DEFAULT; in cc770_isa_probe()
253 if (cor[idx] != 0xff) in cc770_isa_probe()
254 priv->clkout = cor[idx]; in cc770_isa_probe()
255 else if (cor[0] != 0xff) in cc770_isa_probe()
256 priv->clkout = cor[0]; in cc770_isa_probe()
258 priv->clkout = COR_DEFAULT; in cc770_isa_probe()
261 SET_NETDEV_DEV(dev, &pdev->dev); in cc770_isa_probe()
264 if (err) { in cc770_isa_probe()
265 dev_err(&pdev->dev, in cc770_isa_probe()
270 dev_info(&pdev->dev, "device registered (reg_base=0x%p, irq=%d)\n", in cc770_isa_probe()
271 priv->reg_base, dev->irq); in cc770_isa_probe()
277 if (mem[idx]) in cc770_isa_probe()
280 if (mem[idx]) in cc770_isa_probe()
281 release_mem_region(mem[idx], iosize); in cc770_isa_probe()
283 release_region(port[idx], iosize); in cc770_isa_probe()
292 int idx = pdev->id; in cc770_isa_remove() local
296 if (mem[idx]) { in cc770_isa_remove()
297 iounmap(priv->reg_base); in cc770_isa_remove()
298 release_mem_region(mem[idx], CC770_IOSIZE); in cc770_isa_remove()
300 if (priv->read_reg == cc770_isa_port_read_reg_indirect) in cc770_isa_remove()
301 release_region(port[idx], CC770_IOSIZE_INDIRECT); in cc770_isa_remove()
303 release_region(port[idx], CC770_IOSIZE); in cc770_isa_remove()
318 int idx, err; in cc770_isa_init() local
320 for (idx = 0; idx < ARRAY_SIZE(cc770_isa_devs); idx++) { in cc770_isa_init()
321 if ((port[idx] || mem[idx]) && irq[idx]) { in cc770_isa_init()
322 cc770_isa_devs[idx] = in cc770_isa_init()
323 platform_device_alloc(KBUILD_MODNAME, idx); in cc770_isa_init()
324 if (!cc770_isa_devs[idx]) { in cc770_isa_init()
325 err = -ENOMEM; in cc770_isa_init()
328 err = platform_device_add(cc770_isa_devs[idx]); in cc770_isa_init()
329 if (err) { in cc770_isa_init()
330 platform_device_put(cc770_isa_devs[idx]); in cc770_isa_init()
335 idx, port[idx], mem[idx], irq[idx]); in cc770_isa_init()
336 } else if (idx == 0 || port[idx] || mem[idx]) { in cc770_isa_init()
338 err = -EINVAL; in cc770_isa_init()
344 if (err) in cc770_isa_init()
352 while (--idx >= 0) { in cc770_isa_init()
353 if (cc770_isa_devs[idx]) in cc770_isa_init()
354 platform_device_unregister(cc770_isa_devs[idx]); in cc770_isa_init()
363 int idx; in cc770_isa_exit() local
366 for (idx = 0; idx < ARRAY_SIZE(cc770_isa_devs); idx++) { in cc770_isa_exit()
367 if (cc770_isa_devs[idx]) in cc770_isa_exit()
368 platform_device_unregister(cc770_isa_devs[idx]); in cc770_isa_exit()