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 15 static void compat_ac97_release(struct device *dev) 16 { 17 kfree(to_ac97_t(dev)); 18 } 19 20 static 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 29 static 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 38 static 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 47 static 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 56 static 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 63 static struct snd_ac97_bus compat_soc_ac97_bus = { 64 .ops = &compat_snd_ac97_bus_ops, 65 }; 66 67 struct 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 } 90 EXPORT_SYMBOL_GPL(snd_ac97_compat_alloc); 91 92 void snd_ac97_compat_release(struct snd_ac97 *ac97) 93 { 94 device_unregister(&ac97->dev); 95 } 96 EXPORT_SYMBOL_GPL(snd_ac97_compat_release); 97 98 int 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 } 120 EXPORT_SYMBOL_GPL(snd_ac97_reset); 121