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 1011da177e4SLinus Torvalds void pcmcia_validate_mem(struct pcmcia_socket *s) 1021da177e4SLinus Torvalds { 1031da177e4SLinus Torvalds if (s->resource_ops->validate_mem) 1041da177e4SLinus Torvalds s->resource_ops->validate_mem(s); 1051da177e4SLinus Torvalds } 1061da177e4SLinus Torvalds EXPORT_SYMBOL(pcmcia_validate_mem); 1071da177e4SLinus Torvalds 108e6ea0b9eSDominik Brodowski int pcmcia_adjust_io_region(struct resource *res, unsigned long r_start, 1091da177e4SLinus Torvalds unsigned long r_end, struct pcmcia_socket *s) 1101da177e4SLinus Torvalds { 1111da177e4SLinus Torvalds if (s->resource_ops->adjust_io_region) 1121da177e4SLinus Torvalds return s->resource_ops->adjust_io_region(res, r_start, r_end, s); 1131da177e4SLinus Torvalds return -ENOMEM; 1141da177e4SLinus Torvalds } 1151da177e4SLinus Torvalds 116e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_io_region(unsigned long base, int num, 1171da177e4SLinus Torvalds unsigned long align, struct pcmcia_socket *s) 1181da177e4SLinus Torvalds { 1191da177e4SLinus Torvalds if (s->resource_ops->find_io) 1201da177e4SLinus Torvalds return s->resource_ops->find_io(base, num, align, s); 1211da177e4SLinus Torvalds return NULL; 1221da177e4SLinus Torvalds } 1231da177e4SLinus Torvalds 124e6ea0b9eSDominik Brodowski struct resource *pcmcia_find_mem_region(u_long base, u_long num, u_long align, 1251da177e4SLinus Torvalds int low, struct pcmcia_socket *s) 1261da177e4SLinus Torvalds { 1271da177e4SLinus Torvalds if (s->resource_ops->find_mem) 1281da177e4SLinus Torvalds return s->resource_ops->find_mem(base, num, align, low, s); 1291da177e4SLinus Torvalds return NULL; 1301da177e4SLinus Torvalds } 1311da177e4SLinus Torvalds 1321da177e4SLinus Torvalds void release_resource_db(struct pcmcia_socket *s) 1331da177e4SLinus Torvalds { 1341da177e4SLinus Torvalds if (s->resource_ops->exit) 1351da177e4SLinus Torvalds s->resource_ops->exit(s); 1361da177e4SLinus Torvalds } 1371da177e4SLinus Torvalds 1381da177e4SLinus Torvalds 1391da177e4SLinus Torvalds static int static_init(struct pcmcia_socket *s) 1401da177e4SLinus Torvalds { 1411da177e4SLinus Torvalds unsigned long flags; 1421da177e4SLinus Torvalds 1431da177e4SLinus Torvalds /* the good thing about SS_CAP_STATIC_MAP sockets is 1441da177e4SLinus Torvalds * that they don't need a resource database */ 1451da177e4SLinus Torvalds 1461da177e4SLinus Torvalds spin_lock_irqsave(&s->lock, flags); 1471da177e4SLinus Torvalds s->resource_setup_done = 1; 1481da177e4SLinus Torvalds spin_unlock_irqrestore(&s->lock, flags); 1491da177e4SLinus Torvalds 1501da177e4SLinus Torvalds return 0; 1511da177e4SLinus Torvalds } 1521da177e4SLinus Torvalds 1531da177e4SLinus Torvalds 1541da177e4SLinus Torvalds struct pccard_resource_ops pccard_static_ops = { 1551da177e4SLinus Torvalds .validate_mem = NULL, 1561da177e4SLinus Torvalds .adjust_io_region = NULL, 1571da177e4SLinus Torvalds .find_io = NULL, 1581da177e4SLinus Torvalds .find_mem = NULL, 1591da177e4SLinus Torvalds .adjust_resource = NULL, 1601da177e4SLinus Torvalds .init = static_init, 1611da177e4SLinus Torvalds .exit = NULL, 1621da177e4SLinus Torvalds }; 1631da177e4SLinus Torvalds EXPORT_SYMBOL(pccard_static_ops); 164