/* * Functions for accessing OPL4 devices * Copyright (c) 2003 by Clemens Ladisch * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include "opl4_local.h" #include #include #include #include MODULE_AUTHOR("Clemens Ladisch "); MODULE_DESCRIPTION("OPL4 driver"); MODULE_LICENSE("GPL"); static void inline snd_opl4_wait(opl4_t *opl4) { int timeout = 10; while ((inb(opl4->fm_port) & OPL4_STATUS_BUSY) && --timeout > 0) ; } void snd_opl4_write(opl4_t *opl4, u8 reg, u8 value) { snd_opl4_wait(opl4); outb(reg, opl4->pcm_port); snd_opl4_wait(opl4); outb(value, opl4->pcm_port + 1); } u8 snd_opl4_read(opl4_t *opl4, u8 reg) { snd_opl4_wait(opl4); outb(reg, opl4->pcm_port); snd_opl4_wait(opl4); return inb(opl4->pcm_port + 1); } void snd_opl4_read_memory(opl4_t *opl4, char *buf, int offset, int size) { unsigned long flags; u8 memcfg; spin_lock_irqsave(&opl4->reg_lock, flags); memcfg = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION); snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg | OPL4_MODE_BIT); snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_HIGH, offset >> 16); snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_MID, offset >> 8); snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_LOW, offset); snd_opl4_wait(opl4); outb(OPL4_REG_MEMORY_DATA, opl4->pcm_port); snd_opl4_wait(opl4); insb(opl4->pcm_port + 1, buf, size); snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg); spin_unlock_irqrestore(&opl4->reg_lock, flags); } void snd_opl4_write_memory(opl4_t *opl4, const char *buf, int offset, int size) { unsigned long flags; u8 memcfg; spin_lock_irqsave(&opl4->reg_lock, flags); memcfg = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION); snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg | OPL4_MODE_BIT); snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_HIGH, offset >> 16); snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_MID, offset >> 8); snd_opl4_write(opl4, OPL4_REG_MEMORY_ADDRESS_LOW, offset); snd_opl4_wait(opl4); outb(OPL4_REG_MEMORY_DATA, opl4->pcm_port); snd_opl4_wait(opl4); outsb(opl4->pcm_port + 1, buf, size); snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, memcfg); spin_unlock_irqrestore(&opl4->reg_lock, flags); } static void snd_opl4_enable_opl4(opl4_t *opl4) { outb(OPL3_REG_MODE, opl4->fm_port + 2); inb(opl4->fm_port); inb(opl4->fm_port); outb(OPL3_OPL3_ENABLE | OPL3_OPL4_ENABLE, opl4->fm_port + 3); inb(opl4->fm_port); inb(opl4->fm_port); } static int snd_opl4_detect(opl4_t *opl4) { u8 id1, id2; snd_opl4_enable_opl4(opl4); id1 = snd_opl4_read(opl4, OPL4_REG_MEMORY_CONFIGURATION); snd_printdd("OPL4[02]=%02x\n", id1); switch (id1 & OPL4_DEVICE_ID_MASK) { case 0x20: opl4->hardware = OPL3_HW_OPL4; break; case 0x40: opl4->hardware = OPL3_HW_OPL4_ML; break; default: return -ENODEV; } snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_FM, 0x00); snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_PCM, 0xff); id1 = snd_opl4_read(opl4, OPL4_REG_MIX_CONTROL_FM); id2 = snd_opl4_read(opl4, OPL4_REG_MIX_CONTROL_PCM); snd_printdd("OPL4 id1=%02x id2=%02x\n", id1, id2); if (id1 != 0x00 || id2 != 0xff) return -ENODEV; snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_FM, 0x3f); snd_opl4_write(opl4, OPL4_REG_MIX_CONTROL_PCM, 0x3f); snd_opl4_write(opl4, OPL4_REG_MEMORY_CONFIGURATION, 0x00); return 0; } #if defined(CONFIG_SND_SEQUENCER) || (defined(MODULE) && defined(CONFIG_SND_SEQUENCER_MODULE)) static void snd_opl4_seq_dev_free(snd_seq_device_t *seq_dev) { opl4_t *opl4 = seq_dev->private_data; opl4->seq_dev = NULL; } static int snd_opl4_create_seq_dev(opl4_t *opl4, int seq_device) { opl4->seq_dev_num = seq_device; if (snd_seq_device_new(opl4->card, seq_device, SNDRV_SEQ_DEV_ID_OPL4, sizeof(opl4_t *), &opl4->seq_dev) >= 0) { strcpy(opl4->seq_dev->name, "OPL4 Wavetable"); *(opl4_t **)SNDRV_SEQ_DEVICE_ARGPTR(opl4->seq_dev) = opl4; opl4->seq_dev->private_data = opl4; opl4->seq_dev->private_free = snd_opl4_seq_dev_free; } return 0; } #endif static void snd_opl4_free(opl4_t *opl4) { #ifdef CONFIG_PROC_FS snd_opl4_free_proc(opl4); #endif if (opl4->res_fm_port) { release_resource(opl4->res_fm_port); kfree_nocheck(opl4->res_fm_port); } if (opl4->res_pcm_port) { release_resource(opl4->res_pcm_port); kfree_nocheck(opl4->res_pcm_port); } kfree(opl4); } static int snd_opl4_dev_free(snd_device_t *device) { opl4_t *opl4 = device->device_data; snd_opl4_free(opl4); return 0; } int snd_opl4_create(snd_card_t *card, unsigned long fm_port, unsigned long pcm_port, int seq_device, opl3_t **ropl3, opl4_t **ropl4) { opl4_t *opl4; opl3_t *opl3; int err; static snd_device_ops_t ops = { .dev_free = snd_opl4_dev_free }; if (ropl3) *ropl3 = NULL; if (ropl4) *ropl4 = NULL; opl4 = kcalloc(1, sizeof(*opl4), GFP_KERNEL); if (!opl4) return -ENOMEM; opl4->res_fm_port = request_region(fm_port, 8, "OPL4 FM"); opl4->res_pcm_port = request_region(pcm_port, 8, "OPL4 PCM/MIX"); if (!opl4->res_fm_port || !opl4->res_pcm_port) { snd_printk(KERN_ERR "opl4: can't grab ports 0x%lx, 0x%lx\n", fm_port, pcm_port); snd_opl4_free(opl4); return -EBUSY; } opl4->card = card; opl4->fm_port = fm_port; opl4->pcm_port = pcm_port; spin_lock_init(&opl4->reg_lock); init_MUTEX(&opl4->access_mutex); err = snd_opl4_detect(opl4); if (err < 0) { snd_opl4_free(opl4); snd_printd("OPL4 chip not detected at %#lx/%#lx\n", fm_port, pcm_port); return err; } err = snd_device_new(card, SNDRV_DEV_CODEC, opl4, &ops); if (err < 0) { snd_opl4_free(opl4); return err; } err = snd_opl3_create(card, fm_port, fm_port + 2, opl4->hardware, 1, &opl3); if (err < 0) { snd_device_free(card, opl4); return err; } /* opl3 initialization disabled opl4, so reenable */ snd_opl4_enable_opl4(opl4); snd_opl4_create_mixer(opl4); #ifdef CONFIG_PROC_FS snd_opl4_create_proc(opl4); #endif #if defined(CONFIG_SND_SEQUENCER) || (defined(MODULE) && defined(CONFIG_SND_SEQUENCER_MODULE)) opl4->seq_client = -1; if (opl4->hardware < OPL3_HW_OPL4_ML) snd_opl4_create_seq_dev(opl4, seq_device); #endif if (ropl3) *ropl3 = opl3; if (ropl4) *ropl4 = opl4; return 0; } EXPORT_SYMBOL(snd_opl4_write); EXPORT_SYMBOL(snd_opl4_read); EXPORT_SYMBOL(snd_opl4_write_memory); EXPORT_SYMBOL(snd_opl4_read_memory); EXPORT_SYMBOL(snd_opl4_create); static int __init alsa_opl4_init(void) { return 0; } static void __exit alsa_opl4_exit(void) { } module_init(alsa_opl4_init) module_exit(alsa_opl4_exit)