sound/oss/opl3sa.c - kernel/msm-4.9 - Gitiles

 /*
  * sound/opl3sa.c
  *
  * Low level driver for Yamaha YMF701B aka OPL3-SA chip
  *
  *
  *
  * Copyright (C) by Hannu Savolainen 1993-1997
  *
  * OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL)
  * Version 2 (June 1991). See the "COPYING" file distributed with this software
  * for more info.
  *
  * Changes:
  *	Alan Cox		Modularisation
  *	Christoph Hellwig	Adapted to module_init/module_exit
  *	Arnaldo C. de Melo	got rid of attach_uart401
  *
  * FIXME:
  * 	Check for install of mpu etc is wrong, should check result of the mss stuff
  */

 #include <linux/init.h>
 #include <linux/module.h>
 #include <linux/spinlock.h>

 #undef  SB_OK

 #include "sound_config.h"

 #include "ad1848.h"
 #include "mpu401.h"

 #ifdef SB_OK
 #include "sb.h"
 static int sb_initialized;
 #endif

 static DEFINE_SPINLOCK(lock);

 static unsigned char opl3sa_read(int addr)
 {
 	unsigned long flags;
 	unsigned char tmp;

 	spin_lock_irqsave(&lock,flags);
 	outb((0x1d), 0xf86);	/* password */
 	outb(((unsigned char) addr), 0xf86);	/* address */
 	tmp = inb(0xf87);	/* data */
 	spin_unlock_irqrestore(&lock,flags);

 	return tmp;
 }

 static void opl3sa_write(int addr, int data)
 {
 	unsigned long flags;

 	spin_lock_irqsave(&lock,flags);
 	outb((0x1d), 0xf86);	/* password */
 	outb(((unsigned char) addr), 0xf86);	/* address */
 	outb(((unsigned char) data), 0xf87);	/* data */
 	spin_unlock_irqrestore(&lock,flags);
 }

 static int __init opl3sa_detect(void)
 {
 	int tmp;

 	if (((tmp = opl3sa_read(0x01)) & 0xc4) != 0x04)
 	{
 		DDB(printk("OPL3-SA detect error 1 (%x)\n", opl3sa_read(0x01)));
 		/* return 0; */
 	}

 	/*
 	 * Check that the password feature has any effect
 	 */

 	if (inb(0xf87) == tmp)
 	{
 		DDB(printk("OPL3-SA detect failed 2 (%x/%x)\n", tmp, inb(0xf87)));
 		return 0;
 	}
 	tmp = (opl3sa_read(0x04) & 0xe0) >> 5;

 	if (tmp != 0 && tmp != 1)
 	{
 		DDB(printk("OPL3-SA detect failed 3 (%d)\n", tmp));
 		return 0;
 	}
 	DDB(printk("OPL3-SA mode %x detected\n", tmp));

 	opl3sa_write(0x01, 0x00);	/* Disable MSS */
 	opl3sa_write(0x02, 0x00);	/* Disable SB */
 	opl3sa_write(0x03, 0x00);	/* Disable MPU */

 	return 1;
 }

 /*
  *    Probe and attach routines for the Windows Sound System mode of
  *     OPL3-SA
  */

 static int __init probe_opl3sa_wss(struct address_info *hw_config, struct resource *ports)
 {
 	unsigned char tmp = 0x24;	/* WSS enable */

 	/*
 	 * Check if the IO port returns valid signature. The original MS Sound
 	 * system returns 0x04 while some cards (OPL3-SA for example)
 	 * return 0x00.
 	 */

 	if (!opl3sa_detect())
 	{
 		printk(KERN_ERR "OSS: OPL3-SA chip not found\n");
 		return 0;
 	}

 	switch (hw_config->io_base)
 	{
 		case 0x530:
 			tmp |= 0x00;
 			break;
 		case 0xe80:
 			tmp |= 0x08;
 			break;
 		case 0xf40:
 			tmp |= 0x10;
 			break;
 		case 0x604:
 			tmp |= 0x18;
 			break;
 		default:
 			printk(KERN_ERR "OSS: Unsupported OPL3-SA/WSS base %x\n", hw_config->io_base);
 		  return 0;
 	}

 	opl3sa_write(0x01, tmp);	/* WSS setup register */

 	return probe_ms_sound(hw_config, ports);
 }

 static void __init attach_opl3sa_wss(struct address_info *hw_config, struct resource *ports)
 {
 	int nm = num_mixers;

 	/* FIXME */
 	attach_ms_sound(hw_config, ports, THIS_MODULE);
 	if (num_mixers > nm)	/* A mixer was installed */
 	{
 		AD1848_REROUTE(SOUND_MIXER_LINE1, SOUND_MIXER_CD);
 		AD1848_REROUTE(SOUND_MIXER_LINE2, SOUND_MIXER_SYNTH);
 		AD1848_REROUTE(SOUND_MIXER_LINE3, SOUND_MIXER_LINE);
 	}
 }


 static int __init probe_opl3sa_mpu(struct address_info *hw_config)
 {
 	unsigned char conf;
 	static signed char irq_bits[] = {
 		-1, -1, -1, -1, -1, 1, -1, 2, -1, 3, 4
 	};

 	if (hw_config->irq > 10)
 	{
 		printk(KERN_ERR "OPL3-SA: Bad MPU IRQ %d\n", hw_config->irq);
 		return 0;
 	}
 	if (irq_bits[hw_config->irq] == -1)
 	{
 		printk(KERN_ERR "OPL3-SA: Bad MPU IRQ %d\n", hw_config->irq);
 		return 0;
 	}
 	switch (hw_config->io_base)
 	{
 		case 0x330:
 			conf = 0x00;
 			break;
 		case 0x332:
 			conf = 0x20;
 			break;
 		case 0x334:
 			conf = 0x40;
 			break;
 		case 0x300:
 			conf = 0x60;
 			break;
 		default:
 			return 0;	/* Invalid port */
 	}

 	conf |= 0x83;		/* MPU & OPL3 (synth) & game port enable */
 	conf |= irq_bits[hw_config->irq] << 2;

 	opl3sa_write(0x03, conf);

 	hw_config->name = "OPL3-SA (MPU401)";

 	return probe_uart401(hw_config, THIS_MODULE);
 }

 static void __exit unload_opl3sa_wss(struct address_info *hw_config)
 {
 	int dma2 = hw_config->dma2;

 	if (dma2 == -1)
 		dma2 = hw_config->dma;

 	release_region(0xf86, 2);
 	release_region(hw_config->io_base, 4);

 	ad1848_unload(hw_config->io_base + 4,
 		      hw_config->irq,
 		      hw_config->dma,
 		      dma2,
 		      0);
 	sound_unload_audiodev(hw_config->slots[0]);
 }

 static inline void __exit unload_opl3sa_mpu(struct address_info *hw_config)
 {
 	unload_uart401(hw_config);
 }

 #ifdef SB_OK
 static inline void __exit unload_opl3sa_sb(struct address_info *hw_config)
 {
 	sb_dsp_unload(hw_config);
 }
 #endif

 static int found_mpu;

 static struct address_info cfg;
 static struct address_info cfg_mpu;

 static int __initdata io	= -1;
 static int __initdata irq	= -1;
 static int __initdata dma	= -1;
 static int __initdata dma2	= -1;
 static int __initdata mpu_io	= -1;
 static int __initdata mpu_irq	= -1;

 module_param(io, int, 0);
 module_param(irq, int, 0);
 module_param(dma, int, 0);
 module_param(dma2, int, 0);
 module_param(mpu_io, int, 0);
 module_param(mpu_irq, int, 0);

 static int __init init_opl3sa(void)
 {
 	struct resource *ports;
 	if (io == -1 || irq == -1 || dma == -1) {
 		printk(KERN_ERR "opl3sa: dma, irq and io must be set.\n");
 		return -EINVAL;
 	}

 	cfg.io_base = io;
 	cfg.irq = irq;
 	cfg.dma = dma;
 	cfg.dma2 = dma2;

 	cfg_mpu.io_base = mpu_io;
 	cfg_mpu.irq = mpu_irq;

 	ports = request_region(io + 4, 4, "ad1848");
 	if (!ports)
 		return -EBUSY;

 	if (!request_region(0xf86, 2, "OPL3-SA"))/* Control port is busy */ {
 		release_region(io + 4, 4);
 		return 0;
 	}

 	if (!request_region(io, 4, "WSS config")) {
 		release_region(0x86, 2);
 		release_region(io + 4, 4);
 		return 0;
 	}

 	if (probe_opl3sa_wss(&cfg, ports) == 0) {
 		release_region(0xf86, 2);
 		release_region(io, 4);
 		release_region(io + 4, 4);
 		return -ENODEV;
 	}

 	found_mpu=probe_opl3sa_mpu(&cfg_mpu);

 	attach_opl3sa_wss(&cfg, ports);
 	return 0;
 }

 static void __exit cleanup_opl3sa(void)
 {
 	if(found_mpu)
 		unload_opl3sa_mpu(&cfg_mpu);
 	unload_opl3sa_wss(&cfg);
 }

 module_init(init_opl3sa);
 module_exit(cleanup_opl3sa);

 #ifndef MODULE
 static int __init setup_opl3sa(char *str)
 {
 	/* io, irq, dma, dma2, mpu_io, mpu_irq */
 	int ints[7];

 	str = get_options(str, ARRAY_SIZE(ints), ints);

 	io	= ints[1];
 	irq	= ints[2];
 	dma	= ints[3];
 	dma2	= ints[4];
 	mpu_io	= ints[5];
 	mpu_irq	= ints[6];

 	return 1;
 }

 __setup("opl3sa=", setup_opl3sa);
 #endif
 MODULE_LICENSE("GPL");
	/*
	* sound/opl3sa.c
	*
	* Low level driver for Yamaha YMF701B aka OPL3-SA chip
	*
	*
	*
	* Copyright (C) by Hannu Savolainen 1993-1997
	*
	* OSS/Free for Linux is distributed under the GNU GENERAL PUBLIC LICENSE (GPL)
	* Version 2 (June 1991). See the "COPYING" file distributed with this software
	* for more info.
	*
	* Changes:
	* Alan Cox Modularisation
	* Christoph Hellwig Adapted to module_init/module_exit
	* Arnaldo C. de Melo got rid of attach_uart401
	*
	* FIXME:
	* Check for install of mpu etc is wrong, should check result of the mss stuff
	*/

	#include <linux/init.h>
	#include <linux/module.h>
	#include <linux/spinlock.h>

	#undef SB_OK

	#include "sound_config.h"

	#include "ad1848.h"
	#include "mpu401.h"

	#ifdef SB_OK
	#include "sb.h"
	static int sb_initialized;
	#endif

	static DEFINE_SPINLOCK(lock);

	static unsigned char opl3sa_read(int addr)
	{
	unsigned long flags;
	unsigned char tmp;

	spin_lock_irqsave(&lock,flags);
	outb((0x1d), 0xf86); /* password */
	outb(((unsigned char) addr), 0xf86); /* address */
	tmp = inb(0xf87); /* data */
	spin_unlock_irqrestore(&lock,flags);

	return tmp;
	}

	static void opl3sa_write(int addr, int data)
	{
	unsigned long flags;

	spin_lock_irqsave(&lock,flags);
	outb((0x1d), 0xf86); /* password */
	outb(((unsigned char) addr), 0xf86); /* address */
	outb(((unsigned char) data), 0xf87); /* data */
	spin_unlock_irqrestore(&lock,flags);
	}

	static int __init opl3sa_detect(void)
	{
	int tmp;

	if (((tmp = opl3sa_read(0x01)) & 0xc4) != 0x04)
	{
	DDB(printk("OPL3-SA detect error 1 (%x)\n", opl3sa_read(0x01)));
	/* return 0; */
	}

	/*
	* Check that the password feature has any effect
	*/

	if (inb(0xf87) == tmp)
	{
	DDB(printk("OPL3-SA detect failed 2 (%x/%x)\n", tmp, inb(0xf87)));
	return 0;
	}
	tmp = (opl3sa_read(0x04) & 0xe0) >> 5;

	if (tmp != 0 && tmp != 1)
	{
	DDB(printk("OPL3-SA detect failed 3 (%d)\n", tmp));
	return 0;
	}
	DDB(printk("OPL3-SA mode %x detected\n", tmp));

	opl3sa_write(0x01, 0x00); /* Disable MSS */
	opl3sa_write(0x02, 0x00); /* Disable SB */
	opl3sa_write(0x03, 0x00); /* Disable MPU */

	return 1;
	}

	/*
	* Probe and attach routines for the Windows Sound System mode of
	* OPL3-SA
	*/

	static int __init probe_opl3sa_wss(struct address_info hw_config, struct resource ports)
	{
	unsigned char tmp = 0x24; /* WSS enable */

	/*
	* Check if the IO port returns valid signature. The original MS Sound
	* system returns 0x04 while some cards (OPL3-SA for example)
	* return 0x00.
	*/

	if (!opl3sa_detect())
	{
	printk(KERN_ERR "OSS: OPL3-SA chip not found\n");
	return 0;
	}

	switch (hw_config->io_base)
	{
	case 0x530:
	tmp \|= 0x00;
	break;
	case 0xe80:
	tmp \|= 0x08;
	break;
	case 0xf40:
	tmp \|= 0x10;
	break;
	case 0x604:
	tmp \|= 0x18;
	break;
	default:
	printk(KERN_ERR "OSS: Unsupported OPL3-SA/WSS base %x\n", hw_config->io_base);
	return 0;
	}

	opl3sa_write(0x01, tmp); /* WSS setup register */

	return probe_ms_sound(hw_config, ports);
	}

	static void __init attach_opl3sa_wss(struct address_info hw_config, struct resource ports)
	{
	int nm = num_mixers;

	/* FIXME */
	attach_ms_sound(hw_config, ports, THIS_MODULE);
	if (num_mixers > nm) /* A mixer was installed */
	{
	AD1848_REROUTE(SOUND_MIXER_LINE1, SOUND_MIXER_CD);
	AD1848_REROUTE(SOUND_MIXER_LINE2, SOUND_MIXER_SYNTH);
	AD1848_REROUTE(SOUND_MIXER_LINE3, SOUND_MIXER_LINE);
	}
	}


	static int __init probe_opl3sa_mpu(struct address_info *hw_config)
	{
	unsigned char conf;
	static signed char irq_bits[] = {
	-1, -1, -1, -1, -1, 1, -1, 2, -1, 3, 4
	};

	if (hw_config->irq > 10)
	{
	printk(KERN_ERR "OPL3-SA: Bad MPU IRQ %d\n", hw_config->irq);
	return 0;
	}
	if (irq_bits[hw_config->irq] == -1)
	{
	printk(KERN_ERR "OPL3-SA: Bad MPU IRQ %d\n", hw_config->irq);
	return 0;
	}
	switch (hw_config->io_base)
	{
	case 0x330:
	conf = 0x00;
	break;
	case 0x332:
	conf = 0x20;
	break;
	case 0x334:
	conf = 0x40;
	break;
	case 0x300:
	conf = 0x60;
	break;
	default:
	return 0; /* Invalid port */
	}

	conf \|= 0x83; /* MPU & OPL3 (synth) & game port enable */
	conf \|= irq_bits[hw_config->irq] << 2;

	opl3sa_write(0x03, conf);

	hw_config->name = "OPL3-SA (MPU401)";

	return probe_uart401(hw_config, THIS_MODULE);
	}

	static void __exit unload_opl3sa_wss(struct address_info *hw_config)
	{
	int dma2 = hw_config->dma2;

	if (dma2 == -1)
	dma2 = hw_config->dma;

	release_region(0xf86, 2);
	release_region(hw_config->io_base, 4);

	ad1848_unload(hw_config->io_base + 4,
	hw_config->irq,
	hw_config->dma,
	dma2,
	0);
	sound_unload_audiodev(hw_config->slots[0]);
	}

	static inline void __exit unload_opl3sa_mpu(struct address_info *hw_config)
	{
	unload_uart401(hw_config);
	}

	#ifdef SB_OK
	static inline void __exit unload_opl3sa_sb(struct address_info *hw_config)
	{
	sb_dsp_unload(hw_config);
	}
	#endif

	static int found_mpu;

	static struct address_info cfg;
	static struct address_info cfg_mpu;

	static int __initdata io = -1;
	static int __initdata irq = -1;
	static int __initdata dma = -1;
	static int __initdata dma2 = -1;
	static int __initdata mpu_io = -1;
	static int __initdata mpu_irq = -1;

	module_param(io, int, 0);
	module_param(irq, int, 0);
	module_param(dma, int, 0);
	module_param(dma2, int, 0);
	module_param(mpu_io, int, 0);
	module_param(mpu_irq, int, 0);

	static int __init init_opl3sa(void)
	{
	struct resource *ports;
	if (io == -1 \|\| irq == -1 \|\| dma == -1) {
	printk(KERN_ERR "opl3sa: dma, irq and io must be set.\n");
	return -EINVAL;
	}

	cfg.io_base = io;
	cfg.irq = irq;
	cfg.dma = dma;
	cfg.dma2 = dma2;

	cfg_mpu.io_base = mpu_io;
	cfg_mpu.irq = mpu_irq;

	ports = request_region(io + 4, 4, "ad1848");
	if (!ports)
	return -EBUSY;

	if (!request_region(0xf86, 2, "OPL3-SA"))/* Control port is busy */ {
	release_region(io + 4, 4);
	return 0;
	}

	if (!request_region(io, 4, "WSS config")) {
	release_region(0x86, 2);
	release_region(io + 4, 4);
	return 0;
	}

	if (probe_opl3sa_wss(&cfg, ports) == 0) {
	release_region(0xf86, 2);
	release_region(io, 4);
	release_region(io + 4, 4);
	return -ENODEV;
	}

	found_mpu=probe_opl3sa_mpu(&cfg_mpu);

	attach_opl3sa_wss(&cfg, ports);
	return 0;
	}

	static void __exit cleanup_opl3sa(void)
	{
	if(found_mpu)
	unload_opl3sa_mpu(&cfg_mpu);
	unload_opl3sa_wss(&cfg);
	}

	module_init(init_opl3sa);
	module_exit(cleanup_opl3sa);

	#ifndef MODULE
	static int __init setup_opl3sa(char *str)
	{
	/* io, irq, dma, dma2, mpu_io, mpu_irq */
	int ints[7];

	str = get_options(str, ARRAY_SIZE(ints), ints);

	io = ints[1];
	irq = ints[2];
	dma = ints[3];
	dma2 = ints[4];
	mpu_io = ints[5];
	mpu_irq = ints[6];

	return 1;
	}

	__setup("opl3sa=", setup_opl3sa);
	#endif
	MODULE_LICENSE("GPL");