xref: /openbmc/linux/sound/drivers/opl4/opl4_lib.c (revision 34273b23)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Functions for accessing OPL4 devices
4  * Copyright (c) 2003 by Clemens Ladisch <clemens@ladisch.de>
5  */
6 
7 #include "opl4_local.h"
8 #include <sound/initval.h>
9 #include <linux/ioport.h>
10 #include <linux/slab.h>
11 #include <linux/init.h>
12 #include <linux/module.h>
13 #include <linux/io.h>
14 
15 MODULE_AUTHOR("Clemens Ladisch <clemens@ladisch.de>");
16 MODULE_DESCRIPTION("OPL4 driver");
17 MODULE_LICENSE("GPL");
18 
snd_opl4_wait(struct snd_opl4 * opl4)19 static inline void snd_opl4_wait(struct snd_opl4 *opl4)
20 {
21 	int timeout = 10;
22 	while ((inb(opl4->fm_port) & OPL4_STATUS_BUSY) && --timeout > 0)
23 		;
24 }
25 
snd_opl4_write(struct snd_opl4 * opl4,u8 reg,u8 value)26 void snd_opl4_write(struct snd_opl4 *opl4, u8 reg, u8 value)
27 {
28 	snd_opl4_wait(opl4);
29 	outb(reg, opl4->pcm_port);
30 
31 	snd_opl4_wait(opl4);
32 	outb(value, opl4->pcm_port + 1);
33 }
34 
35 EXPORT_SYMBOL(snd_opl4_write);
36 
snd_opl4_read(struct snd_opl4 * opl4,u8 reg)37 u8 snd_opl4_read(struct snd_opl4 *opl4, u8 reg)
38 {
39 	snd_opl4_wait(opl4);
40 	outb(reg, opl4->pcm_port);
41 
42 	snd_opl4_wait(opl4);
43 	return inb(opl4->pcm_port + 1);
44 }
45 
46 EXPORT_SYMBOL(snd_opl4_read);
47 
snd_opl4_read_memory(struct snd_opl4 * opl4,char * buf,int offset,int size)48 void snd_opl4_read_memory(struct snd_opl4 *opl4, char *buf, int offset, int size)
49 {
50 	unsigned long flags;
51 	u8 memcfg;
52 
53 	spin_lock_irqsave(&opl4->reg_lock, flags);
54 
55 	memcfg = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION);
56 	snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg | OPL4_MODE_BIT);
57 
58 	snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_HIGH, offset >> 16);
59 	snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_MID, offset >> 8);
60 	snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_LOW, offset);
61 
62 	snd_opl4_wait(opl4);
63 	outb(OPL4_REG_MEMORY_DATA, opl4->pcm_port);
64 	snd_opl4_wait(opl4);
65 	insb(opl4->pcm_port + 1, buf, size);
66 
67 	snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg);
68 
69 	spin_unlock_irqrestore(&opl4->reg_lock, flags);
70 }
71 
72 EXPORT_SYMBOL(snd_opl4_read_memory);
73 
snd_opl4_write_memory(struct snd_opl4 * opl4,const char * buf,int offset,int size)74 void snd_opl4_write_memory(struct snd_opl4 *opl4, const char *buf, int offset, int size)
75 {
76 	unsigned long flags;
77 	u8 memcfg;
78 
79 	spin_lock_irqsave(&opl4->reg_lock, flags);
80 
81 	memcfg = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION);
82 	snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg | OPL4_MODE_BIT);
83 
84 	snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_HIGH, offset >> 16);
85 	snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_MID, offset >> 8);
86 	snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_LOW, offset);
87 
88 	snd_opl4_wait(opl4);
89 	outb(OPL4_REG_MEMORY_DATA, opl4->pcm_port);
90 	snd_opl4_wait(opl4);
91 	outsb(opl4->pcm_port + 1, buf, size);
92 
93 	snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg);
94 
95 	spin_unlock_irqrestore(&opl4->reg_lock, flags);
96 }
97 
98 EXPORT_SYMBOL(snd_opl4_write_memory);
99 
snd_opl4_enable_opl4(struct snd_opl4 * opl4)100 static void snd_opl4_enable_opl4(struct snd_opl4 *opl4)
101 {
102 	outb(OPL3_REG_MODE, opl4->fm_port + 2);
103 	inb(opl4->fm_port);
104 	inb(opl4->fm_port);
105 	outb(OPL3_OPL3_ENABLE | OPL3_OPL4_ENABLE, opl4->fm_port + 3);
106 	inb(opl4->fm_port);
107 	inb(opl4->fm_port);
108 }
109 
snd_opl4_detect(struct snd_opl4 * opl4)110 static int snd_opl4_detect(struct snd_opl4 *opl4)
111 {
112 	u8 id1, id2;
113 
114 	snd_opl4_enable_opl4(opl4);
115 
116 	id1 = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION);
117 	snd_printdd("OPL4[02]=%02x\n", id1);
118 	switch (id1 & OPL4_DEVICE_ID_MASK) {
119 	case 0x20:
120 		opl4->hardware = OPL3_HW_OPL4;
121 		break;
122 	case 0x40:
123 		opl4->hardware = OPL3_HW_OPL4_ML;
124 		break;
125 	default:
126 		return -ENODEV;
127 	}
128 
129 	snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_FM, 0x00);
130 	snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_PCM, 0xff);
131 	id1 = snd_opl4_read(opl4, OPL4_REG_MIX_CONTROL_FM);
132 	id2 = snd_opl4_read(opl4, OPL4_REG_MIX_CONTROL_PCM);
133 	snd_printdd("OPL4 id1=%02x id2=%02x\n", id1, id2);
134        	if (id1 != 0x00 || id2 != 0xff)
135 		return -ENODEV;
136 
137 	snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_FM, 0x3f);
138 	snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_PCM, 0x3f);
139 	snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, 0x00);
140 	return 0;
141 }
142 
143 #if IS_ENABLED(CONFIG_SND_SEQUENCER)
snd_opl4_seq_dev_free(struct snd_seq_device * seq_dev)144 static void snd_opl4_seq_dev_free(struct snd_seq_device *seq_dev)
145 {
146 	struct snd_opl4 *opl4 = seq_dev->private_data;
147 	opl4->seq_dev = NULL;
148 }
149 
snd_opl4_create_seq_dev(struct snd_opl4 * opl4,int seq_device)150 static int snd_opl4_create_seq_dev(struct snd_opl4 *opl4, int seq_device)
151 {
152 	opl4->seq_dev_num = seq_device;
153 	if (snd_seq_device_new(opl4->card, seq_device, SNDRV_SEQ_DEV_ID_OPL4,
154 			       sizeof(struct snd_opl4 *), &opl4->seq_dev) >= 0) {
155 		strcpy(opl4->seq_dev->name, "OPL4 Wavetable");
156 		*(struct snd_opl4 **)SNDRV_SEQ_DEVICE_ARGPTR(opl4->seq_dev) = opl4;
157 		opl4->seq_dev->private_data = opl4;
158 		opl4->seq_dev->private_free = snd_opl4_seq_dev_free;
159 	}
160 	return 0;
161 }
162 #endif
163 
snd_opl4_free(struct snd_opl4 * opl4)164 static void snd_opl4_free(struct snd_opl4 *opl4)
165 {
166 	snd_opl4_free_proc(opl4);
167 	release_and_free_resource(opl4->res_fm_port);
168 	release_and_free_resource(opl4->res_pcm_port);
169 	kfree(opl4);
170 }
171 
snd_opl4_dev_free(struct snd_device * device)172 static int snd_opl4_dev_free(struct snd_device *device)
173 {
174 	struct snd_opl4 *opl4 = device->device_data;
175 	snd_opl4_free(opl4);
176 	return 0;
177 }
178 
snd_opl4_create(struct snd_card * card,unsigned long fm_port,unsigned long pcm_port,int seq_device,struct snd_opl3 ** ropl3,struct snd_opl4 ** ropl4)179 int snd_opl4_create(struct snd_card *card,
180 		    unsigned long fm_port, unsigned long pcm_port,
181 		    int seq_device,
182 		    struct snd_opl3 **ropl3, struct snd_opl4 **ropl4)
183 {
184 	struct snd_opl4 *opl4;
185 	struct snd_opl3 *opl3;
186 	int err;
187 	static const struct snd_device_ops ops = {
188 		.dev_free = snd_opl4_dev_free
189 	};
190 
191 	if (ropl3)
192 		*ropl3 = NULL;
193 	if (ropl4)
194 		*ropl4 = NULL;
195 
196 	opl4 = kzalloc(sizeof(*opl4), GFP_KERNEL);
197 	if (!opl4)
198 		return -ENOMEM;
199 
200 	opl4->res_fm_port = request_region(fm_port, 8, "OPL4 FM");
201 	opl4->res_pcm_port = request_region(pcm_port, 8, "OPL4 PCM/MIX");
202 	if (!opl4->res_fm_port || !opl4->res_pcm_port) {
203 		snd_printk(KERN_ERR "opl4: can't grab ports 0x%lx, 0x%lx\n", fm_port, pcm_port);
204 		snd_opl4_free(opl4);
205 		return -EBUSY;
206 	}
207 
208 	opl4->card = card;
209 	opl4->fm_port = fm_port;
210 	opl4->pcm_port = pcm_port;
211 	spin_lock_init(&opl4->reg_lock);
212 	mutex_init(&opl4->access_mutex);
213 
214 	err = snd_opl4_detect(opl4);
215 	if (err < 0) {
216 		snd_opl4_free(opl4);
217 		snd_printd("OPL4 chip not detected at %#lx/%#lx\n", fm_port, pcm_port);
218 		return err;
219 	}
220 
221 	err = snd_device_new(card, SNDRV_DEV_CODEC, opl4, &ops);
222 	if (err < 0) {
223 		snd_opl4_free(opl4);
224 		return err;
225 	}
226 
227 	err = snd_opl3_create(card, fm_port, fm_port + 2, opl4->hardware, 1, &opl3);
228 	if (err < 0) {
229 		snd_device_free(card, opl4);
230 		return err;
231 	}
232 
233 	/* opl3 initialization disabled opl4, so reenable */
234 	snd_opl4_enable_opl4(opl4);
235 
236 	snd_opl4_create_mixer(opl4);
237 	snd_opl4_create_proc(opl4);
238 
239 #if IS_ENABLED(CONFIG_SND_SEQUENCER)
240 	opl4->seq_client = -1;
241 	if (opl4->hardware < OPL3_HW_OPL4_ML)
242 		snd_opl4_create_seq_dev(opl4, seq_device);
243 #endif
244 
245 	if (ropl3)
246 		*ropl3 = opl3;
247 	if (ropl4)
248 		*ropl4 = opl4;
249 	return 0;
250 }
251 
252 EXPORT_SYMBOL(snd_opl4_create);
253