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> 2191284224SDominik Brodowski #include <pcmcia/cistpl.h> 221da177e4SLinus Torvalds #include "cs_internal.h" 231da177e4SLinus Torvalds 241da177e4SLinus Torvalds 25de75914eSDominik Brodowski int pcmcia_validate_mem(struct pcmcia_socket *s) 261da177e4SLinus Torvalds { 271da177e4SLinus Torvalds if (s->resource_ops->validate_mem) 28de75914eSDominik Brodowski return s->resource_ops->validate_mem(s); 29de75914eSDominik Brodowski /* if there is no callback, we can assume that everything is OK */ 30de75914eSDominik Brodowski return 0; 311da177e4SLinus Torvalds } 321da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_validate_mem); 331da177e4SLinus Torvalds 34e6ea0b9eSDominik Brodowski int pcmcia_adjust_io_region(struct resource *res, unsigned long r_start, 351da177e4SLinus Torvalds unsigned long r_end, struct pcmcia_socket *s) 361da177e4SLinus Torvalds { 371da177e4SLinus Torvalds if (s->resource_ops->adjust_io_region) 381da177e4SLinus Torvalds return s->resource_ops->adjust_io_region(res, r_start, r_end, s); 391da177e4SLinus Torvalds return -ENOMEM; 401da177e4SLinus Torvalds } 411a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_adjust_io_region); 421da177e4SLinus Torvalds 43e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_io_region(unsigned long base, int num, 441da177e4SLinus Torvalds unsigned long align, struct pcmcia_socket *s) 451da177e4SLinus Torvalds { 461da177e4SLinus Torvalds if (s->resource_ops->find_io) 471da177e4SLinus Torvalds return s->resource_ops->find_io(base, num, align, s); 481da177e4SLinus Torvalds return NULL; 491da177e4SLinus Torvalds } 501a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_io_region); 511da177e4SLinus Torvalds 52e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_mem_region(u_long base, u_long num, u_long align, 531da177e4SLinus Torvalds int low, struct pcmcia_socket *s) 541da177e4SLinus Torvalds { 551da177e4SLinus Torvalds if (s->resource_ops->find_mem) 561da177e4SLinus Torvalds return s->resource_ops->find_mem(base, num, align, low, s); 571da177e4SLinus Torvalds return NULL; 581da177e4SLinus Torvalds } 591a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_mem_region); 601da177e4SLinus Torvalds 611da177e4SLinus Torvalds void release_resource_db(struct pcmcia_socket *s) 621da177e4SLinus Torvalds { 631da177e4SLinus Torvalds if (s->resource_ops->exit) 641da177e4SLinus Torvalds s->resource_ops->exit(s); 651da177e4SLinus Torvalds } 661da177e4SLinus Torvalds 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds static int static_init(struct pcmcia_socket *s) 691da177e4SLinus Torvalds { 701da177e4SLinus Torvalds unsigned long flags; 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds /* the good thing about SS_CAP_STATIC_MAP sockets is 731da177e4SLinus Torvalds * that they don't need a resource database */ 741da177e4SLinus Torvalds 751da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 761da177e4SLinus Torvalds s->resource_setup_done = 1; 771da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 781da177e4SLinus Torvalds 791da177e4SLinus Torvalds return 0; 801da177e4SLinus Torvalds } 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds 831da177e4SLinus Torvalds struct pccard_resource_ops pccard_static_ops = { 841da177e4SLinus Torvalds .validate_mem = NULL, 851da177e4SLinus Torvalds .adjust_io_region = NULL, 861da177e4SLinus Torvalds .find_io = NULL, 871da177e4SLinus Torvalds .find_mem = NULL, 88c5023801SDominik Brodowski .add_io = NULL, 89c5023801SDominik Brodowski .add_mem = NULL, 901da177e4SLinus Torvalds .init = static_init, 911da177e4SLinus Torvalds .exit = NULL, 921da177e4SLinus Torvalds }; 931da177e4SLinus Torvalds EXPORT_SYMBOL(pccard_static_ops); 943b27e942SDominik Brodowski 953b27e942SDominik Brodowski 963b27e942SDominik Brodowski #ifdef CONFIG_PCCARD_IODYN 973b27e942SDominik Brodowski 983b27e942SDominik Brodowski static struct resource * 993b27e942SDominik Brodowski make_resource(unsigned long b, unsigned long n, int flags, char *name) 1003b27e942SDominik Brodowski { 1013b27e942SDominik Brodowski struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL); 1023b27e942SDominik Brodowski 1033b27e942SDominik Brodowski if (res) { 1043b27e942SDominik Brodowski res->name = name; 1053b27e942SDominik Brodowski res->start = b; 1063b27e942SDominik Brodowski res->end = b + n - 1; 1073b27e942SDominik Brodowski res->flags = flags; 1083b27e942SDominik Brodowski } 1093b27e942SDominik Brodowski return res; 1103b27e942SDominik Brodowski } 1113b27e942SDominik Brodowski 1123b27e942SDominik Brodowski struct pcmcia_align_data { 1133b27e942SDominik Brodowski unsigned long mask; 1143b27e942SDominik Brodowski unsigned long offset; 1153b27e942SDominik Brodowski }; 1163b27e942SDominik Brodowski 1173b7a17fcSDominik Brodowski static resource_size_t pcmcia_align(void *align_data, 1183b7a17fcSDominik Brodowski const struct resource *res, 119b26b2d49SDominik Brodowski resource_size_t size, resource_size_t align) 1203b27e942SDominik Brodowski { 1213b27e942SDominik Brodowski struct pcmcia_align_data *data = align_data; 122b26b2d49SDominik Brodowski resource_size_t start; 1233b27e942SDominik Brodowski 1243b27e942SDominik Brodowski start = (res->start & ~data->mask) + data->offset; 1253b27e942SDominik Brodowski if (start < res->start) 1263b27e942SDominik Brodowski start += data->mask + 1; 1273b27e942SDominik Brodowski 1283b27e942SDominik Brodowski #ifdef CONFIG_X86 1293b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 1303b27e942SDominik Brodowski if (start & 0x300) { 1313b27e942SDominik Brodowski start = (start + 0x3ff) & ~0x3ff; 1323b27e942SDominik Brodowski } 1333b27e942SDominik Brodowski } 1343b27e942SDominik Brodowski #endif 1353b27e942SDominik Brodowski 1363b27e942SDominik Brodowski #ifdef CONFIG_M68K 1373b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 1383b27e942SDominik Brodowski if ((res->start + size - 1) >= 1024) 139b26b2d49SDominik Brodowski start = res->end; 1403b27e942SDominik Brodowski } 1413b27e942SDominik Brodowski #endif 142b26b2d49SDominik Brodowski 143b26b2d49SDominik Brodowski return start; 1443b27e942SDominik Brodowski } 1453b27e942SDominik Brodowski 1463b27e942SDominik Brodowski 1473b27e942SDominik Brodowski static int iodyn_adjust_io_region(struct resource *res, unsigned long r_start, 1483b27e942SDominik Brodowski unsigned long r_end, struct pcmcia_socket *s) 1493b27e942SDominik Brodowski { 1503b27e942SDominik Brodowski return adjust_resource(res, r_start, r_end - r_start + 1); 1513b27e942SDominik Brodowski } 1523b27e942SDominik Brodowski 1533b27e942SDominik Brodowski 1543b27e942SDominik Brodowski static struct resource *iodyn_find_io_region(unsigned long base, int num, 1553b27e942SDominik Brodowski unsigned long align, struct pcmcia_socket *s) 1563b27e942SDominik Brodowski { 1573b27e942SDominik Brodowski struct resource *res = make_resource(0, num, IORESOURCE_IO, 158f2fecec5SKay Sievers dev_name(&s->dev)); 1593b27e942SDominik Brodowski struct pcmcia_align_data data; 1603b27e942SDominik Brodowski unsigned long min = base; 1613b27e942SDominik Brodowski int ret; 1623b27e942SDominik Brodowski 1633b27e942SDominik Brodowski if (align == 0) 1643b27e942SDominik Brodowski align = 0x10000; 1653b27e942SDominik Brodowski 1663b27e942SDominik Brodowski data.mask = align - 1; 1673b27e942SDominik Brodowski data.offset = base & data.mask; 1683b27e942SDominik Brodowski 1693b27e942SDominik Brodowski #ifdef CONFIG_PCI 1703b27e942SDominik Brodowski if (s->cb_dev) { 1713b27e942SDominik Brodowski ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1, 1723b27e942SDominik Brodowski min, 0, pcmcia_align, &data); 1733b27e942SDominik Brodowski } else 1743b27e942SDominik Brodowski #endif 1753b27e942SDominik Brodowski ret = allocate_resource(&ioport_resource, res, num, min, ~0UL, 1763b27e942SDominik Brodowski 1, pcmcia_align, &data); 1773b27e942SDominik Brodowski 1783b27e942SDominik Brodowski if (ret != 0) { 1793b27e942SDominik Brodowski kfree(res); 1803b27e942SDominik Brodowski res = NULL; 1813b27e942SDominik Brodowski } 1823b27e942SDominik Brodowski return res; 1833b27e942SDominik Brodowski } 1843b27e942SDominik Brodowski 1853b27e942SDominik Brodowski struct pccard_resource_ops pccard_iodyn_ops = { 1863b27e942SDominik Brodowski .validate_mem = NULL, 1873b27e942SDominik Brodowski .adjust_io_region = iodyn_adjust_io_region, 1883b27e942SDominik Brodowski .find_io = iodyn_find_io_region, 1893b27e942SDominik Brodowski .find_mem = NULL, 190c5023801SDominik Brodowski .add_io = NULL, 191c5023801SDominik Brodowski .add_mem = NULL, 1923b27e942SDominik Brodowski .init = static_init, 1933b27e942SDominik Brodowski .exit = NULL, 1943b27e942SDominik Brodowski }; 1953b27e942SDominik Brodowski EXPORT_SYMBOL(pccard_iodyn_ops); 1963b27e942SDominik Brodowski 1973b27e942SDominik Brodowski #endif /* CONFIG_PCCARD_IODYN */ 198