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 24de75914eSDominik Brodowski int pcmcia_validate_mem(struct pcmcia_socket *s) 251da177e4SLinus Torvalds { 261da177e4SLinus Torvalds if (s->resource_ops->validate_mem) 27de75914eSDominik Brodowski return s->resource_ops->validate_mem(s); 28de75914eSDominik Brodowski /* if there is no callback, we can assume that everything is OK */ 29de75914eSDominik Brodowski return 0; 301da177e4SLinus Torvalds } 311da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_validate_mem); 321da177e4SLinus Torvalds 33e6ea0b9eSDominik Brodowski int pcmcia_adjust_io_region(struct resource *res, unsigned long r_start, 341da177e4SLinus Torvalds unsigned long r_end, struct pcmcia_socket *s) 351da177e4SLinus Torvalds { 361da177e4SLinus Torvalds if (s->resource_ops->adjust_io_region) 371da177e4SLinus Torvalds return s->resource_ops->adjust_io_region(res, r_start, r_end, s); 381da177e4SLinus Torvalds return -ENOMEM; 391da177e4SLinus Torvalds } 401a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_adjust_io_region); 411da177e4SLinus Torvalds 42e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_io_region(unsigned long base, int num, 431da177e4SLinus Torvalds unsigned long align, struct pcmcia_socket *s) 441da177e4SLinus Torvalds { 451da177e4SLinus Torvalds if (s->resource_ops->find_io) 461da177e4SLinus Torvalds return s->resource_ops->find_io(base, num, align, s); 471da177e4SLinus Torvalds return NULL; 481da177e4SLinus Torvalds } 491a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_io_region); 501da177e4SLinus Torvalds 51e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_mem_region(u_long base, u_long num, u_long align, 521da177e4SLinus Torvalds int low, struct pcmcia_socket *s) 531da177e4SLinus Torvalds { 541da177e4SLinus Torvalds if (s->resource_ops->find_mem) 551da177e4SLinus Torvalds return s->resource_ops->find_mem(base, num, align, low, s); 561da177e4SLinus Torvalds return NULL; 571da177e4SLinus Torvalds } 581a8d4663SDominik Brodowski EXPORT_SYMBOL(pcmcia_find_mem_region); 591da177e4SLinus Torvalds 601da177e4SLinus Torvalds void release_resource_db(struct pcmcia_socket *s) 611da177e4SLinus Torvalds { 621da177e4SLinus Torvalds if (s->resource_ops->exit) 631da177e4SLinus Torvalds s->resource_ops->exit(s); 641da177e4SLinus Torvalds } 651da177e4SLinus Torvalds 661da177e4SLinus Torvalds 671da177e4SLinus Torvalds static int static_init(struct pcmcia_socket *s) 681da177e4SLinus Torvalds { 691da177e4SLinus Torvalds unsigned long flags; 701da177e4SLinus Torvalds 711da177e4SLinus Torvalds /* the good thing about SS_CAP_STATIC_MAP sockets is 721da177e4SLinus Torvalds * that they don't need a resource database */ 731da177e4SLinus Torvalds 741da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 751da177e4SLinus Torvalds s->resource_setup_done = 1; 761da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 771da177e4SLinus Torvalds 781da177e4SLinus Torvalds return 0; 791da177e4SLinus Torvalds } 801da177e4SLinus Torvalds 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds struct pccard_resource_ops pccard_static_ops = { 831da177e4SLinus Torvalds .validate_mem = NULL, 841da177e4SLinus Torvalds .adjust_io_region = NULL, 851da177e4SLinus Torvalds .find_io = NULL, 861da177e4SLinus Torvalds .find_mem = NULL, 87c5023801SDominik Brodowski .add_io = NULL, 88c5023801SDominik Brodowski .add_mem = NULL, 891da177e4SLinus Torvalds .init = static_init, 901da177e4SLinus Torvalds .exit = NULL, 911da177e4SLinus Torvalds }; 921da177e4SLinus Torvalds EXPORT_SYMBOL(pccard_static_ops); 933b27e942SDominik Brodowski 943b27e942SDominik Brodowski 953b27e942SDominik Brodowski #ifdef CONFIG_PCCARD_IODYN 963b27e942SDominik Brodowski 973b27e942SDominik Brodowski static struct resource * 983b27e942SDominik Brodowski make_resource(unsigned long b, unsigned long n, int flags, char *name) 993b27e942SDominik Brodowski { 1003b27e942SDominik Brodowski struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL); 1013b27e942SDominik Brodowski 1023b27e942SDominik Brodowski if (res) { 1033b27e942SDominik Brodowski res->name = name; 1043b27e942SDominik Brodowski res->start = b; 1053b27e942SDominik Brodowski res->end = b + n - 1; 1063b27e942SDominik Brodowski res->flags = flags; 1073b27e942SDominik Brodowski } 1083b27e942SDominik Brodowski return res; 1093b27e942SDominik Brodowski } 1103b27e942SDominik Brodowski 1113b27e942SDominik Brodowski struct pcmcia_align_data { 1123b27e942SDominik Brodowski unsigned long mask; 1133b27e942SDominik Brodowski unsigned long offset; 1143b27e942SDominik Brodowski }; 1153b27e942SDominik Brodowski 1163b27e942SDominik Brodowski static void pcmcia_align(void *align_data, struct resource *res, 1173b27e942SDominik Brodowski unsigned long size, unsigned long align) 1183b27e942SDominik Brodowski { 1193b27e942SDominik Brodowski struct pcmcia_align_data *data = align_data; 1203b27e942SDominik Brodowski unsigned long start; 1213b27e942SDominik Brodowski 1223b27e942SDominik Brodowski start = (res->start & ~data->mask) + data->offset; 1233b27e942SDominik Brodowski if (start < res->start) 1243b27e942SDominik Brodowski start += data->mask + 1; 1253b27e942SDominik Brodowski res->start = start; 1263b27e942SDominik Brodowski 1273b27e942SDominik Brodowski #ifdef CONFIG_X86 1283b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 1293b27e942SDominik Brodowski if (start & 0x300) { 1303b27e942SDominik Brodowski start = (start + 0x3ff) & ~0x3ff; 1313b27e942SDominik Brodowski res->start = start; 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) 1393b27e942SDominik Brodowski res->start = res->end; 1403b27e942SDominik Brodowski } 1413b27e942SDominik Brodowski #endif 1423b27e942SDominik Brodowski } 1433b27e942SDominik Brodowski 1443b27e942SDominik Brodowski 1453b27e942SDominik Brodowski static int iodyn_adjust_io_region(struct resource *res, unsigned long r_start, 1463b27e942SDominik Brodowski unsigned long r_end, struct pcmcia_socket *s) 1473b27e942SDominik Brodowski { 1483b27e942SDominik Brodowski return adjust_resource(res, r_start, r_end - r_start + 1); 1493b27e942SDominik Brodowski } 1503b27e942SDominik Brodowski 1513b27e942SDominik Brodowski 1523b27e942SDominik Brodowski static struct resource *iodyn_find_io_region(unsigned long base, int num, 1533b27e942SDominik Brodowski unsigned long align, struct pcmcia_socket *s) 1543b27e942SDominik Brodowski { 1553b27e942SDominik Brodowski struct resource *res = make_resource(0, num, IORESOURCE_IO, 156dfe461aeSManuel Lauss s->dev.bus_id); 1573b27e942SDominik Brodowski struct pcmcia_align_data data; 1583b27e942SDominik Brodowski unsigned long min = base; 1593b27e942SDominik Brodowski int ret; 1603b27e942SDominik Brodowski 1613b27e942SDominik Brodowski if (align == 0) 1623b27e942SDominik Brodowski align = 0x10000; 1633b27e942SDominik Brodowski 1643b27e942SDominik Brodowski data.mask = align - 1; 1653b27e942SDominik Brodowski data.offset = base & data.mask; 1663b27e942SDominik Brodowski 1673b27e942SDominik Brodowski #ifdef CONFIG_PCI 1683b27e942SDominik Brodowski if (s->cb_dev) { 1693b27e942SDominik Brodowski ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1, 1703b27e942SDominik Brodowski min, 0, pcmcia_align, &data); 1713b27e942SDominik Brodowski } else 1723b27e942SDominik Brodowski #endif 1733b27e942SDominik Brodowski ret = allocate_resource(&ioport_resource, res, num, min, ~0UL, 1743b27e942SDominik Brodowski 1, pcmcia_align, &data); 1753b27e942SDominik Brodowski 1763b27e942SDominik Brodowski if (ret != 0) { 1773b27e942SDominik Brodowski kfree(res); 1783b27e942SDominik Brodowski res = NULL; 1793b27e942SDominik Brodowski } 1803b27e942SDominik Brodowski return res; 1813b27e942SDominik Brodowski } 1823b27e942SDominik Brodowski 1833b27e942SDominik Brodowski struct pccard_resource_ops pccard_iodyn_ops = { 1843b27e942SDominik Brodowski .validate_mem = NULL, 1853b27e942SDominik Brodowski .adjust_io_region = iodyn_adjust_io_region, 1863b27e942SDominik Brodowski .find_io = iodyn_find_io_region, 1873b27e942SDominik Brodowski .find_mem = NULL, 188c5023801SDominik Brodowski .add_io = NULL, 189c5023801SDominik Brodowski .add_mem = NULL, 1903b27e942SDominik Brodowski .init = static_init, 1913b27e942SDominik Brodowski .exit = NULL, 1923b27e942SDominik Brodowski }; 1933b27e942SDominik Brodowski EXPORT_SYMBOL(pccard_iodyn_ops); 1943b27e942SDominik Brodowski 1953b27e942SDominik Brodowski #endif /* CONFIG_PCCARD_IODYN */ 196