drivers/mfd/mcp-core.c

   1 /*
   2  *  linux/drivers/mfd/mcp-core.c
   3  *
   4  *  Copyright (C) 2001 Russell King
   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.
   9  *
  10  *  Generic MCP (Multimedia Communications Port) layer.  All MCP locking
  11  *  is solely held within this file.
  12  */
  13 #include <linux/module.h>
  14 #include <linux/init.h>
  15 #include <linux/errno.h>
  16 #include <linux/smp.h>
  17 #include <linux/device.h>
  18 #include <linux/slab.h>
  19 #include <linux/string.h>
  20 #include <linux/mfd/mcp.h>
  21
  22
  23 #define to_mcp(d)               container_of(d, struct mcp, attached_device)
  24 #define to_mcp_driver(d)        container_of(d, struct mcp_driver, drv)
  25
  26 static int mcp_bus_match(struct device *dev, struct device_driver *drv)
  27 {
  28         return 1;
  29 }
  30
  31 static int mcp_bus_probe(struct device *dev)
  32 {
  33         struct mcp *mcp = to_mcp(dev);
  34         struct mcp_driver *drv = to_mcp_driver(dev->driver);
  35
  36         return drv->probe(mcp);
  37 }
  38
  39 static int mcp_bus_remove(struct device *dev)
  40 {
  41         struct mcp *mcp = to_mcp(dev);
  42         struct mcp_driver *drv = to_mcp_driver(dev->driver);
  43
  44         drv->remove(mcp);
  45         return 0;
  46 }
  47
  48 static struct bus_type mcp_bus_type = {
  49         .name           = "mcp",
  50         .match          = mcp_bus_match,
  51         .probe          = mcp_bus_probe,
  52         .remove         = mcp_bus_remove,
  53 };
  54
  55 /**
  56  *      mcp_set_telecom_divisor - set the telecom divisor
  57  *      @mcp: MCP interface structure
  58  *      @div: SIB clock divisor
  59  *
  60  *      Set the telecom divisor on the MCP interface.  The resulting
  61  *      sample rate is SIBCLOCK/div.
  62  */
  63 void mcp_set_telecom_divisor(struct mcp *mcp, unsigned int div)
  64 {
  65         unsigned long flags;
  66
  67         spin_lock_irqsave(&mcp->lock, flags);
  68         mcp->ops->set_telecom_divisor(mcp, div);
  69         spin_unlock_irqrestore(&mcp->lock, flags);
  70 }
  71 EXPORT_SYMBOL(mcp_set_telecom_divisor);
  72
  73 /**
  74  *      mcp_set_audio_divisor - set the audio divisor
  75  *      @mcp: MCP interface structure
  76  *      @div: SIB clock divisor
  77  *
  78  *      Set the audio divisor on the MCP interface.
  79  */
  80 void mcp_set_audio_divisor(struct mcp *mcp, unsigned int div)
  81 {
  82         unsigned long flags;
  83
  84         spin_lock_irqsave(&mcp->lock, flags);
  85         mcp->ops->set_audio_divisor(mcp, div);
  86         spin_unlock_irqrestore(&mcp->lock, flags);
  87 }
  88 EXPORT_SYMBOL(mcp_set_audio_divisor);
  89
  90 /**
  91  *      mcp_reg_write - write a device register
  92  *      @mcp: MCP interface structure
  93  *      @reg: 4-bit register index
  94  *      @val: 16-bit data value
  95  *
  96  *      Write a device register.  The MCP interface must be enabled
  97  *      to prevent this function hanging.
  98  */
  99 void mcp_reg_write(struct mcp *mcp, unsigned int reg, unsigned int val)
 100 {
 101         unsigned long flags;
 102
 103         spin_lock_irqsave(&mcp->lock, flags);
 104         mcp->ops->reg_write(mcp, reg, val);
 105         spin_unlock_irqrestore(&mcp->lock, flags);
 106 }
 107 EXPORT_SYMBOL(mcp_reg_write);
 108
 109 /**
 110  *      mcp_reg_read - read a device register
 111  *      @mcp: MCP interface structure
 112  *      @reg: 4-bit register index
 113  *
 114  *      Read a device register and return its value.  The MCP interface
 115  *      must be enabled to prevent this function hanging.
 116  */
 117 unsigned int mcp_reg_read(struct mcp *mcp, unsigned int reg)
 118 {
 119         unsigned long flags;
 120         unsigned int val;
 121
 122         spin_lock_irqsave(&mcp->lock, flags);
 123         val = mcp->ops->reg_read(mcp, reg);
 124         spin_unlock_irqrestore(&mcp->lock, flags);
 125
 126         return val;
 127 }
 128 EXPORT_SYMBOL(mcp_reg_read);
 129
 130 /**
 131  *      mcp_enable - enable the MCP interface
 132  *      @mcp: MCP interface to enable
 133  *
 134  *      Enable the MCP interface.  Each call to mcp_enable will need
 135  *      a corresponding call to mcp_disable to disable the interface.
 136  */
 137 void mcp_enable(struct mcp *mcp)
 138 {
 139         unsigned long flags;
 140
 141         spin_lock_irqsave(&mcp->lock, flags);
 142         if (mcp->use_count++ == 0)
 143                 mcp->ops->enable(mcp);
 144         spin_unlock_irqrestore(&mcp->lock, flags);
 145 }
 146 EXPORT_SYMBOL(mcp_enable);
 147
 148 /**
 149  *      mcp_disable - disable the MCP interface
 150  *      @mcp: MCP interface to disable
 151  *
 152  *      Disable the MCP interface.  The MCP interface will only be
 153  *      disabled once the number of calls to mcp_enable matches the
 154  *      number of calls to mcp_disable.
 155  */
 156 void mcp_disable(struct mcp *mcp)
 157 {
 158         unsigned long flags;
 159
 160         spin_lock_irqsave(&mcp->lock, flags);
 161         if (--mcp->use_count == 0)
 162                 mcp->ops->disable(mcp);
 163         spin_unlock_irqrestore(&mcp->lock, flags);
 164 }
 165 EXPORT_SYMBOL(mcp_disable);
 166
 167 static void mcp_release(struct device *dev)
 168 {
 169         struct mcp *mcp = container_of(dev, struct mcp, attached_device);
 170
 171         kfree(mcp);
 172 }
 173
 174 struct mcp *mcp_host_alloc(struct device *parent, size_t size)
 175 {
 176         struct mcp *mcp;
 177
 178         mcp = kzalloc(sizeof(struct mcp) + size, GFP_KERNEL);
 179         if (mcp) {
 180                 spin_lock_init(&mcp->lock);
 181                 device_initialize(&mcp->attached_device);
 182                 mcp->attached_device.parent = parent;
 183                 mcp->attached_device.bus = &mcp_bus_type;
 184                 mcp->attached_device.dma_mask = parent->dma_mask;
 185                 mcp->attached_device.release = mcp_release;
 186         }
 187         return mcp;
 188 }
 189 EXPORT_SYMBOL(mcp_host_alloc);
 190
 191 int mcp_host_add(struct mcp *mcp, void *pdata)
 192 {
 193         mcp->attached_device.platform_data = pdata;
 194         dev_set_name(&mcp->attached_device, "mcp0");
 195         return device_add(&mcp->attached_device);
 196 }
 197 EXPORT_SYMBOL(mcp_host_add);
 198
 199 void mcp_host_del(struct mcp *mcp)
 200 {
 201         device_del(&mcp->attached_device);
 202 }
 203 EXPORT_SYMBOL(mcp_host_del);
 204
 205 void mcp_host_free(struct mcp *mcp)
 206 {
 207         put_device(&mcp->attached_device);
 208 }
 209 EXPORT_SYMBOL(mcp_host_free);
 210
 211 int mcp_driver_register(struct mcp_driver *mcpdrv)
 212 {
 213         mcpdrv->drv.bus = &mcp_bus_type;
 214         return driver_register(&mcpdrv->drv);
 215 }
 216 EXPORT_SYMBOL(mcp_driver_register);
 217
 218 void mcp_driver_unregister(struct mcp_driver *mcpdrv)
 219 {
 220         driver_unregister(&mcpdrv->drv);
 221 }
 222 EXPORT_SYMBOL(mcp_driver_unregister);
 223
 224 static int __init mcp_init(void)
 225 {
 226         return bus_register(&mcp_bus_type);
 227 }
 228
 229 static void __exit mcp_exit(void)
 230 {
 231         bus_unregister(&mcp_bus_type);
 232 }
 233
 234 module_init(mcp_init);
 235 module_exit(mcp_exit);
 236
 237 MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
 238 MODULE_DESCRIPTION("Core multimedia communications port driver");
 239 MODULE_LICENSE("GPL");