253 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Functions for accessing OPL4 devices4 * 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 15MODULE_AUTHOR("Clemens Ladisch <clemens@ladisch.de>");16MODULE_DESCRIPTION("OPL4 driver");17MODULE_LICENSE("GPL");18 19static 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 26void 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 35EXPORT_SYMBOL(snd_opl4_write);36 37u8 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 46EXPORT_SYMBOL(snd_opl4_read);47 48void 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 72EXPORT_SYMBOL(snd_opl4_read_memory);73 74void 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 98EXPORT_SYMBOL(snd_opl4_write_memory);99 100static 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 110static 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 dev_dbg(opl4->card->dev, "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 dev_dbg(opl4->card->dev, "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)144static 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 150static 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#endif163 164static 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 172static 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 179int 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_free189 };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 dev_err(card->dev, "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 dev_dbg(card->dev, "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#endif244 245 if (ropl3)246 *ropl3 = opl3;247 if (ropl4)248 *ropl4 = opl4;249 return 0;250}251 252EXPORT_SYMBOL(snd_opl4_create);253