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