sound/hda/ext/hdac_ext_bus.c

   1 /*
   2  *  hdac-ext-bus.c - HD-audio extended core bus functions.
   3  *
   4  *  Copyright (C) 2014-2015 Intel Corp
   5  *  Author: Jeeja KP <jeeja.kp@intel.com>
   6  *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; version 2 of the License.
  11  *
  12  *  This program is distributed in the hope that it will be useful, but
  13  *  WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  *  General Public License for more details.
  16  *
  17  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  18  */
  19
  20 #include <linux/module.h>
  21 #include <linux/slab.h>
  22 #include <linux/io.h>
  23 #include <sound/hdaudio_ext.h>
  24
  25 MODULE_DESCRIPTION("HDA extended core");
  26 MODULE_LICENSE("GPL v2");
  27
  28 static void hdac_ext_writel(u32 value, u32 __iomem *addr)
  29 {
  30         writel(value, addr);
  31 }
  32
  33 static u32 hdac_ext_readl(u32 __iomem *addr)
  34 {
  35         return readl(addr);
  36 }
  37
  38 static void hdac_ext_writew(u16 value, u16 __iomem *addr)
  39 {
  40         writew(value, addr);
  41 }
  42
  43 static u16 hdac_ext_readw(u16 __iomem *addr)
  44 {
  45         return readw(addr);
  46 }
  47
  48 static void hdac_ext_writeb(u8 value, u8 __iomem *addr)
  49 {
  50         writeb(value, addr);
  51 }
  52
  53 static u8 hdac_ext_readb(u8 __iomem *addr)
  54 {
  55         return readb(addr);
  56 }
  57
  58 static int hdac_ext_dma_alloc_pages(struct hdac_bus *bus, int type,
  59                            size_t size, struct snd_dma_buffer *buf)
  60 {
  61         return snd_dma_alloc_pages(type, bus->dev, size, buf);
  62 }
  63
  64 static void hdac_ext_dma_free_pages(struct hdac_bus *bus, struct snd_dma_buffer *buf)
  65 {
  66         snd_dma_free_pages(buf);
  67 }
  68
  69 static const struct hdac_io_ops hdac_ext_default_io = {
  70         .reg_writel = hdac_ext_writel,
  71         .reg_readl = hdac_ext_readl,
  72         .reg_writew = hdac_ext_writew,
  73         .reg_readw = hdac_ext_readw,
  74         .reg_writeb = hdac_ext_writeb,
  75         .reg_readb = hdac_ext_readb,
  76         .dma_alloc_pages = hdac_ext_dma_alloc_pages,
  77         .dma_free_pages = hdac_ext_dma_free_pages,
  78 };
  79
  80 /**
  81  * snd_hdac_ext_bus_init - initialize a HD-audio extended bus
  82  * @ebus: the pointer to extended bus object
  83  * @dev: device pointer
  84  * @ops: bus verb operators
  85  * @io_ops: lowlevel I/O operators, can be NULL. If NULL core will use
  86  * default ops
  87  *
  88  * Returns 0 if successful, or a negative error code.
  89  */
  90 int snd_hdac_ext_bus_init(struct hdac_ext_bus *ebus, struct device *dev,
  91                         const struct hdac_bus_ops *ops,
  92                         const struct hdac_io_ops *io_ops)
  93 {
  94         int ret;
  95         static int idx;
  96
  97         /* check if io ops are provided, if not load the defaults */
  98         if (io_ops == NULL)
  99                 io_ops = &hdac_ext_default_io;
 100
 101         ret = snd_hdac_bus_init(&ebus->bus, dev, ops, io_ops);
 102         if (ret < 0)
 103                 return ret;
 104
 105         INIT_LIST_HEAD(&ebus->hlink_list);
 106         ebus->idx = idx++;
 107
 108         mutex_init(&ebus->lock);
 109         ebus->cmd_dma_state = true;
 110
 111         return 0;
 112 }
 113 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_init);
 114
 115 /**
 116  * snd_hdac_ext_bus_exit - clean up a HD-audio extended bus
 117  * @ebus: the pointer to extended bus object
 118  */
 119 void snd_hdac_ext_bus_exit(struct hdac_ext_bus *ebus)
 120 {
 121         snd_hdac_bus_exit(&ebus->bus);
 122         WARN_ON(!list_empty(&ebus->hlink_list));
 123 }
 124 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_exit);
 125
 126 static void default_release(struct device *dev)
 127 {
 128         snd_hdac_ext_bus_device_exit(container_of(dev, struct hdac_device, dev));
 129 }
 130
 131 /**
 132  * snd_hdac_ext_bus_device_init - initialize the HDA extended codec base device
 133  * @ebus: hdac extended bus to attach to
 134  * @addr: codec address
 135  *
 136  * Returns zero for success or a negative error code.
 137  */
 138 int snd_hdac_ext_bus_device_init(struct hdac_ext_bus *ebus, int addr)
 139 {
 140         struct hdac_ext_device *edev;
 141         struct hdac_device *hdev = NULL;
 142         struct hdac_bus *bus = ebus_to_hbus(ebus);
 143         char name[15];
 144         int ret;
 145
 146         edev = kzalloc(sizeof(*edev), GFP_KERNEL);
 147         if (!edev)
 148                 return -ENOMEM;
 149         hdev = &edev->hdac;
 150
 151         snprintf(name, sizeof(name), "ehdaudio%dD%d", ebus->idx, addr);
 152
 153         ret  = snd_hdac_device_init(hdev, bus, name, addr);
 154         if (ret < 0) {
 155                 dev_err(bus->dev, "device init failed for hdac device\n");
 156                 return ret;
 157         }
 158         hdev->type = HDA_DEV_ASOC;
 159         hdev->dev.release = default_release;
 160
 161         ret = snd_hdac_device_register(hdev);
 162         if (ret) {
 163                 dev_err(bus->dev, "failed to register hdac device\n");
 164                 snd_hdac_ext_bus_device_exit(hdev);
 165                 return ret;
 166         }
 167
 168         return 0;
 169 }
 170 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_device_init);
 171
 172 /**
 173  * snd_hdac_ext_bus_device_exit - clean up a HD-audio extended codec base device
 174  * @hdev: hdac device to clean up
 175  */
 176 void snd_hdac_ext_bus_device_exit(struct hdac_device *hdev)
 177 {
 178         struct hdac_ext_device *edev = to_ehdac_device(hdev);
 179
 180         snd_hdac_device_exit(hdev);
 181         kfree(edev);
 182 }
 183 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_device_exit);
 184
 185 /**
 186  * snd_hdac_ext_bus_device_remove - remove HD-audio extended codec base devices
 187  *
 188  * @ebus: HD-audio extended bus
 189  */
 190 void snd_hdac_ext_bus_device_remove(struct hdac_ext_bus *ebus)
 191 {
 192         struct hdac_device *codec, *__codec;
 193         /*
 194          * we need to remove all the codec devices objects created in the
 195          * snd_hdac_ext_bus_device_init
 196          */
 197         list_for_each_entry_safe(codec, __codec, &ebus->bus.codec_list, list) {
 198                 snd_hdac_device_unregister(codec);
 199                 put_device(&codec->dev);
 200         }
 201 }
 202 EXPORT_SYMBOL_GPL(snd_hdac_ext_bus_device_remove);
 203 #define dev_to_hdac(dev) (container_of((dev), \
 204                         struct hdac_device, dev))
 205
 206 static inline struct hdac_ext_driver *get_edrv(struct device *dev)
 207 {
 208         struct hdac_driver *hdrv = drv_to_hdac_driver(dev->driver);
 209         struct hdac_ext_driver *edrv = to_ehdac_driver(hdrv);
 210
 211         return edrv;
 212 }
 213
 214 static inline struct hdac_ext_device *get_edev(struct device *dev)
 215 {
 216         struct hdac_device *hdev = dev_to_hdac_dev(dev);
 217         struct hdac_ext_device *edev = to_ehdac_device(hdev);
 218
 219         return edev;
 220 }
 221
 222 static int hda_ext_drv_probe(struct device *dev)
 223 {
 224         return (get_edrv(dev))->probe(get_edev(dev));
 225 }
 226
 227 static int hdac_ext_drv_remove(struct device *dev)
 228 {
 229         return (get_edrv(dev))->remove(get_edev(dev));
 230 }
 231
 232 static void hdac_ext_drv_shutdown(struct device *dev)
 233 {
 234         return (get_edrv(dev))->shutdown(get_edev(dev));
 235 }
 236
 237 /**
 238  * snd_hda_ext_driver_register - register a driver for ext hda devices
 239  *
 240  * @drv: ext hda driver structure
 241  */
 242 int snd_hda_ext_driver_register(struct hdac_ext_driver *drv)
 243 {
 244         drv->hdac.type = HDA_DEV_ASOC;
 245         drv->hdac.driver.bus = &snd_hda_bus_type;
 246         /* we use default match */
 247
 248         if (drv->probe)
 249                 drv->hdac.driver.probe = hda_ext_drv_probe;
 250         if (drv->remove)
 251                 drv->hdac.driver.remove = hdac_ext_drv_remove;
 252         if (drv->shutdown)
 253                 drv->hdac.driver.shutdown = hdac_ext_drv_shutdown;
 254
 255         return driver_register(&drv->hdac.driver);
 256 }
 257 EXPORT_SYMBOL_GPL(snd_hda_ext_driver_register);
 258
 259 /**
 260  * snd_hda_ext_driver_unregister - unregister a driver for ext hda devices
 261  *
 262  * @drv: ext hda driver structure
 263  */
 264 void snd_hda_ext_driver_unregister(struct hdac_ext_driver *drv)
 265 {
 266         driver_unregister(&drv->hdac.driver);
 267 }
 268 EXPORT_SYMBOL_GPL(snd_hda_ext_driver_unregister);