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
compat_ac97_release(struct device * dev)15 static void compat_ac97_release(struct device *dev)
16 {
17 kfree(to_ac97_t(dev));
18 }
19
compat_ac97_reset(struct snd_ac97 * ac97)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
compat_ac97_warm_reset(struct snd_ac97 * ac97)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
compat_ac97_write(struct snd_ac97 * ac97,unsigned short reg,unsigned short val)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
compat_ac97_read(struct snd_ac97 * ac97,unsigned short reg)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
snd_ac97_compat_alloc(struct ac97_codec_device * adev)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
snd_ac97_compat_release(struct snd_ac97 * ac97)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
snd_ac97_reset(struct snd_ac97 * ac97,bool try_warm,unsigned int id,unsigned int id_mask)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