sound/ac97/snd_ac97_compat.c

   1 /*
   2  *  Copyright (C) 2016 Robert Jarzmik <robert.jarzmik@free.fr>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  */
   8
   9 #include <linux/list.h>
  10 #include <linux/slab.h>
  11 #include <sound/ac97/codec.h>
  12 #include <sound/ac97/compat.h>
  13 #include <sound/ac97/controller.h>
  14 #include <sound/soc.h>
  15
  16 #include "ac97_core.h"
  17
  18 static void compat_ac97_release(struct device *dev)
  19 {
  20         kfree(to_ac97_t(dev));
  21 }
  22
  23 static void compat_ac97_reset(struct snd_ac97 *ac97)
  24 {
  25         struct ac97_codec_device *adev = to_ac97_device(ac97->private_data);
  26         struct ac97_controller *actrl = adev->ac97_ctrl;
  27
  28         if (actrl->ops->reset)
  29                 actrl->ops->reset(actrl);
  30 }
  31
  32 static void compat_ac97_warm_reset(struct snd_ac97 *ac97)
  33 {
  34         struct ac97_codec_device *adev = to_ac97_device(ac97->private_data);
  35         struct ac97_controller *actrl = adev->ac97_ctrl;
  36
  37         if (actrl->ops->warm_reset)
  38                 actrl->ops->warm_reset(actrl);
  39 }
  40
  41 static void compat_ac97_write(struct snd_ac97 *ac97, unsigned short reg,
  42                               unsigned short val)
  43 {
  44         struct ac97_codec_device *adev = to_ac97_device(ac97->private_data);
  45         struct ac97_controller *actrl = adev->ac97_ctrl;
  46
  47         actrl->ops->write(actrl, ac97->num, reg, val);
  48 }
  49
  50 static unsigned short compat_ac97_read(struct snd_ac97 *ac97,
  51                                        unsigned short reg)
  52 {
  53         struct ac97_codec_device *adev = to_ac97_device(ac97->private_data);
  54         struct ac97_controller *actrl = adev->ac97_ctrl;
  55
  56         return actrl->ops->read(actrl, ac97->num, reg);
  57 }
  58
  59 static struct snd_ac97_bus_ops compat_snd_ac97_bus_ops = {
  60         .reset = compat_ac97_reset,
  61         .warm_reset = compat_ac97_warm_reset,
  62         .write = compat_ac97_write,
  63         .read = compat_ac97_read,
  64 };
  65
  66 static struct snd_ac97_bus compat_soc_ac97_bus = {
  67         .ops = &compat_snd_ac97_bus_ops,
  68 };
  69
  70 struct snd_ac97 *snd_ac97_compat_alloc(struct ac97_codec_device *adev)
  71 {
  72         struct snd_ac97 *ac97;
  73         int ret;
  74
  75         ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL);
  76         if (ac97 == NULL)
  77                 return ERR_PTR(-ENOMEM);
  78
  79         ac97->private_data = adev;
  80         ac97->bus = &compat_soc_ac97_bus;
  81
  82         ac97->dev.parent = &adev->dev;
  83         ac97->dev.release = compat_ac97_release;
  84         dev_set_name(&ac97->dev, "%s-compat", dev_name(&adev->dev));
  85         ret = device_register(&ac97->dev);
  86         if (ret) {
  87                 put_device(&ac97->dev);
  88                 return ERR_PTR(ret);
  89         }
  90
  91         return ac97;
  92 }
  93 EXPORT_SYMBOL_GPL(snd_ac97_compat_alloc);
  94
  95 void snd_ac97_compat_release(struct snd_ac97 *ac97)
  96 {
  97         device_unregister(&ac97->dev);
  98 }
  99 EXPORT_SYMBOL_GPL(snd_ac97_compat_release);
 100
 101 int snd_ac97_reset(struct snd_ac97 *ac97, bool try_warm, unsigned int id,
 102         unsigned int id_mask)
 103 {
 104         struct ac97_codec_device *adev = to_ac97_device(ac97->private_data);
 105         struct ac97_controller *actrl = adev->ac97_ctrl;
 106         unsigned int scanned;
 107
 108         if (try_warm) {
 109                 compat_ac97_warm_reset(ac97);
 110                 scanned = snd_ac97_bus_scan_one(actrl, adev->num);
 111                 if (ac97_ids_match(scanned, adev->vendor_id, id_mask))
 112                         return 1;
 113         }
 114
 115         compat_ac97_reset(ac97);
 116         compat_ac97_warm_reset(ac97);
 117         scanned = snd_ac97_bus_scan_one(actrl, adev->num);
 118         if (ac97_ids_match(scanned, adev->vendor_id, id_mask))
 119                 return 0;
 120
 121         return -ENODEV;
 122 }
 123 EXPORT_SYMBOL_GPL(snd_ac97_reset);