11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * rsrc_mgr.c -- Resource management routines and/or wrappers 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or modify 51da177e4SLinus Torvalds * it under the terms of the GNU General Public License version 2 as 61da177e4SLinus Torvalds * published by the Free Software Foundation. 71da177e4SLinus Torvalds * 81da177e4SLinus Torvalds * The initial developer of the original code is David A. Hinds 91da177e4SLinus Torvalds * <dahinds@users.sourceforge.net>. Portions created by David A. Hinds 101da177e4SLinus Torvalds * are Copyright (C) 1999 David A. Hinds. All Rights Reserved. 111da177e4SLinus Torvalds * 121da177e4SLinus Torvalds * (C) 1999 David A. Hinds 131da177e4SLinus Torvalds */ 141da177e4SLinus Torvalds 151da177e4SLinus Torvalds #include <linux/module.h> 161da177e4SLinus Torvalds #include <linux/kernel.h> 171da177e4SLinus Torvalds 181da177e4SLinus Torvalds #include <pcmcia/cs_types.h> 191da177e4SLinus Torvalds #include <pcmcia/ss.h> 201da177e4SLinus Torvalds #include <pcmcia/cs.h> 211da177e4SLinus Torvalds #include "cs_internal.h" 221da177e4SLinus Torvalds 231da177e4SLinus Torvalds 240e0fad8fSDominik Brodowski #ifdef CONFIG_PCMCIA_IOCTL 250e0fad8fSDominik Brodowski 261da177e4SLinus Torvalds #ifdef CONFIG_PCMCIA_PROBE 271da177e4SLinus Torvalds 281da177e4SLinus Torvalds static int adjust_irq(struct pcmcia_socket *s, adjust_t *adj) 291da177e4SLinus Torvalds { 301da177e4SLinus Torvalds int irq; 311da177e4SLinus Torvalds u32 mask; 321da177e4SLinus Torvalds 331da177e4SLinus Torvalds irq = adj->resource.irq.IRQ; 341da177e4SLinus Torvalds if ((irq < 0) || (irq > 15)) 351da177e4SLinus Torvalds return CS_BAD_IRQ; 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds if (adj->Action != REMOVE_MANAGED_RESOURCE) 381da177e4SLinus Torvalds return 0; 391da177e4SLinus Torvalds 401da177e4SLinus Torvalds mask = 1 << irq; 411da177e4SLinus Torvalds 421da177e4SLinus Torvalds if (!(s->irq_mask & mask)) 431da177e4SLinus Torvalds return 0; 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds s->irq_mask &= ~mask; 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds return 0; 481da177e4SLinus Torvalds } 491da177e4SLinus Torvalds 501da177e4SLinus Torvalds #else 511da177e4SLinus Torvalds 521da177e4SLinus Torvalds static inline int adjust_irq(struct pcmcia_socket *s, adjust_t *adj) { 531da177e4SLinus Torvalds return CS_SUCCESS; 541da177e4SLinus Torvalds } 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds #endif 571da177e4SLinus Torvalds 581da177e4SLinus Torvalds 591da177e4SLinus Torvalds int pcmcia_adjust_resource_info(adjust_t *adj) 601da177e4SLinus Torvalds { 611da177e4SLinus Torvalds struct pcmcia_socket *s; 621da177e4SLinus Torvalds int ret = CS_UNSUPPORTED_FUNCTION; 631da177e4SLinus Torvalds unsigned long flags; 641da177e4SLinus Torvalds 651da177e4SLinus Torvalds down_read(&pcmcia_socket_list_rwsem); 661da177e4SLinus Torvalds list_for_each_entry(s, &pcmcia_socket_list, socket_list) { 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds if (adj->Resource == RES_IRQ) 691da177e4SLinus Torvalds ret = adjust_irq(s, adj); 701da177e4SLinus Torvalds 711da177e4SLinus Torvalds else if (s->resource_ops->adjust_resource) { 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds /* you can't use the old interface if the new 741da177e4SLinus Torvalds * one was used before */ 751da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 763c29976aSDominik Brodowski if ((s->resource_setup_new) && 771da177e4SLinus Torvalds !(s->resource_setup_old)) { 781da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 791da177e4SLinus Torvalds continue; 801da177e4SLinus Torvalds } else if (!(s->resource_setup_old)) 811da177e4SLinus Torvalds s->resource_setup_old = 1; 821da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 831da177e4SLinus Torvalds 841da177e4SLinus Torvalds ret = s->resource_ops->adjust_resource(s, adj); 851da177e4SLinus Torvalds if (!ret) { 861da177e4SLinus Torvalds /* as there's no way we know this is the 871da177e4SLinus Torvalds * last call to adjust_resource_info, we 881da177e4SLinus Torvalds * always need to assume this is the latest 891da177e4SLinus Torvalds * one... */ 901da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 911da177e4SLinus Torvalds s->resource_setup_done = 1; 921da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 931da177e4SLinus Torvalds } 941da177e4SLinus Torvalds } 951da177e4SLinus Torvalds } 961da177e4SLinus Torvalds up_read(&pcmcia_socket_list_rwsem); 971da177e4SLinus Torvalds 981da177e4SLinus Torvalds return (ret); 991da177e4SLinus Torvalds } 1001da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_adjust_resource_info); 1011da177e4SLinus Torvalds 1020e0fad8fSDominik Brodowski #endif 1030e0fad8fSDominik Brodowski 104de75914eSDominik Brodowski int pcmcia_validate_mem(struct pcmcia_socket *s) 1051da177e4SLinus Torvalds { 1061da177e4SLinus Torvalds if (s->resource_ops->validate_mem) 107de75914eSDominik Brodowski return s->resource_ops->validate_mem(s); 108de75914eSDominik Brodowski /* if there is no callback, we can assume that everything is OK */ 109de75914eSDominik Brodowski return 0; 1101da177e4SLinus Torvalds } 1111da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_validate_mem); 1121da177e4SLinus Torvalds 113e6ea0b9eSDominik Brodowski int pcmcia_adjust_io_region(struct resource *res, unsigned long r_start, 1141da177e4SLinus Torvalds unsigned long r_end, struct pcmcia_socket *s) 1151da177e4SLinus Torvalds { 1161da177e4SLinus Torvalds if (s->resource_ops->adjust_io_region) 1171da177e4SLinus Torvalds return s->resource_ops->adjust_io_region(res, r_start, r_end, s); 1181da177e4SLinus Torvalds return -ENOMEM; 1191da177e4SLinus Torvalds } 1201a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_adjust_io_region); 1211da177e4SLinus Torvalds 122e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_io_region(unsigned long base, int num, 1231da177e4SLinus Torvalds unsigned long align, struct pcmcia_socket *s) 1241da177e4SLinus Torvalds { 1251da177e4SLinus Torvalds if (s->resource_ops->find_io) 1261da177e4SLinus Torvalds return s->resource_ops->find_io(base, num, align, s); 1271da177e4SLinus Torvalds return NULL; 1281da177e4SLinus Torvalds } 1291a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_io_region); 1301da177e4SLinus Torvalds 131e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_mem_region(u_long base, u_long num, u_long align, 1321da177e4SLinus Torvalds int low, struct pcmcia_socket *s) 1331da177e4SLinus Torvalds { 1341da177e4SLinus Torvalds if (s->resource_ops->find_mem) 1351da177e4SLinus Torvalds return s->resource_ops->find_mem(base, num, align, low, s); 1361da177e4SLinus Torvalds return NULL; 1371da177e4SLinus Torvalds } 1381a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_mem_region); 1391da177e4SLinus Torvalds 1401da177e4SLinus Torvalds void release_resource_db(struct pcmcia_socket *s) 1411da177e4SLinus Torvalds { 1421da177e4SLinus Torvalds if (s->resource_ops->exit) 1431da177e4SLinus Torvalds s->resource_ops->exit(s); 1441da177e4SLinus Torvalds } 1451da177e4SLinus Torvalds 1461da177e4SLinus Torvalds 1471da177e4SLinus Torvalds static int static_init(struct pcmcia_socket *s) 1481da177e4SLinus Torvalds { 1491da177e4SLinus Torvalds unsigned long flags; 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds /* the good thing about SS_CAP_STATIC_MAP sockets is 1521da177e4SLinus Torvalds * that they don't need a resource database */ 1531da177e4SLinus Torvalds 1541da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 1551da177e4SLinus Torvalds s->resource_setup_done = 1; 1561da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 1571da177e4SLinus Torvalds 1581da177e4SLinus Torvalds return 0; 1591da177e4SLinus Torvalds } 1601da177e4SLinus Torvalds 1611da177e4SLinus Torvalds 1621da177e4SLinus Torvalds struct pccard_resource_ops pccard_static_ops = { 1631da177e4SLinus Torvalds .validate_mem = NULL, 1641da177e4SLinus Torvalds .adjust_io_region = NULL, 1651da177e4SLinus Torvalds .find_io = NULL, 1661da177e4SLinus Torvalds .find_mem = NULL, 1671da177e4SLinus Torvalds .adjust_resource = NULL, 1681da177e4SLinus Torvalds .init = static_init, 1691da177e4SLinus Torvalds .exit = NULL, 1701da177e4SLinus Torvalds }; 1711da177e4SLinus Torvalds EXPORT_SYMBOL(pccard_static_ops); 1723b27e942SDominik Brodowski 1733b27e942SDominik Brodowski 1743b27e942SDominik Brodowski #ifdef CONFIG_PCCARD_IODYN 1753b27e942SDominik Brodowski 1763b27e942SDominik Brodowski static struct resource * 1773b27e942SDominik Brodowski make_resource(unsigned long b, unsigned long n, int flags, char *name) 1783b27e942SDominik Brodowski { 1793b27e942SDominik Brodowski struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL); 1803b27e942SDominik Brodowski 1813b27e942SDominik Brodowski if (res) { 1823b27e942SDominik Brodowski res->name = name; 1833b27e942SDominik Brodowski res->start = b; 1843b27e942SDominik Brodowski res->end = b + n - 1; 1853b27e942SDominik Brodowski res->flags = flags; 1863b27e942SDominik Brodowski } 1873b27e942SDominik Brodowski return res; 1883b27e942SDominik Brodowski } 1893b27e942SDominik Brodowski 1903b27e942SDominik Brodowski struct pcmcia_align_data { 1913b27e942SDominik Brodowski unsigned long mask; 1923b27e942SDominik Brodowski unsigned long offset; 1933b27e942SDominik Brodowski }; 1943b27e942SDominik Brodowski 1953b27e942SDominik Brodowski static void pcmcia_align(void *align_data, struct resource *res, 1963b27e942SDominik Brodowski unsigned long size, unsigned long align) 1973b27e942SDominik Brodowski { 1983b27e942SDominik Brodowski struct pcmcia_align_data *data = align_data; 1993b27e942SDominik Brodowski unsigned long start; 2003b27e942SDominik Brodowski 2013b27e942SDominik Brodowski start = (res->start & ~data->mask) + data->offset; 2023b27e942SDominik Brodowski if (start < res->start) 2033b27e942SDominik Brodowski start += data->mask + 1; 2043b27e942SDominik Brodowski res->start = start; 2053b27e942SDominik Brodowski 2063b27e942SDominik Brodowski #ifdef CONFIG_X86 2073b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 2083b27e942SDominik Brodowski if (start & 0x300) { 2093b27e942SDominik Brodowski start = (start + 0x3ff) & ~0x3ff; 2103b27e942SDominik Brodowski res->start = start; 2113b27e942SDominik Brodowski } 2123b27e942SDominik Brodowski } 2133b27e942SDominik Brodowski #endif 2143b27e942SDominik Brodowski 2153b27e942SDominik Brodowski #ifdef CONFIG_M68K 2163b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 2173b27e942SDominik Brodowski if ((res->start + size - 1) >= 1024) 2183b27e942SDominik Brodowski res->start = res->end; 2193b27e942SDominik Brodowski } 2203b27e942SDominik Brodowski #endif 2213b27e942SDominik Brodowski } 2223b27e942SDominik Brodowski 2233b27e942SDominik Brodowski 2243b27e942SDominik Brodowski static int iodyn_adjust_io_region(struct resource *res, unsigned long r_start, 2253b27e942SDominik Brodowski unsigned long r_end, struct pcmcia_socket *s) 2263b27e942SDominik Brodowski { 2273b27e942SDominik Brodowski return adjust_resource(res, r_start, r_end - r_start + 1); 2283b27e942SDominik Brodowski } 2293b27e942SDominik Brodowski 2303b27e942SDominik Brodowski 2313b27e942SDominik Brodowski static struct resource *iodyn_find_io_region(unsigned long base, int num, 2323b27e942SDominik Brodowski unsigned long align, struct pcmcia_socket *s) 2333b27e942SDominik Brodowski { 2343b27e942SDominik Brodowski struct resource *res = make_resource(0, num, IORESOURCE_IO, 235dfe461aeSManuel Lauss s->dev.bus_id); 2363b27e942SDominik Brodowski struct pcmcia_align_data data; 2373b27e942SDominik Brodowski unsigned long min = base; 2383b27e942SDominik Brodowski int ret; 2393b27e942SDominik Brodowski 2403b27e942SDominik Brodowski if (align == 0) 2413b27e942SDominik Brodowski align = 0x10000; 2423b27e942SDominik Brodowski 2433b27e942SDominik Brodowski data.mask = align - 1; 2443b27e942SDominik Brodowski data.offset = base & data.mask; 2453b27e942SDominik Brodowski 2463b27e942SDominik Brodowski #ifdef CONFIG_PCI 2473b27e942SDominik Brodowski if (s->cb_dev) { 2483b27e942SDominik Brodowski ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1, 2493b27e942SDominik Brodowski min, 0, pcmcia_align, &data); 2503b27e942SDominik Brodowski } else 2513b27e942SDominik Brodowski #endif 2523b27e942SDominik Brodowski ret = allocate_resource(&ioport_resource, res, num, min, ~0UL, 2533b27e942SDominik Brodowski 1, pcmcia_align, &data); 2543b27e942SDominik Brodowski 2553b27e942SDominik Brodowski if (ret != 0) { 2563b27e942SDominik Brodowski kfree(res); 2573b27e942SDominik Brodowski res = NULL; 2583b27e942SDominik Brodowski } 2593b27e942SDominik Brodowski return res; 2603b27e942SDominik Brodowski } 2613b27e942SDominik Brodowski 2623b27e942SDominik Brodowski struct pccard_resource_ops pccard_iodyn_ops = { 2633b27e942SDominik Brodowski .validate_mem = NULL, 2643b27e942SDominik Brodowski .adjust_io_region = iodyn_adjust_io_region, 2653b27e942SDominik Brodowski .find_io = iodyn_find_io_region, 2663b27e942SDominik Brodowski .find_mem = NULL, 2673b27e942SDominik Brodowski .adjust_resource = NULL, 2683b27e942SDominik Brodowski .init = static_init, 2693b27e942SDominik Brodowski .exit = NULL, 2703b27e942SDominik Brodowski }; 2713b27e942SDominik Brodowski EXPORT_SYMBOL(pccard_iodyn_ops); 2723b27e942SDominik Brodowski 2733b27e942SDominik Brodowski #endif /* CONFIG_PCCARD_IODYN */ 274