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