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/config.h> 161da177e4SLinus Torvalds #include <linux/module.h> 171da177e4SLinus Torvalds #include <linux/kernel.h> 181da177e4SLinus Torvalds 191da177e4SLinus Torvalds #include <pcmcia/cs_types.h> 201da177e4SLinus Torvalds #include <pcmcia/ss.h> 211da177e4SLinus Torvalds #include <pcmcia/cs.h> 221da177e4SLinus Torvalds #include "cs_internal.h" 231da177e4SLinus Torvalds 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds #ifdef CONFIG_PCMCIA_PROBE 261da177e4SLinus Torvalds 271da177e4SLinus Torvalds static int adjust_irq(struct pcmcia_socket *s, adjust_t *adj) 281da177e4SLinus Torvalds { 291da177e4SLinus Torvalds int irq; 301da177e4SLinus Torvalds u32 mask; 311da177e4SLinus Torvalds 321da177e4SLinus Torvalds irq = adj->resource.irq.IRQ; 331da177e4SLinus Torvalds if ((irq < 0) || (irq > 15)) 341da177e4SLinus Torvalds return CS_BAD_IRQ; 351da177e4SLinus Torvalds 361da177e4SLinus Torvalds if (adj->Action != REMOVE_MANAGED_RESOURCE) 371da177e4SLinus Torvalds return 0; 381da177e4SLinus Torvalds 391da177e4SLinus Torvalds mask = 1 << irq; 401da177e4SLinus Torvalds 411da177e4SLinus Torvalds if (!(s->irq_mask & mask)) 421da177e4SLinus Torvalds return 0; 431da177e4SLinus Torvalds 441da177e4SLinus Torvalds s->irq_mask &= ~mask; 451da177e4SLinus Torvalds 461da177e4SLinus Torvalds return 0; 471da177e4SLinus Torvalds } 481da177e4SLinus Torvalds 491da177e4SLinus Torvalds #else 501da177e4SLinus Torvalds 511da177e4SLinus Torvalds static inline int adjust_irq(struct pcmcia_socket *s, adjust_t *adj) { 521da177e4SLinus Torvalds return CS_SUCCESS; 531da177e4SLinus Torvalds } 541da177e4SLinus Torvalds 551da177e4SLinus Torvalds #endif 561da177e4SLinus Torvalds 571da177e4SLinus Torvalds 581da177e4SLinus Torvalds int pcmcia_adjust_resource_info(adjust_t *adj) 591da177e4SLinus Torvalds { 601da177e4SLinus Torvalds struct pcmcia_socket *s; 611da177e4SLinus Torvalds int ret = CS_UNSUPPORTED_FUNCTION; 621da177e4SLinus Torvalds unsigned long flags; 631da177e4SLinus Torvalds 641da177e4SLinus Torvalds down_read(&pcmcia_socket_list_rwsem); 651da177e4SLinus Torvalds list_for_each_entry(s, &pcmcia_socket_list, socket_list) { 661da177e4SLinus Torvalds 671da177e4SLinus Torvalds if (adj->Resource == RES_IRQ) 681da177e4SLinus Torvalds ret = adjust_irq(s, adj); 691da177e4SLinus Torvalds 701da177e4SLinus Torvalds else if (s->resource_ops->adjust_resource) { 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds /* you can't use the old interface if the new 731da177e4SLinus Torvalds * one was used before */ 741da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 753c29976aSDominik Brodowski if ((s->resource_setup_new) && 761da177e4SLinus Torvalds !(s->resource_setup_old)) { 771da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 781da177e4SLinus Torvalds continue; 791da177e4SLinus Torvalds } else if (!(s->resource_setup_old)) 801da177e4SLinus Torvalds s->resource_setup_old = 1; 811da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 821da177e4SLinus Torvalds 831da177e4SLinus Torvalds ret = s->resource_ops->adjust_resource(s, adj); 841da177e4SLinus Torvalds if (!ret) { 851da177e4SLinus Torvalds /* as there's no way we know this is the 861da177e4SLinus Torvalds * last call to adjust_resource_info, we 871da177e4SLinus Torvalds * always need to assume this is the latest 881da177e4SLinus Torvalds * one... */ 891da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 901da177e4SLinus Torvalds s->resource_setup_done = 1; 911da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 921da177e4SLinus Torvalds } 931da177e4SLinus Torvalds } 941da177e4SLinus Torvalds } 951da177e4SLinus Torvalds up_read(&pcmcia_socket_list_rwsem); 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds return (ret); 981da177e4SLinus Torvalds } 991da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_adjust_resource_info); 1001da177e4SLinus Torvalds 101de75914eSDominik Brodowski int pcmcia_validate_mem(struct pcmcia_socket *s) 1021da177e4SLinus Torvalds { 1031da177e4SLinus Torvalds if (s->resource_ops->validate_mem) 104de75914eSDominik Brodowski return s->resource_ops->validate_mem(s); 105de75914eSDominik Brodowski /* if there is no callback, we can assume that everything is OK */ 106de75914eSDominik Brodowski return 0; 1071da177e4SLinus Torvalds } 1081da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_validate_mem); 1091da177e4SLinus Torvalds 110e6ea0b9eSDominik Brodowski int pcmcia_adjust_io_region(struct resource *res, unsigned long r_start, 1111da177e4SLinus Torvalds unsigned long r_end, struct pcmcia_socket *s) 1121da177e4SLinus Torvalds { 1131da177e4SLinus Torvalds if (s->resource_ops->adjust_io_region) 1141da177e4SLinus Torvalds return s->resource_ops->adjust_io_region(res, r_start, r_end, s); 1151da177e4SLinus Torvalds return -ENOMEM; 1161da177e4SLinus Torvalds } 1171a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_adjust_io_region); 1181da177e4SLinus Torvalds 119e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_io_region(unsigned long base, int num, 1201da177e4SLinus Torvalds unsigned long align, struct pcmcia_socket *s) 1211da177e4SLinus Torvalds { 1221da177e4SLinus Torvalds if (s->resource_ops->find_io) 1231da177e4SLinus Torvalds return s->resource_ops->find_io(base, num, align, s); 1241da177e4SLinus Torvalds return NULL; 1251da177e4SLinus Torvalds } 1261a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_io_region); 1271da177e4SLinus Torvalds 128e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_mem_region(u_long base, u_long num, u_long align, 1291da177e4SLinus Torvalds int low, struct pcmcia_socket *s) 1301da177e4SLinus Torvalds { 1311da177e4SLinus Torvalds if (s->resource_ops->find_mem) 1321da177e4SLinus Torvalds return s->resource_ops->find_mem(base, num, align, low, s); 1331da177e4SLinus Torvalds return NULL; 1341da177e4SLinus Torvalds } 1351a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_mem_region); 1361da177e4SLinus Torvalds 1371da177e4SLinus Torvalds void release_resource_db(struct pcmcia_socket *s) 1381da177e4SLinus Torvalds { 1391da177e4SLinus Torvalds if (s->resource_ops->exit) 1401da177e4SLinus Torvalds s->resource_ops->exit(s); 1411da177e4SLinus Torvalds } 1421da177e4SLinus Torvalds 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds static int static_init(struct pcmcia_socket *s) 1451da177e4SLinus Torvalds { 1461da177e4SLinus Torvalds unsigned long flags; 1471da177e4SLinus Torvalds 1481da177e4SLinus Torvalds /* the good thing about SS_CAP_STATIC_MAP sockets is 1491da177e4SLinus Torvalds * that they don't need a resource database */ 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 1521da177e4SLinus Torvalds s->resource_setup_done = 1; 1531da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 1541da177e4SLinus Torvalds 1551da177e4SLinus Torvalds return 0; 1561da177e4SLinus Torvalds } 1571da177e4SLinus Torvalds 1581da177e4SLinus Torvalds 1591da177e4SLinus Torvalds struct pccard_resource_ops pccard_static_ops = { 1601da177e4SLinus Torvalds .validate_mem = NULL, 1611da177e4SLinus Torvalds .adjust_io_region = NULL, 1621da177e4SLinus Torvalds .find_io = NULL, 1631da177e4SLinus Torvalds .find_mem = NULL, 1641da177e4SLinus Torvalds .adjust_resource = NULL, 1651da177e4SLinus Torvalds .init = static_init, 1661da177e4SLinus Torvalds .exit = NULL, 1671da177e4SLinus Torvalds }; 1681da177e4SLinus Torvalds EXPORT_SYMBOL(pccard_static_ops); 1693b27e942SDominik Brodowski 1703b27e942SDominik Brodowski 1713b27e942SDominik Brodowski #ifdef CONFIG_PCCARD_IODYN 1723b27e942SDominik Brodowski 1733b27e942SDominik Brodowski static struct resource * 1743b27e942SDominik Brodowski make_resource(unsigned long b, unsigned long n, int flags, char *name) 1753b27e942SDominik Brodowski { 1763b27e942SDominik Brodowski struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL); 1773b27e942SDominik Brodowski 1783b27e942SDominik Brodowski if (res) { 1793b27e942SDominik Brodowski res->name = name; 1803b27e942SDominik Brodowski res->start = b; 1813b27e942SDominik Brodowski res->end = b + n - 1; 1823b27e942SDominik Brodowski res->flags = flags; 1833b27e942SDominik Brodowski } 1843b27e942SDominik Brodowski return res; 1853b27e942SDominik Brodowski } 1863b27e942SDominik Brodowski 1873b27e942SDominik Brodowski struct pcmcia_align_data { 1883b27e942SDominik Brodowski unsigned long mask; 1893b27e942SDominik Brodowski unsigned long offset; 1903b27e942SDominik Brodowski }; 1913b27e942SDominik Brodowski 1923b27e942SDominik Brodowski static void pcmcia_align(void *align_data, struct resource *res, 1933b27e942SDominik Brodowski unsigned long size, unsigned long align) 1943b27e942SDominik Brodowski { 1953b27e942SDominik Brodowski struct pcmcia_align_data *data = align_data; 1963b27e942SDominik Brodowski unsigned long start; 1973b27e942SDominik Brodowski 1983b27e942SDominik Brodowski start = (res->start & ~data->mask) + data->offset; 1993b27e942SDominik Brodowski if (start < res->start) 2003b27e942SDominik Brodowski start += data->mask + 1; 2013b27e942SDominik Brodowski res->start = start; 2023b27e942SDominik Brodowski 2033b27e942SDominik Brodowski #ifdef CONFIG_X86 2043b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 2053b27e942SDominik Brodowski if (start & 0x300) { 2063b27e942SDominik Brodowski start = (start + 0x3ff) & ~0x3ff; 2073b27e942SDominik Brodowski res->start = start; 2083b27e942SDominik Brodowski } 2093b27e942SDominik Brodowski } 2103b27e942SDominik Brodowski #endif 2113b27e942SDominik Brodowski 2123b27e942SDominik Brodowski #ifdef CONFIG_M68K 2133b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 2143b27e942SDominik Brodowski if ((res->start + size - 1) >= 1024) 2153b27e942SDominik Brodowski res->start = res->end; 2163b27e942SDominik Brodowski } 2173b27e942SDominik Brodowski #endif 2183b27e942SDominik Brodowski } 2193b27e942SDominik Brodowski 2203b27e942SDominik Brodowski 2213b27e942SDominik Brodowski static int iodyn_adjust_io_region(struct resource *res, unsigned long r_start, 2223b27e942SDominik Brodowski unsigned long r_end, struct pcmcia_socket *s) 2233b27e942SDominik Brodowski { 2243b27e942SDominik Brodowski return adjust_resource(res, r_start, r_end - r_start + 1); 2253b27e942SDominik Brodowski } 2263b27e942SDominik Brodowski 2273b27e942SDominik Brodowski 2283b27e942SDominik Brodowski static struct resource *iodyn_find_io_region(unsigned long base, int num, 2293b27e942SDominik Brodowski unsigned long align, struct pcmcia_socket *s) 2303b27e942SDominik Brodowski { 2313b27e942SDominik Brodowski struct resource *res = make_resource(0, num, IORESOURCE_IO, 2323b27e942SDominik Brodowski s->dev.class_id); 2333b27e942SDominik Brodowski struct pcmcia_align_data data; 2343b27e942SDominik Brodowski unsigned long min = base; 2353b27e942SDominik Brodowski int ret; 2363b27e942SDominik Brodowski 2373b27e942SDominik Brodowski if (align == 0) 2383b27e942SDominik Brodowski align = 0x10000; 2393b27e942SDominik Brodowski 2403b27e942SDominik Brodowski data.mask = align - 1; 2413b27e942SDominik Brodowski data.offset = base & data.mask; 2423b27e942SDominik Brodowski 2433b27e942SDominik Brodowski #ifdef CONFIG_PCI 2443b27e942SDominik Brodowski if (s->cb_dev) { 2453b27e942SDominik Brodowski ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1, 2463b27e942SDominik Brodowski min, 0, pcmcia_align, &data); 2473b27e942SDominik Brodowski } else 2483b27e942SDominik Brodowski #endif 2493b27e942SDominik Brodowski ret = allocate_resource(&ioport_resource, res, num, min, ~0UL, 2503b27e942SDominik Brodowski 1, pcmcia_align, &data); 2513b27e942SDominik Brodowski 2523b27e942SDominik Brodowski if (ret != 0) { 2533b27e942SDominik Brodowski kfree(res); 2543b27e942SDominik Brodowski res = NULL; 2553b27e942SDominik Brodowski } 2563b27e942SDominik Brodowski return res; 2573b27e942SDominik Brodowski } 2583b27e942SDominik Brodowski 2593b27e942SDominik Brodowski struct pccard_resource_ops pccard_iodyn_ops = { 2603b27e942SDominik Brodowski .validate_mem = NULL, 2613b27e942SDominik Brodowski .adjust_io_region = iodyn_adjust_io_region, 2623b27e942SDominik Brodowski .find_io = iodyn_find_io_region, 2633b27e942SDominik Brodowski .find_mem = NULL, 2643b27e942SDominik Brodowski .adjust_resource = NULL, 2653b27e942SDominik Brodowski .init = static_init, 2663b27e942SDominik Brodowski .exit = NULL, 2673b27e942SDominik Brodowski }; 2683b27e942SDominik Brodowski EXPORT_SYMBOL(pccard_iodyn_ops); 2693b27e942SDominik Brodowski 2703b27e942SDominik Brodowski #endif /* CONFIG_PCCARD_IODYN */ 271