1/* 2 * Functions for accessing OPL4 devices 3 * Copyright (c) 2003 by Clemens Ladisch <clemens@ladisch.de> 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License as published by 7 * the Free Software Foundation; either version 2 of the License, or 8 * (at your option) any later version. 9 * 10 * This program is distributed in the hope that it will be useful, 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13 * GNU General Public License for more details. 14 * 15 * You should have received a copy of the GNU General Public License 16 * along with this program; if not, write to the Free Software 17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 18 */ 19 20#include "opl4_local.h" 21#include <sound/initval.h> 22#include <linux/ioport.h> 23#include <linux/slab.h> 24#include <linux/init.h> 25#include <asm/io.h> 26 27MODULE_AUTHOR("Clemens Ladisch <clemens@ladisch.de>"); 28MODULE_DESCRIPTION("OPL4 driver"); 29MODULE_LICENSE("GPL"); 30 31static void inline snd_opl4_wait(struct snd_opl4 *opl4) 32{ 33 int timeout = 10; 34 while ((inb(opl4->fm_port) & OPL4_STATUS_BUSY) && --timeout > 0) 35 ; 36} 37 38void snd_opl4_write(struct snd_opl4 *opl4, u8 reg, u8 value) 39{ 40 snd_opl4_wait(opl4); 41 outb(reg, opl4->pcm_port); 42 43 snd_opl4_wait(opl4); 44 outb(value, opl4->pcm_port + 1); 45} 46 47EXPORT_SYMBOL(snd_opl4_write); 48 49u8 snd_opl4_read(struct snd_opl4 *opl4, u8 reg) 50{ 51 snd_opl4_wait(opl4); 52 outb(reg, opl4->pcm_port); 53 54 snd_opl4_wait(opl4); 55 return inb(opl4->pcm_port + 1); 56} 57 58EXPORT_SYMBOL(snd_opl4_read); 59 60void snd_opl4_read_memory(struct snd_opl4 *opl4, char *buf, int offset, int size) 61{ 62 unsigned long flags; 63 u8 memcfg; 64 65 spin_lock_irqsave(&opl4->reg_lock, flags); 66 67 memcfg = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION); 68 snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg | OPL4_MODE_BIT); 69 70 snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_HIGH, offset >> 16); 71 snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_MID, offset >> 8); 72 snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_LOW, offset); 73 74 snd_opl4_wait(opl4); 75 outb(OPL4_REG_MEMORY_DATA, opl4->pcm_port); 76 snd_opl4_wait(opl4); 77 insb(opl4->pcm_port + 1, buf, size); 78 79 snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg); 80 81 spin_unlock_irqrestore(&opl4->reg_lock, flags); 82} 83 84EXPORT_SYMBOL(snd_opl4_read_memory); 85 86void snd_opl4_write_memory(struct snd_opl4 *opl4, const char *buf, int offset, int size) 87{ 88 unsigned long flags; 89 u8 memcfg; 90 91 spin_lock_irqsave(&opl4->reg_lock, flags); 92 93 memcfg = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION); 94 snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg | OPL4_MODE_BIT); 95 96 snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_HIGH, offset >> 16); 97 snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_MID, offset >> 8); 98 snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_LOW, offset); 99 100 snd_opl4_wait(opl4); 101 outb(OPL4_REG_MEMORY_DATA, opl4->pcm_port); 102 snd_opl4_wait(opl4); 103 outsb(opl4->pcm_port + 1, buf, size); 104 105 snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg); 106 107 spin_unlock_irqrestore(&opl4->reg_lock, flags); 108} 109 110EXPORT_SYMBOL(snd_opl4_write_memory); 111 112static void snd_opl4_enable_opl4(struct snd_opl4 *opl4) 113{ 114 outb(OPL3_REG_MODE, opl4->fm_port + 2); 115 inb(opl4->fm_port); 116 inb(opl4->fm_port); 117 outb(OPL3_OPL3_ENABLE | OPL3_OPL4_ENABLE, opl4->fm_port + 3); 118 inb(opl4->fm_port); 119 inb(opl4->fm_port); 120} 121 122static int snd_opl4_detect(struct snd_opl4 *opl4) 123{ 124 u8 id1, id2; 125 126 snd_opl4_enable_opl4(opl4); 127 128 id1 = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION); 129 snd_printdd("OPL4[02]=%02x\n", id1); 130 switch (id1 & OPL4_DEVICE_ID_MASK) { 131 case 0x20: 132 opl4->hardware = OPL3_HW_OPL4; 133 break; 134 case 0x40: 135 opl4->hardware = OPL3_HW_OPL4_ML; 136 break; 137 default: 138 return -ENODEV; 139 } 140 141 snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_FM, 0x00); 142 snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_PCM, 0xff); 143 id1 = snd_opl4_read(opl4, OPL4_REG_MIX_CONTROL_FM); 144 id2 = snd_opl4_read(opl4, OPL4_REG_MIX_CONTROL_PCM); 145 snd_printdd("OPL4 id1=%02x id2=%02x\n", id1, id2); 146 if (id1 != 0x00 || id2 != 0xff) 147 return -ENODEV; 148 149 snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_FM, 0x3f); 150 snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_PCM, 0x3f); 151 snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, 0x00); 152 return 0; 153} 154 155#if defined(CONFIG_SND_SEQUENCER) || (defined(MODULE) && \ 156 defined(CONFIG_SND_SEQUENCER_MODULE)) 157static void snd_opl4_seq_dev_free(struct snd_seq_device *seq_dev) 158{ 159 struct snd_opl4 *opl4 = seq_dev->private_data; 160 opl4->seq_dev = NULL; 161} 162 163static int snd_opl4_create_seq_dev(struct snd_opl4 *opl4, int seq_device) 164{ 165 opl4->seq_dev_num = seq_device; 166 if (snd_seq_device_new(opl4->card, seq_device, SNDRV_SEQ_DEV_ID_OPL4, 167 sizeof(struct snd_opl4 *), &opl4->seq_dev) >= 0) { 168 strcpy(opl4->seq_dev->name, "OPL4 Wavetable"); 169 *(struct snd_opl4 **)SNDRV_SEQ_DEVICE_ARGPTR(opl4->seq_dev) = opl4; 170 opl4->seq_dev->private_data = opl4; 171 opl4->seq_dev->private_free = snd_opl4_seq_dev_free; 172 } 173 return 0; 174} 175#endif 176 177static void snd_opl4_free(struct snd_opl4 *opl4) 178{ 179#ifdef CONFIG_PROC_FS 180 snd_opl4_free_proc(opl4); 181#endif 182 release_and_free_resource(opl4->res_fm_port); 183 release_and_free_resource(opl4->res_pcm_port); 184 kfree(opl4); 185} 186 187static int snd_opl4_dev_free(struct snd_device *device) 188{ 189 struct snd_opl4 *opl4 = device->device_data; 190 snd_opl4_free(opl4); 191 return 0; 192} 193 194int snd_opl4_create(struct snd_card *card, 195 unsigned long fm_port, unsigned long pcm_port, 196 int seq_device, 197 struct snd_opl3 **ropl3, struct snd_opl4 **ropl4) 198{ 199 struct snd_opl4 *opl4; 200 struct snd_opl3 *opl3; 201 int err; 202 static struct snd_device_ops ops = { 203 .dev_free = snd_opl4_dev_free 204 }; 205 206 if (ropl3) 207 *ropl3 = NULL; 208 if (ropl4) 209 *ropl4 = NULL; 210 211 opl4 = kzalloc(sizeof(*opl4), GFP_KERNEL); 212 if (!opl4) 213 return -ENOMEM; 214 215 opl4->res_fm_port = request_region(fm_port, 8, "OPL4 FM"); 216 opl4->res_pcm_port = request_region(pcm_port, 8, "OPL4 PCM/MIX"); 217 if (!opl4->res_fm_port || !opl4->res_pcm_port) { 218 snd_printk(KERN_ERR "opl4: can't grab ports 0x%lx, 0x%lx\n", fm_port, pcm_port); 219 snd_opl4_free(opl4); 220 return -EBUSY; 221 } 222 223 opl4->card = card; 224 opl4->fm_port = fm_port; 225 opl4->pcm_port = pcm_port; 226 spin_lock_init(&opl4->reg_lock); 227 mutex_init(&opl4->access_mutex); 228 229 err = snd_opl4_detect(opl4); 230 if (err < 0) { 231 snd_opl4_free(opl4); 232 snd_printd("OPL4 chip not detected at %#lx/%#lx\n", fm_port, pcm_port); 233 return err; 234 } 235 236 err = snd_device_new(card, SNDRV_DEV_CODEC, opl4, &ops); 237 if (err < 0) { 238 snd_opl4_free(opl4); 239 return err; 240 } 241 242 err = snd_opl3_create(card, fm_port, fm_port + 2, opl4->hardware, 1, &opl3); 243 if (err < 0) { 244 snd_device_free(card, opl4); 245 return err; 246 } 247 248 /* opl3 initialization disabled opl4, so reenable */ 249 snd_opl4_enable_opl4(opl4); 250 251 snd_opl4_create_mixer(opl4); 252#ifdef CONFIG_PROC_FS 253 snd_opl4_create_proc(opl4); 254#endif 255 256#if defined(CONFIG_SND_SEQUENCER) || (defined(MODULE) && \ 257 defined(CONFIG_SND_SEQUENCER_MODULE)) 258 opl4->seq_client = -1; 259 if (opl4->hardware < OPL3_HW_OPL4_ML) 260 snd_opl4_create_seq_dev(opl4, seq_device); 261#endif 262 263 if (ropl3) 264 *ropl3 = opl3; 265 if (ropl4) 266 *ropl4 = opl4; 267 return 0; 268} 269 270EXPORT_SYMBOL(snd_opl4_create); 271 272static int __init alsa_opl4_init(void) 273{ 274 return 0; 275} 276 277static void __exit alsa_opl4_exit(void) 278{ 279} 280 281module_init(alsa_opl4_init) 282module_exit(alsa_opl4_exit) 283