linux-bk/kernel/pm.c
<<
>>
Prefs
   1/*
   2 *  pm.c - Power management interface
   3 *
   4 *  Copyright (C) 2000 Andrew Henroid
   5 *
   6 *  This program is free software; you can redistribute it and/or modify
   7 *  it under the terms of the GNU General Public License as published by
   8 *  the Free Software Foundation; either version 2 of the License, or
   9 *  (at your option) any later version.
  10 *
  11 *  This program is distributed in the hope that it will be useful,
  12 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14 *  GNU General Public License for more details.
  15 *
  16 *  You should have received a copy of the GNU General Public License
  17 *  along with this program; if not, write to the Free Software
  18 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19 */
  20
  21#include <linux/module.h>
  22#include <linux/spinlock.h>
  23#include <linux/mm.h>
  24#include <linux/slab.h>
  25#include <linux/pm.h>
  26#include <linux/interrupt.h>
  27
  28int pm_active;
  29
  30/*
  31 *      Locking notes:
  32 *              pm_devs_lock can be a semaphore providing pm ops are not called
  33 *      from an interrupt handler (already a bad idea so no change here). Each
  34 *      change must be protected so that an unlink of an entry doesn't clash
  35 *      with a pm send - which is permitted to sleep in the current architecture
  36 *
  37 *      Module unloads clashing with pm events now work out safely, the module 
  38 *      unload path will block until the event has been sent. It may well block
  39 *      until a resume but that will be fine.
  40 */
  41 
  42static DECLARE_MUTEX(pm_devs_lock);
  43static LIST_HEAD(pm_devs);
  44
  45/**
  46 *      pm_register - register a device with power management
  47 *      @type: device type 
  48 *      @id: device ID
  49 *      @callback: callback function
  50 *
  51 *      Add a device to the list of devices that wish to be notified about
  52 *      power management events. A &pm_dev structure is returned on success,
  53 *      on failure the return is %NULL.
  54 *
  55 *      The callback function will be called in process context and
  56 *      it may sleep.
  57 */
  58 
  59struct pm_dev *pm_register(pm_dev_t type,
  60                           unsigned long id,
  61                           pm_callback callback)
  62{
  63        struct pm_dev *dev = kmalloc(sizeof(struct pm_dev), GFP_KERNEL);
  64        if (dev) {
  65                memset(dev, 0, sizeof(*dev));
  66                dev->type = type;
  67                dev->id = id;
  68                dev->callback = callback;
  69
  70                down(&pm_devs_lock);
  71                list_add(&dev->entry, &pm_devs);
  72                up(&pm_devs_lock);
  73        }
  74        return dev;
  75}
  76
  77/**
  78 *      pm_unregister -  unregister a device with power management
  79 *      @dev: device to unregister
  80 *
  81 *      Remove a device from the power management notification lists. The
  82 *      dev passed must be a handle previously returned by pm_register.
  83 */
  84 
  85void pm_unregister(struct pm_dev *dev)
  86{
  87        if (dev) {
  88                down(&pm_devs_lock);
  89                list_del(&dev->entry);
  90                up(&pm_devs_lock);
  91
  92                kfree(dev);
  93        }
  94}
  95
  96static void __pm_unregister(struct pm_dev *dev)
  97{
  98        if (dev) {
  99                list_del(&dev->entry);
 100                kfree(dev);
 101        }
 102}
 103
 104/**
 105 *      pm_unregister_all - unregister all devices with matching callback
 106 *      @callback: callback function pointer
 107 *
 108 *      Unregister every device that would call the callback passed. This
 109 *      is primarily meant as a helper function for loadable modules. It
 110 *      enables a module to give up all its managed devices without keeping
 111 *      its own private list.
 112 */
 113 
 114void pm_unregister_all(pm_callback callback)
 115{
 116        struct list_head *entry;
 117
 118        if (!callback)
 119                return;
 120
 121        down(&pm_devs_lock);
 122        entry = pm_devs.next;
 123        while (entry != &pm_devs) {
 124                struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
 125                entry = entry->next;
 126                if (dev->callback == callback)
 127                        __pm_unregister(dev);
 128        }
 129        up(&pm_devs_lock);
 130}
 131
 132/**
 133 *      pm_send - send request to a single device
 134 *      @dev: device to send to
 135 *      @rqst: power management request
 136 *      @data: data for the callback
 137 *
 138 *      Issue a power management request to a given device. The 
 139 *      %PM_SUSPEND and %PM_RESUME events are handled specially. The
 140 *      data field must hold the intended next state. No call is made
 141 *      if the state matches.
 142 *
 143 *      BUGS: what stops two power management requests occuring in parallel
 144 *      and conflicting.
 145 *
 146 *      WARNING: Calling pm_send directly is not generally recommended, in
 147 *      paticular there is no locking against the pm_dev going away. The
 148 *      caller must maintain all needed locking or have 'inside knowledge'
 149 *      on the safety. Also remember that this function is not locked against
 150 *      pm_unregister. This means that you must handle SMP races on callback
 151 *      execution and unload yourself.
 152 */
 153 
 154int pm_send(struct pm_dev *dev, pm_request_t rqst, void *data)
 155{
 156        int status = 0;
 157        unsigned long prev_state, next_state;
 158
 159        if (in_interrupt())
 160                BUG();
 161
 162        switch (rqst) {
 163        case PM_SUSPEND:
 164        case PM_RESUME:
 165                prev_state = dev->state;
 166                next_state = (unsigned long) data;
 167                if (prev_state != next_state) {
 168                        if (dev->callback)
 169                                status = (*dev->callback)(dev, rqst, data);
 170                        if (!status) {
 171                                dev->state = next_state;
 172                                dev->prev_state = prev_state;
 173                        }
 174                }
 175                else {
 176                        dev->prev_state = prev_state;
 177                }
 178                break;
 179        default:
 180                if (dev->callback)
 181                        status = (*dev->callback)(dev, rqst, data);
 182                break;
 183        }
 184        return status;
 185}
 186
 187/*
 188 * Undo incomplete request
 189 */
 190static void pm_undo_all(struct pm_dev *last)
 191{
 192        struct list_head *entry = last->entry.prev;
 193        while (entry != &pm_devs) {
 194                struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
 195                if (dev->state != dev->prev_state) {
 196                        /* previous state was zero (running) resume or
 197                         * previous state was non-zero (suspended) suspend
 198                         */
 199                        pm_request_t undo = (dev->prev_state
 200                                             ? PM_SUSPEND:PM_RESUME);
 201                        pm_send(dev, undo, (void*) dev->prev_state);
 202                }
 203                entry = entry->prev;
 204        }
 205}
 206
 207/**
 208 *      pm_send_all - send request to all managed devices
 209 *      @rqst: power management request
 210 *      @data: data for the callback
 211 *
 212 *      Issue a power management request to a all devices. The 
 213 *      %PM_SUSPEND events are handled specially. Any device is 
 214 *      permitted to fail a suspend by returning a non zero (error)
 215 *      value from its callback function. If any device vetoes a 
 216 *      suspend request then all other devices that have suspended 
 217 *      during the processing of this request are restored to their
 218 *      previous state.
 219 *
 220 *      WARNING:  This function takes the pm_devs_lock. The lock is not dropped until
 221 *      the callbacks have completed. This prevents races against pm locking
 222 *      functions, races against module unload pm_unregister code. It does
 223 *      mean however that you must not issue pm_ functions within the callback
 224 *      or you will deadlock and users will hate you.
 225 *
 226 *      Zero is returned on success. If a suspend fails then the status
 227 *      from the device that vetoes the suspend is returned.
 228 *
 229 *      BUGS: what stops two power management requests occuring in parallel
 230 *      and conflicting.
 231 */
 232 
 233int pm_send_all(pm_request_t rqst, void *data)
 234{
 235        struct list_head *entry;
 236        
 237        down(&pm_devs_lock);
 238        entry = pm_devs.next;
 239        while (entry != &pm_devs) {
 240                struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
 241                if (dev->callback) {
 242                        int status = pm_send(dev, rqst, data);
 243                        if (status) {
 244                                /* return devices to previous state on
 245                                 * failed suspend request
 246                                 */
 247                                if (rqst == PM_SUSPEND)
 248                                        pm_undo_all(dev);
 249                                up(&pm_devs_lock);
 250                                return status;
 251                        }
 252                }
 253                entry = entry->next;
 254        }
 255        up(&pm_devs_lock);
 256        return 0;
 257}
 258
 259/**
 260 *      pm_find  - find a device
 261 *      @type: type of device
 262 *      @from: where to start looking
 263 *
 264 *      Scan the power management list for devices of a specific type. The
 265 *      return value for a matching device may be passed to further calls
 266 *      to this function to find further matches. A %NULL indicates the end
 267 *      of the list. 
 268 *
 269 *      To search from the beginning pass %NULL as the @from value.
 270 *
 271 *      The caller MUST hold the pm_devs_lock lock when calling this 
 272 *      function. The instant that the lock is dropped all pointers returned
 273 *      may become invalid.
 274 */
 275 
 276struct pm_dev *pm_find(pm_dev_t type, struct pm_dev *from)
 277{
 278        struct list_head *entry = from ? from->entry.next:pm_devs.next;
 279        while (entry != &pm_devs) {
 280                struct pm_dev *dev = list_entry(entry, struct pm_dev, entry);
 281                if (type == PM_UNKNOWN_DEV || dev->type == type)
 282                        return dev;
 283                entry = entry->next;
 284        }
 285        return 0;
 286}
 287
 288EXPORT_SYMBOL(pm_register);
 289EXPORT_SYMBOL(pm_unregister);
 290EXPORT_SYMBOL(pm_unregister_all);
 291EXPORT_SYMBOL(pm_send);
 292EXPORT_SYMBOL(pm_send_all);
 293EXPORT_SYMBOL(pm_find);
 294EXPORT_SYMBOL(pm_active);
 295
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.