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 155a0e3ad6STejun Heo #include <linux/slab.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> 2291284224SDominik Brodowski #include <pcmcia/cistpl.h> 231da177e4SLinus Torvalds #include "cs_internal.h" 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds static int static_init(struct pcmcia_socket *s) 261da177e4SLinus Torvalds { 271da177e4SLinus Torvalds /* the good thing about SS_CAP_STATIC_MAP sockets is 281da177e4SLinus Torvalds * that they don't need a resource database */ 291da177e4SLinus Torvalds 301da177e4SLinus Torvalds s->resource_setup_done = 1; 311da177e4SLinus Torvalds 321da177e4SLinus Torvalds return 0; 331da177e4SLinus Torvalds } 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds 361da177e4SLinus Torvalds struct pccard_resource_ops pccard_static_ops = { 371da177e4SLinus Torvalds .validate_mem = NULL, 381da177e4SLinus Torvalds .adjust_io_region = NULL, 391da177e4SLinus Torvalds .find_io = NULL, 401da177e4SLinus Torvalds .find_mem = NULL, 41c5023801SDominik Brodowski .add_io = NULL, 42c5023801SDominik Brodowski .add_mem = NULL, 431da177e4SLinus Torvalds .init = static_init, 441da177e4SLinus Torvalds .exit = NULL, 451da177e4SLinus Torvalds }; 461da177e4SLinus Torvalds EXPORT_SYMBOL(pccard_static_ops); 473b27e942SDominik Brodowski 483b27e942SDominik Brodowski 493b27e942SDominik Brodowski #ifdef CONFIG_PCCARD_IODYN 503b27e942SDominik Brodowski 513b27e942SDominik Brodowski static struct resource * 523b27e942SDominik Brodowski make_resource(unsigned long b, unsigned long n, int flags, char *name) 533b27e942SDominik Brodowski { 543b27e942SDominik Brodowski struct resource *res = kzalloc(sizeof(*res), GFP_KERNEL); 553b27e942SDominik Brodowski 563b27e942SDominik Brodowski if (res) { 573b27e942SDominik Brodowski res->name = name; 583b27e942SDominik Brodowski res->start = b; 593b27e942SDominik Brodowski res->end = b + n - 1; 603b27e942SDominik Brodowski res->flags = flags; 613b27e942SDominik Brodowski } 623b27e942SDominik Brodowski return res; 633b27e942SDominik Brodowski } 643b27e942SDominik Brodowski 653b27e942SDominik Brodowski struct pcmcia_align_data { 663b27e942SDominik Brodowski unsigned long mask; 673b27e942SDominik Brodowski unsigned long offset; 683b27e942SDominik Brodowski }; 693b27e942SDominik Brodowski 703b7a17fcSDominik Brodowski static resource_size_t pcmcia_align(void *align_data, 713b7a17fcSDominik Brodowski const struct resource *res, 72b26b2d49SDominik Brodowski resource_size_t size, resource_size_t align) 733b27e942SDominik Brodowski { 743b27e942SDominik Brodowski struct pcmcia_align_data *data = align_data; 75b26b2d49SDominik Brodowski resource_size_t start; 763b27e942SDominik Brodowski 773b27e942SDominik Brodowski start = (res->start & ~data->mask) + data->offset; 783b27e942SDominik Brodowski if (start < res->start) 793b27e942SDominik Brodowski start += data->mask + 1; 803b27e942SDominik Brodowski 813b27e942SDominik Brodowski #ifdef CONFIG_X86 823b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 836e83ee07SDominik Brodowski if (start & 0x300) 843b27e942SDominik Brodowski start = (start + 0x3ff) & ~0x3ff; 853b27e942SDominik Brodowski } 863b27e942SDominik Brodowski #endif 873b27e942SDominik Brodowski 883b27e942SDominik Brodowski #ifdef CONFIG_M68K 893b27e942SDominik Brodowski if (res->flags & IORESOURCE_IO) { 903b27e942SDominik Brodowski if ((res->start + size - 1) >= 1024) 91b26b2d49SDominik Brodowski start = res->end; 923b27e942SDominik Brodowski } 933b27e942SDominik Brodowski #endif 94b26b2d49SDominik Brodowski 95b26b2d49SDominik Brodowski return start; 963b27e942SDominik Brodowski } 973b27e942SDominik Brodowski 983b27e942SDominik Brodowski 993b27e942SDominik Brodowski static int iodyn_adjust_io_region(struct resource *res, unsigned long r_start, 1003b27e942SDominik Brodowski unsigned long r_end, struct pcmcia_socket *s) 1013b27e942SDominik Brodowski { 1023b27e942SDominik Brodowski return adjust_resource(res, r_start, r_end - r_start + 1); 1033b27e942SDominik Brodowski } 1043b27e942SDominik Brodowski 1053b27e942SDominik Brodowski 1063b27e942SDominik Brodowski static struct resource *iodyn_find_io_region(unsigned long base, int num, 1073b27e942SDominik Brodowski unsigned long align, struct pcmcia_socket *s) 1083b27e942SDominik Brodowski { 1093b27e942SDominik Brodowski struct resource *res = make_resource(0, num, IORESOURCE_IO, 110f2fecec5SKay Sievers dev_name(&s->dev)); 1113b27e942SDominik Brodowski struct pcmcia_align_data data; 1123b27e942SDominik Brodowski unsigned long min = base; 1133b27e942SDominik Brodowski int ret; 1143b27e942SDominik Brodowski 1153b27e942SDominik Brodowski if (align == 0) 1163b27e942SDominik Brodowski align = 0x10000; 1173b27e942SDominik Brodowski 1183b27e942SDominik Brodowski data.mask = align - 1; 1193b27e942SDominik Brodowski data.offset = base & data.mask; 1203b27e942SDominik Brodowski 1213b27e942SDominik Brodowski #ifdef CONFIG_PCI 1223b27e942SDominik Brodowski if (s->cb_dev) { 1233b27e942SDominik Brodowski ret = pci_bus_alloc_resource(s->cb_dev->bus, res, num, 1, 1243b27e942SDominik Brodowski min, 0, pcmcia_align, &data); 1253b27e942SDominik Brodowski } else 1263b27e942SDominik Brodowski #endif 1273b27e942SDominik Brodowski ret = allocate_resource(&ioport_resource, res, num, min, ~0UL, 1283b27e942SDominik Brodowski 1, pcmcia_align, &data); 1293b27e942SDominik Brodowski 1303b27e942SDominik Brodowski if (ret != 0) { 1313b27e942SDominik Brodowski kfree(res); 1323b27e942SDominik Brodowski res = NULL; 1333b27e942SDominik Brodowski } 1343b27e942SDominik Brodowski return res; 1353b27e942SDominik Brodowski } 1363b27e942SDominik Brodowski 1373b27e942SDominik Brodowski struct pccard_resource_ops pccard_iodyn_ops = { 1383b27e942SDominik Brodowski .validate_mem = NULL, 1393b27e942SDominik Brodowski .adjust_io_region = iodyn_adjust_io_region, 1403b27e942SDominik Brodowski .find_io = iodyn_find_io_region, 1413b27e942SDominik Brodowski .find_mem = NULL, 142c5023801SDominik Brodowski .add_io = NULL, 143c5023801SDominik Brodowski .add_mem = NULL, 1443b27e942SDominik Brodowski .init = static_init, 1453b27e942SDominik Brodowski .exit = NULL, 1463b27e942SDominik Brodowski }; 1473b27e942SDominik Brodowski EXPORT_SYMBOL(pccard_iodyn_ops); 1483b27e942SDominik Brodowski 1493b27e942SDominik Brodowski #endif /* CONFIG_PCCARD_IODYN */ 150