// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (C) 2016 Robert Jarzmik <robert.jarzmik@free.fr> */ #include <linux/list.h> #include <linux/slab.h> #include <sound/ac97/codec.h> #include <sound/ac97/compat.h> #include <sound/ac97/controller.h> #include <sound/soc.h> #include "ac97_core.h" static void compat_ac97_release(struct device *dev) { kfree(to_ac97_t(dev)); } static void compat_ac97_reset(struct snd_ac97 *ac97) { struct ac97_codec_device *adev = to_ac97_device(ac97->private_data); struct ac97_controller *actrl = adev->ac97_ctrl; if (actrl->ops->reset) actrl->ops->reset(actrl); } static void compat_ac97_warm_reset(struct snd_ac97 *ac97) { struct ac97_codec_device *adev = to_ac97_device(ac97->private_data); struct ac97_controller *actrl = adev->ac97_ctrl; if (actrl->ops->warm_reset) actrl->ops->warm_reset(actrl); } static void compat_ac97_write(struct snd_ac97 *ac97, unsigned short reg, unsigned short val) { struct ac97_codec_device *adev = to_ac97_device(ac97->private_data); struct ac97_controller *actrl = adev->ac97_ctrl; actrl->ops->write(actrl, ac97->num, reg, val); } static unsigned short compat_ac97_read(struct snd_ac97 *ac97, unsigned short reg) { struct ac97_codec_device *adev = to_ac97_device(ac97->private_data); struct ac97_controller *actrl = adev->ac97_ctrl; return actrl->ops->read(actrl, ac97->num, reg); } static const struct snd_ac97_bus_ops compat_snd_ac97_bus_ops = { .reset = compat_ac97_reset, .warm_reset = compat_ac97_warm_reset, .write = compat_ac97_write, .read = compat_ac97_read, }; static struct snd_ac97_bus compat_soc_ac97_bus = { .ops = &compat_snd_ac97_bus_ops, }; struct snd_ac97 *snd_ac97_compat_alloc(struct ac97_codec_device *adev) { struct snd_ac97 *ac97; int ret; ac97 = kzalloc(sizeof(struct snd_ac97), GFP_KERNEL); if (ac97 == NULL) return ERR_PTR(-ENOMEM); ac97->private_data = adev; ac97->bus = &compat_soc_ac97_bus; ac97->dev.parent = &adev->dev; ac97->dev.release = compat_ac97_release; dev_set_name(&ac97->dev, "%s-compat", dev_name(&adev->dev)); ret = device_register(&ac97->dev); if (ret) { put_device(&ac97->dev); return ERR_PTR(ret); } return ac97; } EXPORT_SYMBOL_GPL(snd_ac97_compat_alloc); void snd_ac97_compat_release(struct snd_ac97 *ac97) { device_unregister(&ac97->dev); } EXPORT_SYMBOL_GPL(snd_ac97_compat_release); int snd_ac97_reset(struct snd_ac97 *ac97, bool try_warm, unsigned int id, unsigned int id_mask) { struct ac97_codec_device *adev = to_ac97_device(ac97->private_data); struct ac97_controller *actrl = adev->ac97_ctrl; unsigned int scanned; if (try_warm) { compat_ac97_warm_reset(ac97); scanned = snd_ac97_bus_scan_one(actrl, adev->num); if (ac97_ids_match(scanned, adev->vendor_id, id_mask)) return 1; } compat_ac97_reset(ac97); compat_ac97_warm_reset(ac97); scanned = snd_ac97_bus_scan_one(actrl, adev->num); if (ac97_ids_match(scanned, adev->vendor_id, id_mask)) return 0; return -ENODEV; } EXPORT_SYMBOL_GPL(snd_ac97_reset);