2362 lines
		
	
	
		
			82 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			2362 lines
		
	
	
		
			82 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0-or-later
 | |
| /*
 | |
|  *   Driver for the Korg 1212 IO PCI card
 | |
|  *
 | |
|  *	Copyright (c) 2001 Haroldo Gamal <gamal@alternex.com.br>
 | |
|  */
 | |
| 
 | |
| #include <linux/delay.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/pci.h>
 | |
| #include <linux/slab.h>
 | |
| #include <linux/wait.h>
 | |
| #include <linux/module.h>
 | |
| #include <linux/mutex.h>
 | |
| #include <linux/firmware.h>
 | |
| #include <linux/io.h>
 | |
| 
 | |
| #include <sound/core.h>
 | |
| #include <sound/info.h>
 | |
| #include <sound/control.h>
 | |
| #include <sound/pcm.h>
 | |
| #include <sound/pcm_params.h>
 | |
| #include <sound/initval.h>
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // Debug Stuff
 | |
| // ----------------------------------------------------------------------------
 | |
| #define K1212_DEBUG_LEVEL		0
 | |
| #if K1212_DEBUG_LEVEL > 0
 | |
| #define K1212_DEBUG_PRINTK(fmt, args...) pr_debug(fmt, ##args)
 | |
| #else
 | |
| #define K1212_DEBUG_PRINTK(fmt, ...)	do { } while (0)
 | |
| #endif
 | |
| #if K1212_DEBUG_LEVEL > 1
 | |
| #define K1212_DEBUG_PRINTK_VERBOSE(fmt, args...) pr_debug(fmt, ##args)
 | |
| #else
 | |
| #define K1212_DEBUG_PRINTK_VERBOSE(fmt, ...)
 | |
| #endif
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // Record/Play Buffer Allocation Method. If K1212_LARGEALLOC is defined all 
 | |
| // buffers are alocated as a large piece inside KorgSharedBuffer.
 | |
| // ----------------------------------------------------------------------------
 | |
| //#define K1212_LARGEALLOC		1
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // Valid states of the Korg 1212 I/O card.
 | |
| // ----------------------------------------------------------------------------
 | |
| enum CardState {
 | |
|    K1212_STATE_NONEXISTENT,		// there is no card here
 | |
|    K1212_STATE_UNINITIALIZED,		// the card is awaiting DSP download
 | |
|    K1212_STATE_DSP_IN_PROCESS,		// the card is currently downloading its DSP code
 | |
|    K1212_STATE_DSP_COMPLETE,		// the card has finished the DSP download
 | |
|    K1212_STATE_READY,			// the card can be opened by an application.  Any application
 | |
| 					//    requests prior to this state should fail.  Only an open
 | |
| 					//    request can be made at this state.
 | |
|    K1212_STATE_OPEN,			// an application has opened the card
 | |
|    K1212_STATE_SETUP,			// the card has been setup for play
 | |
|    K1212_STATE_PLAYING,			// the card is playing
 | |
|    K1212_STATE_MONITOR,			// the card is in the monitor mode
 | |
|    K1212_STATE_CALIBRATING,		// the card is currently calibrating
 | |
|    K1212_STATE_ERRORSTOP,		// the card has stopped itself because of an error and we
 | |
| 					//    are in the process of cleaning things up.
 | |
|    K1212_STATE_MAX_STATE		// state values of this and beyond are invalid
 | |
| };
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // The following enumeration defines the constants written to the card's
 | |
| // host-to-card doorbell to initiate a command.
 | |
| // ----------------------------------------------------------------------------
 | |
| enum korg1212_dbcnst {
 | |
|    K1212_DB_RequestForData        = 0,    // sent by the card to request a buffer fill.
 | |
|    K1212_DB_TriggerPlay           = 1,    // starts playback/record on the card.
 | |
|    K1212_DB_SelectPlayMode        = 2,    // select monitor, playback setup, or stop.
 | |
|    K1212_DB_ConfigureBufferMemory = 3,    // tells card where the host audio buffers are.
 | |
|    K1212_DB_RequestAdatTimecode   = 4,    // asks the card for the latest ADAT timecode value.
 | |
|    K1212_DB_SetClockSourceRate    = 5,    // sets the clock source and rate for the card.
 | |
|    K1212_DB_ConfigureMiscMemory   = 6,    // tells card where other buffers are.
 | |
|    K1212_DB_TriggerFromAdat       = 7,    // tells card to trigger from Adat at a specific
 | |
|                                           //    timecode value.
 | |
|    K1212_DB_DMAERROR              = 0x80, // DMA Error - the PCI bus is congestioned.
 | |
|    K1212_DB_CARDSTOPPED           = 0x81, // Card has stopped by user request.
 | |
|    K1212_DB_RebootCard            = 0xA0, // instructs the card to reboot.
 | |
|    K1212_DB_BootFromDSPPage4      = 0xA4, // instructs the card to boot from the DSP microcode
 | |
|                                           //    on page 4 (local page to card).
 | |
|    K1212_DB_DSPDownloadDone       = 0xAE, // sent by the card to indicate the download has
 | |
|                                           //    completed.
 | |
|    K1212_DB_StartDSPDownload      = 0xAF  // tells the card to download its DSP firmware.
 | |
| };
 | |
| 
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // The following enumeration defines return codes 
 | |
| // to the Korg 1212 I/O driver.
 | |
| // ----------------------------------------------------------------------------
 | |
| enum snd_korg1212rc {
 | |
|    K1212_CMDRET_Success         = 0,   // command was successfully placed
 | |
|    K1212_CMDRET_DIOCFailure,           // the DeviceIoControl call failed
 | |
|    K1212_CMDRET_PMFailure,             // the protected mode call failed
 | |
|    K1212_CMDRET_FailUnspecified,       // unspecified failure
 | |
|    K1212_CMDRET_FailBadState,          // the specified command can not be given in
 | |
|                                        //    the card's current state. (or the wave device's
 | |
|                                        //    state)
 | |
|    K1212_CMDRET_CardUninitialized,     // the card is uninitialized and cannot be used
 | |
|    K1212_CMDRET_BadIndex,              // an out of range card index was specified
 | |
|    K1212_CMDRET_BadHandle,             // an invalid card handle was specified
 | |
|    K1212_CMDRET_NoFillRoutine,         // a play request has been made before a fill routine set
 | |
|    K1212_CMDRET_FillRoutineInUse,      // can't set a new fill routine while one is in use
 | |
|    K1212_CMDRET_NoAckFromCard,         // the card never acknowledged a command
 | |
|    K1212_CMDRET_BadParams,             // bad parameters were provided by the caller
 | |
| 
 | |
|    K1212_CMDRET_BadDevice,             // the specified wave device was out of range
 | |
|    K1212_CMDRET_BadFormat              // the specified wave format is unsupported
 | |
| };
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // The following enumeration defines the constants used to select the play
 | |
| // mode for the card in the SelectPlayMode command.
 | |
| // ----------------------------------------------------------------------------
 | |
| enum PlayModeSelector {
 | |
|    K1212_MODE_SetupPlay  = 0x00000001,     // provides card with pre-play information
 | |
|    K1212_MODE_MonitorOn  = 0x00000002,     // tells card to turn on monitor mode
 | |
|    K1212_MODE_MonitorOff = 0x00000004,     // tells card to turn off monitor mode
 | |
|    K1212_MODE_StopPlay   = 0x00000008      // stops playback on the card
 | |
| };
 | |
| 
 | |
| // ----------------------------------------------------------------------------
 | |
| // The following enumeration defines the constants used to select the monitor
 | |
| // mode for the card in the SetMonitorMode command.
 | |
| // ----------------------------------------------------------------------------
 | |
| enum MonitorModeSelector {
 | |
|    K1212_MONMODE_Off  = 0,     // tells card to turn off monitor mode
 | |
|    K1212_MONMODE_On            // tells card to turn on monitor mode
 | |
| };
 | |
| 
 | |
| #define MAILBOX0_OFFSET      0x40	// location of mailbox 0 relative to base address
 | |
| #define MAILBOX1_OFFSET      0x44	// location of mailbox 1 relative to base address
 | |
| #define MAILBOX2_OFFSET      0x48	// location of mailbox 2 relative to base address
 | |
| #define MAILBOX3_OFFSET      0x4c	// location of mailbox 3 relative to base address
 | |
| #define OUT_DOORBELL_OFFSET  0x60	// location of PCI to local doorbell
 | |
| #define IN_DOORBELL_OFFSET   0x64	// location of local to PCI doorbell
 | |
| #define STATUS_REG_OFFSET    0x68	// location of interrupt control/status register
 | |
| #define PCI_CONTROL_OFFSET   0x6c	// location of the EEPROM, PCI, User I/O, init control
 | |
| 					//    register
 | |
| #define SENS_CONTROL_OFFSET  0x6e	// location of the input sensitivity setting register.
 | |
| 					//    this is the upper word of the PCI control reg.
 | |
| #define DEV_VEND_ID_OFFSET   0x70	// location of the device and vendor ID register
 | |
| 
 | |
| #define MAX_COMMAND_RETRIES  5         // maximum number of times the driver will attempt
 | |
|                                        //    to send a command before giving up.
 | |
| #define COMMAND_ACK_MASK     0x8000    // the MSB is set in the command acknowledgment from
 | |
|                                         //    the card.
 | |
| #define DOORBELL_VAL_MASK    0x00FF    // the doorbell value is one byte
 | |
| 
 | |
| #define CARD_BOOT_DELAY_IN_MS  10
 | |
| #define CARD_BOOT_TIMEOUT      10
 | |
| #define DSP_BOOT_DELAY_IN_MS   200
 | |
| 
 | |
| #define kNumBuffers		8
 | |
| #define k1212MaxCards		4
 | |
| #define k1212NumWaveDevices	6
 | |
| #define k16BitChannels		10
 | |
| #define k32BitChannels		2
 | |
| #define kAudioChannels		(k16BitChannels + k32BitChannels)
 | |
| #define kPlayBufferFrames	1024
 | |
| 
 | |
| #define K1212_ANALOG_CHANNELS	2
 | |
| #define K1212_SPDIF_CHANNELS	2
 | |
| #define K1212_ADAT_CHANNELS	8
 | |
| #define K1212_CHANNELS		(K1212_ADAT_CHANNELS + K1212_ANALOG_CHANNELS)
 | |
| #define K1212_MIN_CHANNELS	1
 | |
| #define K1212_MAX_CHANNELS	K1212_CHANNELS
 | |
| #define K1212_FRAME_SIZE        (sizeof(struct KorgAudioFrame))
 | |
| #define K1212_MAX_SAMPLES	(kPlayBufferFrames*kNumBuffers)
 | |
| #define K1212_PERIODS		(kNumBuffers)
 | |
| #define K1212_PERIOD_BYTES	(K1212_FRAME_SIZE*kPlayBufferFrames)
 | |
| #define K1212_BUF_SIZE          (K1212_PERIOD_BYTES*kNumBuffers)
 | |
| #define K1212_ANALOG_BUF_SIZE	(K1212_ANALOG_CHANNELS * 2 * kPlayBufferFrames * kNumBuffers)
 | |
| #define K1212_SPDIF_BUF_SIZE	(K1212_SPDIF_CHANNELS * 3 * kPlayBufferFrames * kNumBuffers)
 | |
| #define K1212_ADAT_BUF_SIZE	(K1212_ADAT_CHANNELS * 2 * kPlayBufferFrames * kNumBuffers)
 | |
| #define K1212_MAX_BUF_SIZE	(K1212_ANALOG_BUF_SIZE + K1212_ADAT_BUF_SIZE)
 | |
| 
 | |
| #define k1212MinADCSens     0x00
 | |
| #define k1212MaxADCSens     0x7f
 | |
| #define k1212MaxVolume      0x7fff
 | |
| #define k1212MaxWaveVolume  0xffff
 | |
| #define k1212MinVolume      0x0000
 | |
| #define k1212MaxVolInverted 0x8000
 | |
| 
 | |
| // -----------------------------------------------------------------
 | |
| // the following bits are used for controlling interrupts in the
 | |
| // interrupt control/status reg
 | |
| // -----------------------------------------------------------------
 | |
| #define  PCI_INT_ENABLE_BIT               0x00000100
 | |
| #define  PCI_DOORBELL_INT_ENABLE_BIT      0x00000200
 | |
| #define  LOCAL_INT_ENABLE_BIT             0x00010000
 | |
| #define  LOCAL_DOORBELL_INT_ENABLE_BIT    0x00020000
 | |
| #define  LOCAL_DMA1_INT_ENABLE_BIT        0x00080000
 | |
| 
 | |
| // -----------------------------------------------------------------
 | |
| // the following bits are defined for the PCI command register
 | |
| // -----------------------------------------------------------------
 | |
| #define  PCI_CMD_MEM_SPACE_ENABLE_BIT     0x0002
 | |
| #define  PCI_CMD_IO_SPACE_ENABLE_BIT      0x0001
 | |
| #define  PCI_CMD_BUS_MASTER_ENABLE_BIT    0x0004
 | |
| 
 | |
| // -----------------------------------------------------------------
 | |
| // the following bits are defined for the PCI status register
 | |
| // -----------------------------------------------------------------
 | |
| #define  PCI_STAT_PARITY_ERROR_BIT        0x8000
 | |
| #define  PCI_STAT_SYSTEM_ERROR_BIT        0x4000
 | |
| #define  PCI_STAT_MASTER_ABORT_RCVD_BIT   0x2000
 | |
| #define  PCI_STAT_TARGET_ABORT_RCVD_BIT   0x1000
 | |
| #define  PCI_STAT_TARGET_ABORT_SENT_BIT   0x0800
 | |
| 
 | |
| // ------------------------------------------------------------------------
 | |
| // the following constants are used in setting the 1212 I/O card's input
 | |
| // sensitivity.
 | |
| // ------------------------------------------------------------------------
 | |
| #define  SET_SENS_LOCALINIT_BITPOS        15
 | |
| #define  SET_SENS_DATA_BITPOS             10
 | |
| #define  SET_SENS_CLOCK_BITPOS            8
 | |
| #define  SET_SENS_LOADSHIFT_BITPOS        0
 | |
| 
 | |
| #define  SET_SENS_LEFTCHANID              0x00
 | |
| #define  SET_SENS_RIGHTCHANID             0x01
 | |
| 
 | |
| #define  K1212SENSUPDATE_DELAY_IN_MS      50
 | |
| 
 | |
| // --------------------------------------------------------------------------
 | |
| // WaitRTCTicks
 | |
| //
 | |
| //    This function waits the specified number of real time clock ticks.
 | |
| //    According to the DDK, each tick is ~0.8 microseconds.
 | |
| //    The defines following the function declaration can be used for the
 | |
| //    numTicksToWait parameter.
 | |
| // --------------------------------------------------------------------------
 | |
| #define ONE_RTC_TICK         1
 | |
| #define SENSCLKPULSE_WIDTH   4
 | |
| #define LOADSHIFT_DELAY      4
 | |
| #define INTERCOMMAND_DELAY  40
 | |
| #define STOPCARD_DELAY      300        // max # RTC ticks for the card to stop once we write
 | |
|                                        //    the command register.  (could be up to 180 us)
 | |
| #define COMMAND_ACK_DELAY   13         // number of RTC ticks to wait for an acknowledgement
 | |
|                                        //    from the card after sending a command.
 | |
| 
 | |
| enum ClockSourceIndex {
 | |
|    K1212_CLKIDX_AdatAt44_1K = 0,    // selects source as ADAT at 44.1 kHz
 | |
|    K1212_CLKIDX_AdatAt48K,          // selects source as ADAT at 48 kHz
 | |
|    K1212_CLKIDX_WordAt44_1K,        // selects source as S/PDIF at 44.1 kHz
 | |
|    K1212_CLKIDX_WordAt48K,          // selects source as S/PDIF at 48 kHz
 | |
|    K1212_CLKIDX_LocalAt44_1K,       // selects source as local clock at 44.1 kHz
 | |
|    K1212_CLKIDX_LocalAt48K,         // selects source as local clock at 48 kHz
 | |
|    K1212_CLKIDX_Invalid             // used to check validity of the index
 | |
| };
 | |
| 
 | |
| enum ClockSourceType {
 | |
|    K1212_CLKIDX_Adat = 0,    // selects source as ADAT
 | |
|    K1212_CLKIDX_Word,        // selects source as S/PDIF
 | |
|    K1212_CLKIDX_Local        // selects source as local clock
 | |
| };
 | |
| 
 | |
| struct KorgAudioFrame {
 | |
| 	u16 frameData16[k16BitChannels]; /* channels 0-9 use 16 bit samples */
 | |
| 	u32 frameData32[k32BitChannels]; /* channels 10-11 use 32 bits - only 20 are sent across S/PDIF */
 | |
| 	u32 timeCodeVal; /* holds the ADAT timecode value */
 | |
| };
 | |
| 
 | |
| struct KorgAudioBuffer {
 | |
| 	struct KorgAudioFrame  bufferData[kPlayBufferFrames];     /* buffer definition */
 | |
| };
 | |
| 
 | |
| struct KorgSharedBuffer {
 | |
| #ifdef K1212_LARGEALLOC
 | |
|    struct KorgAudioBuffer   playDataBufs[kNumBuffers];
 | |
|    struct KorgAudioBuffer   recordDataBufs[kNumBuffers];
 | |
| #endif
 | |
|    short             volumeData[kAudioChannels];
 | |
|    u32               cardCommand;
 | |
|    u16               routeData [kAudioChannels];
 | |
|    u32               AdatTimeCode;                 // ADAT timecode value
 | |
| };
 | |
| 
 | |
| struct SensBits {
 | |
|    union {
 | |
|       struct {
 | |
|          unsigned int leftChanVal:8;
 | |
|          unsigned int leftChanId:8;
 | |
|       } v;
 | |
|       u16  leftSensBits;
 | |
|    } l;
 | |
|    union {
 | |
|       struct {
 | |
|          unsigned int rightChanVal:8;
 | |
|          unsigned int rightChanId:8;
 | |
|       } v;
 | |
|       u16  rightSensBits;
 | |
|    } r;
 | |
| };
 | |
| 
 | |
| struct snd_korg1212 {
 | |
|         struct snd_card *card;
 | |
|         struct pci_dev *pci;
 | |
|         struct snd_pcm *pcm;
 | |
|         int irq;
 | |
| 
 | |
|         spinlock_t    lock;
 | |
| 	struct mutex open_mutex;
 | |
| 
 | |
| 	struct timer_list timer;	/* timer callback for checking ack of stop request */
 | |
| 	int stop_pending_cnt;		/* counter for stop pending check */
 | |
| 
 | |
|         wait_queue_head_t wait;
 | |
| 
 | |
|         unsigned long iomem;
 | |
|         unsigned long ioport;
 | |
| 	unsigned long iomem2;
 | |
|         unsigned long irqcount;
 | |
|         unsigned long inIRQ;
 | |
|         void __iomem *iobase;
 | |
| 
 | |
| 	struct snd_dma_buffer *dma_dsp;
 | |
| 	struct snd_dma_buffer *dma_play;
 | |
| 	struct snd_dma_buffer *dma_rec;
 | |
| 	struct snd_dma_buffer *dma_shared;
 | |
| 
 | |
| 	u32 DataBufsSize;
 | |
| 
 | |
|         struct KorgAudioBuffer  * playDataBufsPtr;
 | |
|         struct KorgAudioBuffer  * recordDataBufsPtr;
 | |
| 
 | |
| 	struct KorgSharedBuffer * sharedBufferPtr;
 | |
| 
 | |
| 	u32 RecDataPhy;
 | |
| 	u32 PlayDataPhy;
 | |
| 	unsigned long sharedBufferPhy;
 | |
| 	u32 VolumeTablePhy;
 | |
| 	u32 RoutingTablePhy;
 | |
| 	u32 AdatTimeCodePhy;
 | |
| 
 | |
|         u32 __iomem * statusRegPtr;	     // address of the interrupt status/control register
 | |
|         u32 __iomem * outDoorbellPtr;	     // address of the host->card doorbell register
 | |
|         u32 __iomem * inDoorbellPtr;	     // address of the card->host doorbell register
 | |
|         u32 __iomem * mailbox0Ptr;	     // address of mailbox 0 on the card
 | |
|         u32 __iomem * mailbox1Ptr;	     // address of mailbox 1 on the card
 | |
|         u32 __iomem * mailbox2Ptr;	     // address of mailbox 2 on the card
 | |
|         u32 __iomem * mailbox3Ptr;	     // address of mailbox 3 on the card
 | |
|         u32 __iomem * controlRegPtr;	     // address of the EEPROM, PCI, I/O, Init ctrl reg
 | |
|         u16 __iomem * sensRegPtr;	     // address of the sensitivity setting register
 | |
|         u32 __iomem * idRegPtr;		     // address of the device and vendor ID registers
 | |
| 
 | |
|         size_t periodsize;
 | |
| 	int channels;
 | |
|         int currentBuffer;
 | |
| 
 | |
|         struct snd_pcm_substream *playback_substream;
 | |
|         struct snd_pcm_substream *capture_substream;
 | |
| 
 | |
| 	pid_t capture_pid;
 | |
| 	pid_t playback_pid;
 | |
| 
 | |
|  	enum CardState cardState;
 | |
|         int running;
 | |
|         int idleMonitorOn;           // indicates whether the card is in idle monitor mode.
 | |
|         u32 cmdRetryCount;           // tracks how many times we have retried sending to the card.
 | |
| 
 | |
|         enum ClockSourceIndex clkSrcRate; // sample rate and clock source
 | |
| 
 | |
|         enum ClockSourceType clkSource;   // clock source
 | |
|         int clkRate;                 // clock rate
 | |
| 
 | |
|         int volumePhase[kAudioChannels];
 | |
| 
 | |
|         u16 leftADCInSens;           // ADC left channel input sensitivity
 | |
|         u16 rightADCInSens;          // ADC right channel input sensitivity
 | |
| 
 | |
| 	int opencnt;		     // Open/Close count
 | |
| 	int setcnt;		     // SetupForPlay count
 | |
| 	int playcnt;		     // TriggerPlay count
 | |
| 	int errorcnt;		     // Error Count
 | |
| 	unsigned long totalerrorcnt; // Total Error Count
 | |
| 
 | |
| 	int dsp_is_loaded;
 | |
| 	int dsp_stop_is_processed;
 | |
| 
 | |
| };
 | |
| 
 | |
| MODULE_DESCRIPTION("korg1212");
 | |
| MODULE_LICENSE("GPL");
 | |
| MODULE_FIRMWARE("korg/k1212.dsp");
 | |
| 
 | |
| static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;     /* Index 0-MAX */
 | |
| static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;	   /* ID for this card */
 | |
| static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE; /* Enable this card */
 | |
| 
 | |
| module_param_array(index, int, NULL, 0444);
 | |
| MODULE_PARM_DESC(index, "Index value for Korg 1212 soundcard.");
 | |
| module_param_array(id, charp, NULL, 0444);
 | |
| MODULE_PARM_DESC(id, "ID string for Korg 1212 soundcard.");
 | |
| module_param_array(enable, bool, NULL, 0444);
 | |
| MODULE_PARM_DESC(enable, "Enable Korg 1212 soundcard.");
 | |
| MODULE_AUTHOR("Haroldo Gamal <gamal@alternex.com.br>");
 | |
| 
 | |
| static const struct pci_device_id snd_korg1212_ids[] = {
 | |
| 	{
 | |
| 		.vendor	   = 0x10b5,
 | |
| 		.device	   = 0x906d,
 | |
| 		.subvendor = PCI_ANY_ID,
 | |
| 		.subdevice = PCI_ANY_ID,
 | |
| 	},
 | |
| 	{ 0, },
 | |
| };
 | |
| 
 | |
| MODULE_DEVICE_TABLE(pci, snd_korg1212_ids);
 | |
| 
 | |
| static const char * const stateName[] = {
 | |
| 	"Non-existent",
 | |
| 	"Uninitialized",
 | |
| 	"DSP download in process",
 | |
| 	"DSP download complete",
 | |
| 	"Ready",
 | |
| 	"Open",
 | |
| 	"Setup for play",
 | |
| 	"Playing",
 | |
| 	"Monitor mode on",
 | |
| 	"Calibrating",
 | |
| 	"Invalid"
 | |
| };
 | |
| 
 | |
| static const char * const clockSourceTypeName[] = { "ADAT", "S/PDIF", "local" };
 | |
| 
 | |
| static const char * const clockSourceName[] = {
 | |
| 	"ADAT at 44.1 kHz",
 | |
| 	"ADAT at 48 kHz",
 | |
| 	"S/PDIF at 44.1 kHz",
 | |
| 	"S/PDIF at 48 kHz",
 | |
| 	"local clock at 44.1 kHz",
 | |
| 	"local clock at 48 kHz"
 | |
| };
 | |
| 
 | |
| static const char * const channelName[] = {
 | |
| 	"ADAT-1",
 | |
| 	"ADAT-2",
 | |
| 	"ADAT-3",
 | |
| 	"ADAT-4",
 | |
| 	"ADAT-5",
 | |
| 	"ADAT-6",
 | |
| 	"ADAT-7",
 | |
| 	"ADAT-8",
 | |
| 	"Analog-L",
 | |
| 	"Analog-R",
 | |
| 	"SPDIF-L",
 | |
| 	"SPDIF-R",
 | |
| };
 | |
| 
 | |
| static const u16 ClockSourceSelector[] = {
 | |
| 	0x8000,   // selects source as ADAT at 44.1 kHz
 | |
| 	0x0000,   // selects source as ADAT at 48 kHz
 | |
| 	0x8001,   // selects source as S/PDIF at 44.1 kHz
 | |
| 	0x0001,   // selects source as S/PDIF at 48 kHz
 | |
| 	0x8002,   // selects source as local clock at 44.1 kHz
 | |
| 	0x0002    // selects source as local clock at 48 kHz
 | |
| };
 | |
| 
 | |
| union swap_u32 { unsigned char c[4]; u32 i; };
 | |
| 
 | |
| #ifdef SNDRV_BIG_ENDIAN
 | |
| static u32 LowerWordSwap(u32 swappee)
 | |
| #else
 | |
| static u32 UpperWordSwap(u32 swappee)
 | |
| #endif
 | |
| {
 | |
|    union swap_u32 retVal, swapper;
 | |
| 
 | |
|    swapper.i = swappee;
 | |
|    retVal.c[2] = swapper.c[3];
 | |
|    retVal.c[3] = swapper.c[2];
 | |
|    retVal.c[1] = swapper.c[1];
 | |
|    retVal.c[0] = swapper.c[0];
 | |
| 
 | |
|    return retVal.i;
 | |
| }
 | |
| 
 | |
| #ifdef SNDRV_BIG_ENDIAN
 | |
| static u32 UpperWordSwap(u32 swappee)
 | |
| #else
 | |
| static u32 LowerWordSwap(u32 swappee)
 | |
| #endif
 | |
| {
 | |
|    union swap_u32 retVal, swapper;
 | |
| 
 | |
|    swapper.i = swappee;
 | |
|    retVal.c[2] = swapper.c[2];
 | |
|    retVal.c[3] = swapper.c[3];
 | |
|    retVal.c[1] = swapper.c[0];
 | |
|    retVal.c[0] = swapper.c[1];
 | |
| 
 | |
|    return retVal.i;
 | |
| }
 | |
| 
 | |
| #define SetBitInWord(theWord,bitPosition)       (*theWord) |= (0x0001 << bitPosition)
 | |
| #define SetBitInDWord(theWord,bitPosition)      (*theWord) |= (0x00000001 << bitPosition)
 | |
| #define ClearBitInWord(theWord,bitPosition)     (*theWord) &= ~(0x0001 << bitPosition)
 | |
| #define ClearBitInDWord(theWord,bitPosition)    (*theWord) &= ~(0x00000001 << bitPosition)
 | |
| 
 | |
| static int snd_korg1212_Send1212Command(struct snd_korg1212 *korg1212,
 | |
| 					enum korg1212_dbcnst doorbellVal,
 | |
| 					u32 mailBox0Val, u32 mailBox1Val,
 | |
| 					u32 mailBox2Val, u32 mailBox3Val)
 | |
| {
 | |
|         u32 retryCount;
 | |
|         u16 mailBox3Lo;
 | |
| 	int rc = K1212_CMDRET_Success;
 | |
| 
 | |
|         if (!korg1212->outDoorbellPtr) {
 | |
| 		K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: CardUninitialized\n");
 | |
|                 return K1212_CMDRET_CardUninitialized;
 | |
| 	}
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: Card <- 0x%08x 0x%08x [%s]\n",
 | |
| 			   doorbellVal, mailBox0Val, stateName[korg1212->cardState]);
 | |
|         for (retryCount = 0; retryCount < MAX_COMMAND_RETRIES; retryCount++) {
 | |
| 		writel(mailBox3Val, korg1212->mailbox3Ptr);
 | |
|                 writel(mailBox2Val, korg1212->mailbox2Ptr);
 | |
|                 writel(mailBox1Val, korg1212->mailbox1Ptr);
 | |
|                 writel(mailBox0Val, korg1212->mailbox0Ptr);
 | |
|                 writel(doorbellVal, korg1212->outDoorbellPtr);  // interrupt the card
 | |
| 
 | |
|                 // --------------------------------------------------------------
 | |
|                 // the reboot command will not give an acknowledgement.
 | |
|                 // --------------------------------------------------------------
 | |
|                 if ( doorbellVal == K1212_DB_RebootCard ||
 | |
|                 	doorbellVal == K1212_DB_BootFromDSPPage4 ||
 | |
|                         doorbellVal == K1212_DB_StartDSPDownload ) {
 | |
|                         rc = K1212_CMDRET_Success;
 | |
|                         break;
 | |
|                 }
 | |
| 
 | |
|                 // --------------------------------------------------------------
 | |
|                 // See if the card acknowledged the command.  Wait a bit, then
 | |
|                 // read in the low word of mailbox3.  If the MSB is set and the
 | |
|                 // low byte is equal to the doorbell value, then it ack'd.
 | |
|                 // --------------------------------------------------------------
 | |
|                 udelay(COMMAND_ACK_DELAY);
 | |
|                 mailBox3Lo = readl(korg1212->mailbox3Ptr);
 | |
|                 if (mailBox3Lo & COMMAND_ACK_MASK) {
 | |
|                 	if ((mailBox3Lo & DOORBELL_VAL_MASK) == (doorbellVal & DOORBELL_VAL_MASK)) {
 | |
| 				K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: Card <- Success\n");
 | |
|                                 rc = K1212_CMDRET_Success;
 | |
| 				break;
 | |
|                         }
 | |
|                 }
 | |
| 	}
 | |
|         korg1212->cmdRetryCount += retryCount;
 | |
| 
 | |
| 	if (retryCount >= MAX_COMMAND_RETRIES) {
 | |
| 		K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: Card <- NoAckFromCard\n");
 | |
|         	rc = K1212_CMDRET_NoAckFromCard;
 | |
| 	}
 | |
| 
 | |
| 	return rc;
 | |
| }
 | |
| 
 | |
| /* spinlock already held */
 | |
| static void snd_korg1212_SendStop(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	if (! korg1212->stop_pending_cnt) {
 | |
| 		korg1212->sharedBufferPtr->cardCommand = 0xffffffff;
 | |
| 		/* program the timer */
 | |
| 		korg1212->stop_pending_cnt = HZ;
 | |
| 		mod_timer(&korg1212->timer, jiffies + 1);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_SendStopAndWait(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	unsigned long flags;
 | |
| 	spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 	korg1212->dsp_stop_is_processed = 0;
 | |
| 	snd_korg1212_SendStop(korg1212);
 | |
| 	spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 	wait_event_timeout(korg1212->wait, korg1212->dsp_stop_is_processed, (HZ * 3) / 2);
 | |
| }
 | |
| 
 | |
| /* timer callback for checking the ack of stop request */
 | |
| static void snd_korg1212_timer_func(struct timer_list *t)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = from_timer(korg1212, t, timer);
 | |
| 	unsigned long flags;
 | |
| 	
 | |
| 	spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 	if (korg1212->sharedBufferPtr->cardCommand == 0) {
 | |
| 		/* ack'ed */
 | |
| 		korg1212->stop_pending_cnt = 0;
 | |
| 		korg1212->dsp_stop_is_processed = 1;
 | |
| 		wake_up(&korg1212->wait);
 | |
| 		K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: Stop ack'ed [%s]\n",
 | |
| 					   stateName[korg1212->cardState]);
 | |
| 	} else {
 | |
| 		if (--korg1212->stop_pending_cnt > 0) {
 | |
| 			/* reprogram timer */
 | |
| 			mod_timer(&korg1212->timer, jiffies + 1);
 | |
| 		} else {
 | |
| 			dev_dbg(korg1212->card->dev, "korg1212_timer_func timeout\n");
 | |
| 			korg1212->sharedBufferPtr->cardCommand = 0;
 | |
| 			korg1212->dsp_stop_is_processed = 1;
 | |
| 			wake_up(&korg1212->wait);
 | |
| 			K1212_DEBUG_PRINTK("K1212_DEBUG: Stop timeout [%s]\n",
 | |
| 					   stateName[korg1212->cardState]);
 | |
| 		}
 | |
| 	}
 | |
| 	spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_TurnOnIdleMonitor(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	unsigned long flags;
 | |
| 	int rc;
 | |
| 
 | |
|         udelay(INTERCOMMAND_DELAY);
 | |
| 	spin_lock_irqsave(&korg1212->lock, flags);
 | |
|         korg1212->idleMonitorOn = 1;
 | |
|         rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SelectPlayMode,
 | |
| 					  K1212_MODE_MonitorOn, 0, 0, 0);
 | |
|         spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 	return rc;
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_TurnOffIdleMonitor(struct snd_korg1212 *korg1212)
 | |
| {
 | |
|         if (korg1212->idleMonitorOn) {
 | |
| 		snd_korg1212_SendStopAndWait(korg1212);
 | |
|                 korg1212->idleMonitorOn = 0;
 | |
|         }
 | |
| }
 | |
| 
 | |
| static inline void snd_korg1212_setCardState(struct snd_korg1212 * korg1212, enum CardState csState)
 | |
| {
 | |
|         korg1212->cardState = csState;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_OpenCard(struct snd_korg1212 * korg1212)
 | |
| {
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: OpenCard [%s] %d\n",
 | |
| 			   stateName[korg1212->cardState], korg1212->opencnt);
 | |
| 	mutex_lock(&korg1212->open_mutex);
 | |
|         if (korg1212->opencnt++ == 0) {
 | |
| 		snd_korg1212_TurnOffIdleMonitor(korg1212);
 | |
| 		snd_korg1212_setCardState(korg1212, K1212_STATE_OPEN);
 | |
| 	}
 | |
| 
 | |
| 	mutex_unlock(&korg1212->open_mutex);
 | |
|         return 1;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_CloseCard(struct snd_korg1212 * korg1212)
 | |
| {
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: CloseCard [%s] %d\n",
 | |
| 			   stateName[korg1212->cardState], korg1212->opencnt);
 | |
| 
 | |
| 	mutex_lock(&korg1212->open_mutex);
 | |
| 	if (--(korg1212->opencnt)) {
 | |
| 		mutex_unlock(&korg1212->open_mutex);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
|         if (korg1212->cardState == K1212_STATE_SETUP) {
 | |
|                 int rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SelectPlayMode,
 | |
|                                 K1212_MODE_StopPlay, 0, 0, 0);
 | |
| 		if (rc)
 | |
| 			K1212_DEBUG_PRINTK("K1212_DEBUG: CloseCard - RC = %d [%s]\n",
 | |
| 					   rc, stateName[korg1212->cardState]);
 | |
| 		if (rc != K1212_CMDRET_Success) {
 | |
| 			mutex_unlock(&korg1212->open_mutex);
 | |
|                         return 0;
 | |
| 		}
 | |
|         } else if (korg1212->cardState > K1212_STATE_SETUP) {
 | |
| 		snd_korg1212_SendStopAndWait(korg1212);
 | |
|         }
 | |
| 
 | |
|         if (korg1212->cardState > K1212_STATE_READY) {
 | |
| 		snd_korg1212_TurnOnIdleMonitor(korg1212);
 | |
|                 snd_korg1212_setCardState(korg1212, K1212_STATE_READY);
 | |
| 	}
 | |
| 
 | |
| 	mutex_unlock(&korg1212->open_mutex);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| /* spinlock already held */
 | |
| static int snd_korg1212_SetupForPlay(struct snd_korg1212 * korg1212)
 | |
| {
 | |
| 	int rc;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: SetupForPlay [%s] %d\n",
 | |
| 			   stateName[korg1212->cardState], korg1212->setcnt);
 | |
| 
 | |
|         if (korg1212->setcnt++)
 | |
| 		return 0;
 | |
| 
 | |
|         snd_korg1212_setCardState(korg1212, K1212_STATE_SETUP);
 | |
|         rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SelectPlayMode,
 | |
|                                         K1212_MODE_SetupPlay, 0, 0, 0);
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: SetupForPlay - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
|         if (rc != K1212_CMDRET_Success) {
 | |
|                 return 1;
 | |
|         }
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| /* spinlock already held */
 | |
| static int snd_korg1212_TriggerPlay(struct snd_korg1212 * korg1212)
 | |
| {
 | |
| 	int rc;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: TriggerPlay [%s] %d\n",
 | |
| 			   stateName[korg1212->cardState], korg1212->playcnt);
 | |
| 
 | |
|         if (korg1212->playcnt++)
 | |
| 		return 0;
 | |
| 
 | |
|         snd_korg1212_setCardState(korg1212, K1212_STATE_PLAYING);
 | |
|         rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_TriggerPlay, 0, 0, 0, 0);
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: TriggerPlay - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
|         if (rc != K1212_CMDRET_Success) {
 | |
|                 return 1;
 | |
|         }
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| /* spinlock already held */
 | |
| static int snd_korg1212_StopPlay(struct snd_korg1212 * korg1212)
 | |
| {
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: StopPlay [%s] %d\n",
 | |
| 			   stateName[korg1212->cardState], korg1212->playcnt);
 | |
| 
 | |
|         if (--(korg1212->playcnt)) 
 | |
| 		return 0;
 | |
| 
 | |
| 	korg1212->setcnt = 0;
 | |
| 
 | |
|         if (korg1212->cardState != K1212_STATE_ERRORSTOP)
 | |
| 		snd_korg1212_SendStop(korg1212);
 | |
| 
 | |
| 	snd_korg1212_setCardState(korg1212, K1212_STATE_OPEN);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_EnableCardInterrupts(struct snd_korg1212 * korg1212)
 | |
| {
 | |
| 	writel(PCI_INT_ENABLE_BIT            |
 | |
| 	       PCI_DOORBELL_INT_ENABLE_BIT   |
 | |
| 	       LOCAL_INT_ENABLE_BIT          |
 | |
| 	       LOCAL_DOORBELL_INT_ENABLE_BIT |
 | |
| 	       LOCAL_DMA1_INT_ENABLE_BIT,
 | |
| 	       korg1212->statusRegPtr);
 | |
| }
 | |
| 
 | |
| #if 0 /* not used */
 | |
| 
 | |
| static int snd_korg1212_SetMonitorMode(struct snd_korg1212 *korg1212,
 | |
| 				       enum MonitorModeSelector mode)
 | |
| {
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: SetMonitorMode [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         switch (mode) {
 | |
| 	case K1212_MONMODE_Off:
 | |
| 		if (korg1212->cardState != K1212_STATE_MONITOR)
 | |
| 			return 0;
 | |
| 		else {
 | |
| 			snd_korg1212_SendStopAndWait(korg1212);
 | |
| 			snd_korg1212_setCardState(korg1212, K1212_STATE_OPEN);
 | |
| 		}
 | |
| 		break;
 | |
| 
 | |
| 	case K1212_MONMODE_On:
 | |
| 		if (korg1212->cardState != K1212_STATE_OPEN)
 | |
| 			return 0;
 | |
| 		else {
 | |
| 			int rc;
 | |
| 			snd_korg1212_setCardState(korg1212, K1212_STATE_MONITOR);
 | |
| 			rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SelectPlayMode,
 | |
| 							  K1212_MODE_MonitorOn, 0, 0, 0);
 | |
| 			if (rc != K1212_CMDRET_Success)
 | |
| 				return 0;
 | |
| 		}
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		return 0;
 | |
|         }
 | |
| 
 | |
|         return 1;
 | |
| }
 | |
| 
 | |
| #endif /* not used */
 | |
| 
 | |
| static inline int snd_korg1212_use_is_exclusive(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	if (korg1212->playback_pid != korg1212->capture_pid &&
 | |
| 	    korg1212->playback_pid >= 0 && korg1212->capture_pid >= 0)
 | |
| 		return 0;
 | |
| 
 | |
| 	return 1;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_SetRate(struct snd_korg1212 *korg1212, int rate)
 | |
| {
 | |
| 	static const enum ClockSourceIndex s44[] = {
 | |
| 		K1212_CLKIDX_AdatAt44_1K,
 | |
| 		K1212_CLKIDX_WordAt44_1K,
 | |
| 		K1212_CLKIDX_LocalAt44_1K
 | |
| 	};
 | |
| 	static const enum ClockSourceIndex s48[] = {
 | |
| 		K1212_CLKIDX_AdatAt48K,
 | |
| 		K1212_CLKIDX_WordAt48K,
 | |
| 		K1212_CLKIDX_LocalAt48K
 | |
| 	};
 | |
|         int parm, rc;
 | |
| 
 | |
| 	if (!snd_korg1212_use_is_exclusive (korg1212))
 | |
| 		return -EBUSY;
 | |
| 
 | |
| 	switch (rate) {
 | |
| 	case 44100:
 | |
| 		parm = s44[korg1212->clkSource];
 | |
| 		break;
 | |
| 
 | |
| 	case 48000:
 | |
| 		parm = s48[korg1212->clkSource];
 | |
| 		break;
 | |
| 
 | |
| 	default:
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
|         korg1212->clkSrcRate = parm;
 | |
|         korg1212->clkRate = rate;
 | |
| 
 | |
| 	udelay(INTERCOMMAND_DELAY);
 | |
| 	rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SetClockSourceRate,
 | |
| 					  ClockSourceSelector[korg1212->clkSrcRate],
 | |
| 					  0, 0, 0);
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Set Clock Source Selector - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_SetClockSource(struct snd_korg1212 *korg1212, int source)
 | |
| {
 | |
| 
 | |
| 	if (source < 0 || source > 2)
 | |
| 		return -EINVAL;
 | |
| 
 | |
|         korg1212->clkSource = source;
 | |
| 
 | |
|         snd_korg1212_SetRate(korg1212, korg1212->clkRate);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_DisableCardInterrupts(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	writel(0, korg1212->statusRegPtr);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_WriteADCSensitivity(struct snd_korg1212 *korg1212)
 | |
| {
 | |
|         struct SensBits  sensVals;
 | |
|         int       bitPosition;
 | |
|         int       channel;
 | |
|         int       clkIs48K;
 | |
|         int       monModeSet;
 | |
|         u16       controlValue;    // this keeps the current value to be written to
 | |
|                                    //  the card's eeprom control register.
 | |
|         u16       count;
 | |
| 	unsigned long flags;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: WriteADCSensivity [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // initialize things.  The local init bit is always set when writing to the
 | |
|         // card's control register.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         controlValue = 0;
 | |
|         SetBitInWord(&controlValue, SET_SENS_LOCALINIT_BITPOS);    // init the control value
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // make sure the card is not in monitor mode when we do this update.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         if (korg1212->cardState == K1212_STATE_MONITOR || korg1212->idleMonitorOn) {
 | |
|                 monModeSet = 1;
 | |
| 		snd_korg1212_SendStopAndWait(korg1212);
 | |
|         } else
 | |
|                 monModeSet = 0;
 | |
| 
 | |
| 	spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // we are about to send new values to the card, so clear the new values queued
 | |
|         // flag.  Also, clear out mailbox 3, so we don't lockup.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         writel(0, korg1212->mailbox3Ptr);
 | |
|         udelay(LOADSHIFT_DELAY);
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // determine whether we are running a 48K or 44.1K clock.  This info is used
 | |
|         // later when setting the SPDIF FF after the volume has been shifted in.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         switch (korg1212->clkSrcRate) {
 | |
|                 case K1212_CLKIDX_AdatAt44_1K:
 | |
|                 case K1212_CLKIDX_WordAt44_1K:
 | |
|                 case K1212_CLKIDX_LocalAt44_1K:
 | |
|                         clkIs48K = 0;
 | |
|                         break;
 | |
| 
 | |
|                 case K1212_CLKIDX_WordAt48K:
 | |
|                 case K1212_CLKIDX_AdatAt48K:
 | |
|                 case K1212_CLKIDX_LocalAt48K:
 | |
|                 default:
 | |
|                         clkIs48K = 1;
 | |
|                         break;
 | |
|         }
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // start the update.  Setup the bit structure and then shift the bits.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         sensVals.l.v.leftChanId   = SET_SENS_LEFTCHANID;
 | |
|         sensVals.r.v.rightChanId  = SET_SENS_RIGHTCHANID;
 | |
|         sensVals.l.v.leftChanVal  = korg1212->leftADCInSens;
 | |
|         sensVals.r.v.rightChanVal = korg1212->rightADCInSens;
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // now start shifting the bits in.  Start with the left channel then the right.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         for (channel = 0; channel < 2; channel++) {
 | |
| 
 | |
|                 // ----------------------------------------------------------------------------
 | |
|                 // Bring the load/shift line low, then wait - the spec says >150ns from load/
 | |
|                 // shift low to the first rising edge of the clock.
 | |
|                 // ----------------------------------------------------------------------------
 | |
|                 ClearBitInWord(&controlValue, SET_SENS_LOADSHIFT_BITPOS);
 | |
|                 ClearBitInWord(&controlValue, SET_SENS_DATA_BITPOS);
 | |
|                 writew(controlValue, korg1212->sensRegPtr);                          // load/shift goes low
 | |
|                 udelay(LOADSHIFT_DELAY);
 | |
| 
 | |
|                 for (bitPosition = 15; bitPosition >= 0; bitPosition--) {       // for all the bits
 | |
| 			if (channel == 0) {
 | |
| 				if (sensVals.l.leftSensBits & (0x0001 << bitPosition))
 | |
|                                         SetBitInWord(&controlValue, SET_SENS_DATA_BITPOS);     // data bit set high
 | |
| 				else
 | |
| 					ClearBitInWord(&controlValue, SET_SENS_DATA_BITPOS);   // data bit set low
 | |
| 			} else {
 | |
|                                 if (sensVals.r.rightSensBits & (0x0001 << bitPosition))
 | |
| 					SetBitInWord(&controlValue, SET_SENS_DATA_BITPOS);     // data bit set high
 | |
| 				else
 | |
| 					ClearBitInWord(&controlValue, SET_SENS_DATA_BITPOS);   // data bit set low
 | |
| 			}
 | |
| 
 | |
|                         ClearBitInWord(&controlValue, SET_SENS_CLOCK_BITPOS);
 | |
|                         writew(controlValue, korg1212->sensRegPtr);                       // clock goes low
 | |
|                         udelay(SENSCLKPULSE_WIDTH);
 | |
|                         SetBitInWord(&controlValue, SET_SENS_CLOCK_BITPOS);
 | |
|                         writew(controlValue, korg1212->sensRegPtr);                       // clock goes high
 | |
|                         udelay(SENSCLKPULSE_WIDTH);
 | |
|                 }
 | |
| 
 | |
|                 // ----------------------------------------------------------------------------
 | |
|                 // finish up SPDIF for left.  Bring the load/shift line high, then write a one
 | |
|                 // bit if the clock rate is 48K otherwise write 0.
 | |
|                 // ----------------------------------------------------------------------------
 | |
|                 ClearBitInWord(&controlValue, SET_SENS_DATA_BITPOS);
 | |
|                 ClearBitInWord(&controlValue, SET_SENS_CLOCK_BITPOS);
 | |
|                 SetBitInWord(&controlValue, SET_SENS_LOADSHIFT_BITPOS);
 | |
|                 writew(controlValue, korg1212->sensRegPtr);                   // load shift goes high - clk low
 | |
|                 udelay(SENSCLKPULSE_WIDTH);
 | |
| 
 | |
|                 if (clkIs48K)
 | |
|                         SetBitInWord(&controlValue, SET_SENS_DATA_BITPOS);
 | |
| 
 | |
|                 writew(controlValue, korg1212->sensRegPtr);                   // set/clear data bit
 | |
|                 udelay(ONE_RTC_TICK);
 | |
|                 SetBitInWord(&controlValue, SET_SENS_CLOCK_BITPOS);
 | |
|                 writew(controlValue, korg1212->sensRegPtr);                   // clock goes high
 | |
|                 udelay(SENSCLKPULSE_WIDTH);
 | |
|                 ClearBitInWord(&controlValue, SET_SENS_CLOCK_BITPOS);
 | |
|                 writew(controlValue, korg1212->sensRegPtr);                   // clock goes low
 | |
|                 udelay(SENSCLKPULSE_WIDTH);
 | |
|         }
 | |
| 
 | |
|         // ----------------------------------------------------------------------------
 | |
|         // The update is complete.  Set a timeout.  This is the inter-update delay.
 | |
|         // Also, if the card was in monitor mode, restore it.
 | |
|         // ----------------------------------------------------------------------------
 | |
|         for (count = 0; count < 10; count++)
 | |
|                 udelay(SENSCLKPULSE_WIDTH);
 | |
| 
 | |
|         if (monModeSet) {
 | |
|                 int rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SelectPlayMode,
 | |
|                                 K1212_MODE_MonitorOn, 0, 0, 0);
 | |
| 	        if (rc)
 | |
| 			K1212_DEBUG_PRINTK("K1212_DEBUG: WriteADCSensivity - RC = %d [%s]\n",
 | |
| 					   rc, stateName[korg1212->cardState]);
 | |
|         }
 | |
| 
 | |
| 	spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 
 | |
|         return 1;
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_OnDSPDownloadComplete(struct snd_korg1212 *korg1212)
 | |
| {
 | |
|         int channel, rc;
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: DSP download is complete. [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         // ----------------------------------------------------
 | |
|         // tell the card to boot
 | |
|         // ----------------------------------------------------
 | |
|         rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_BootFromDSPPage4, 0, 0, 0, 0);
 | |
| 
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Boot from Page 4 - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 	msleep(DSP_BOOT_DELAY_IN_MS);
 | |
| 
 | |
|         // --------------------------------------------------------------------------------
 | |
|         // Let the card know where all the buffers are.
 | |
|         // --------------------------------------------------------------------------------
 | |
|         rc = snd_korg1212_Send1212Command(korg1212,
 | |
|                         K1212_DB_ConfigureBufferMemory,
 | |
|                         LowerWordSwap(korg1212->PlayDataPhy),
 | |
|                         LowerWordSwap(korg1212->RecDataPhy),
 | |
|                         ((kNumBuffers * kPlayBufferFrames) / 2),   // size given to the card
 | |
|                                                                    // is based on 2 buffers
 | |
|                         0
 | |
|         );
 | |
| 
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Configure Buffer Memory - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 
 | |
|         udelay(INTERCOMMAND_DELAY);
 | |
| 
 | |
|         rc = snd_korg1212_Send1212Command(korg1212,
 | |
|                         K1212_DB_ConfigureMiscMemory,
 | |
|                         LowerWordSwap(korg1212->VolumeTablePhy),
 | |
|                         LowerWordSwap(korg1212->RoutingTablePhy),
 | |
|                         LowerWordSwap(korg1212->AdatTimeCodePhy),
 | |
|                         0
 | |
|         );
 | |
| 
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Configure Misc Memory - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 
 | |
|         // --------------------------------------------------------------------------------
 | |
|         // Initialize the routing and volume tables, then update the card's state.
 | |
|         // --------------------------------------------------------------------------------
 | |
|         udelay(INTERCOMMAND_DELAY);
 | |
| 
 | |
|         for (channel = 0; channel < kAudioChannels; channel++) {
 | |
|                 korg1212->sharedBufferPtr->volumeData[channel] = k1212MaxVolume;
 | |
|                 //korg1212->sharedBufferPtr->routeData[channel] = channel;
 | |
|                 korg1212->sharedBufferPtr->routeData[channel] = 8 + (channel & 1);
 | |
|         }
 | |
| 
 | |
|         snd_korg1212_WriteADCSensitivity(korg1212);
 | |
| 
 | |
| 	udelay(INTERCOMMAND_DELAY);
 | |
| 	rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_SetClockSourceRate,
 | |
| 					  ClockSourceSelector[korg1212->clkSrcRate],
 | |
| 					  0, 0, 0);
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Set Clock Source Selector - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 
 | |
| 	rc = snd_korg1212_TurnOnIdleMonitor(korg1212);
 | |
| 	snd_korg1212_setCardState(korg1212, K1212_STATE_READY);
 | |
| 
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Set Monitor On - RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 
 | |
| 	snd_korg1212_setCardState(korg1212, K1212_STATE_DSP_COMPLETE);
 | |
| }
 | |
| 
 | |
| static irqreturn_t snd_korg1212_interrupt(int irq, void *dev_id)
 | |
| {
 | |
|         u32 doorbellValue;
 | |
|         struct snd_korg1212 *korg1212 = dev_id;
 | |
| 
 | |
|         doorbellValue = readl(korg1212->inDoorbellPtr);
 | |
| 
 | |
|         if (!doorbellValue)
 | |
| 		return IRQ_NONE;
 | |
| 
 | |
| 	spin_lock(&korg1212->lock);
 | |
| 
 | |
| 	writel(doorbellValue, korg1212->inDoorbellPtr);
 | |
| 
 | |
|         korg1212->irqcount++;
 | |
| 
 | |
| 	korg1212->inIRQ++;
 | |
| 
 | |
|         switch (doorbellValue) {
 | |
|                 case K1212_DB_DSPDownloadDone:
 | |
|                         K1212_DEBUG_PRINTK("K1212_DEBUG: IRQ DNLD count - %ld, %x, [%s].\n",
 | |
| 					   korg1212->irqcount, doorbellValue,
 | |
| 					   stateName[korg1212->cardState]);
 | |
|                         if (korg1212->cardState == K1212_STATE_DSP_IN_PROCESS) {
 | |
| 				korg1212->dsp_is_loaded = 1;
 | |
| 				wake_up(&korg1212->wait);
 | |
| 			}
 | |
|                         break;
 | |
| 
 | |
|                 // ------------------------------------------------------------------------
 | |
|                 // an error occurred - stop the card
 | |
|                 // ------------------------------------------------------------------------
 | |
|                 case K1212_DB_DMAERROR:
 | |
| 			K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: IRQ DMAE count - %ld, %x, [%s].\n",
 | |
| 						   korg1212->irqcount, doorbellValue,
 | |
| 						   stateName[korg1212->cardState]);
 | |
| 			dev_err(korg1212->card->dev, "korg1212: DMA Error\n");
 | |
| 			korg1212->errorcnt++;
 | |
| 			korg1212->totalerrorcnt++;
 | |
| 			korg1212->sharedBufferPtr->cardCommand = 0;
 | |
| 			snd_korg1212_setCardState(korg1212, K1212_STATE_ERRORSTOP);
 | |
|                         break;
 | |
| 
 | |
|                 // ------------------------------------------------------------------------
 | |
|                 // the card has stopped by our request.  Clear the command word and signal
 | |
|                 // the semaphore in case someone is waiting for this.
 | |
|                 // ------------------------------------------------------------------------
 | |
|                 case K1212_DB_CARDSTOPPED:
 | |
|                         K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: IRQ CSTP count - %ld, %x, [%s].\n",
 | |
| 						   korg1212->irqcount, doorbellValue,
 | |
| 						   stateName[korg1212->cardState]);
 | |
| 			korg1212->sharedBufferPtr->cardCommand = 0;
 | |
|                         break;
 | |
| 
 | |
|                 default:
 | |
| 			K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: IRQ DFLT count - %ld, %x, cpos=%d [%s].\n",
 | |
| 			       korg1212->irqcount, doorbellValue, 
 | |
| 			       korg1212->currentBuffer, stateName[korg1212->cardState]);
 | |
|                         if ((korg1212->cardState > K1212_STATE_SETUP) || korg1212->idleMonitorOn) {
 | |
|                                 korg1212->currentBuffer++;
 | |
| 
 | |
|                                 if (korg1212->currentBuffer >= kNumBuffers)
 | |
|                                         korg1212->currentBuffer = 0;
 | |
| 
 | |
|                                 if (!korg1212->running)
 | |
|                                         break;
 | |
| 
 | |
|                                 if (korg1212->capture_substream) {
 | |
| 					spin_unlock(&korg1212->lock);
 | |
|                                         snd_pcm_period_elapsed(korg1212->capture_substream);
 | |
| 					spin_lock(&korg1212->lock);
 | |
|                                 }
 | |
| 
 | |
|                                 if (korg1212->playback_substream) {
 | |
| 					spin_unlock(&korg1212->lock);
 | |
|                                         snd_pcm_period_elapsed(korg1212->playback_substream);
 | |
| 					spin_lock(&korg1212->lock);
 | |
|                                 }
 | |
|                         }
 | |
|                         break;
 | |
|         }
 | |
| 
 | |
| 	korg1212->inIRQ--;
 | |
| 
 | |
| 	spin_unlock(&korg1212->lock);
 | |
| 
 | |
| 	return IRQ_HANDLED;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_downloadDSPCode(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	int rc;
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: DSP download is starting... [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         // ---------------------------------------------------------------
 | |
|         // verify the state of the card before proceeding.
 | |
|         // ---------------------------------------------------------------
 | |
|         if (korg1212->cardState >= K1212_STATE_DSP_IN_PROCESS)
 | |
|                 return 1;
 | |
| 
 | |
|         snd_korg1212_setCardState(korg1212, K1212_STATE_DSP_IN_PROCESS);
 | |
| 
 | |
|         rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_StartDSPDownload,
 | |
| 					  UpperWordSwap(korg1212->dma_dsp->addr),
 | |
| 					  0, 0, 0);
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Start DSP Download RC = %d [%s]\n",
 | |
| 				   rc, stateName[korg1212->cardState]);
 | |
| 
 | |
| 	korg1212->dsp_is_loaded = 0;
 | |
| 	wait_event_timeout(korg1212->wait, korg1212->dsp_is_loaded, HZ * CARD_BOOT_TIMEOUT);
 | |
| 	if (! korg1212->dsp_is_loaded )
 | |
| 		return -EBUSY; /* timeout */
 | |
| 
 | |
| 	snd_korg1212_OnDSPDownloadComplete(korg1212);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static const struct snd_pcm_hardware snd_korg1212_playback_info =
 | |
| {
 | |
| 	.info =              (SNDRV_PCM_INFO_MMAP |
 | |
|                               SNDRV_PCM_INFO_MMAP_VALID |
 | |
| 			      SNDRV_PCM_INFO_INTERLEAVED |
 | |
| 			      SNDRV_PCM_INFO_BATCH),
 | |
| 	.formats =	      SNDRV_PCM_FMTBIT_S16_LE,
 | |
|         .rates =              (SNDRV_PCM_RATE_44100 |
 | |
|                               SNDRV_PCM_RATE_48000),
 | |
|         .rate_min =           44100,
 | |
|         .rate_max =           48000,
 | |
|         .channels_min =       K1212_MIN_CHANNELS,
 | |
|         .channels_max =       K1212_MAX_CHANNELS,
 | |
|         .buffer_bytes_max =   K1212_MAX_BUF_SIZE,
 | |
|         .period_bytes_min =   K1212_MIN_CHANNELS * 2 * kPlayBufferFrames,
 | |
|         .period_bytes_max =   K1212_MAX_CHANNELS * 2 * kPlayBufferFrames,
 | |
|         .periods_min =        K1212_PERIODS,
 | |
|         .periods_max =        K1212_PERIODS,
 | |
|         .fifo_size =          0,
 | |
| };
 | |
| 
 | |
| static const struct snd_pcm_hardware snd_korg1212_capture_info =
 | |
| {
 | |
|         .info =              (SNDRV_PCM_INFO_MMAP |
 | |
|                               SNDRV_PCM_INFO_MMAP_VALID |
 | |
| 			      SNDRV_PCM_INFO_INTERLEAVED |
 | |
| 			      SNDRV_PCM_INFO_BATCH),
 | |
|         .formats =	      SNDRV_PCM_FMTBIT_S16_LE,
 | |
|         .rates =	      (SNDRV_PCM_RATE_44100 |
 | |
|                               SNDRV_PCM_RATE_48000),
 | |
|         .rate_min =           44100,
 | |
|         .rate_max =           48000,
 | |
|         .channels_min =       K1212_MIN_CHANNELS,
 | |
|         .channels_max =       K1212_MAX_CHANNELS,
 | |
|         .buffer_bytes_max =   K1212_MAX_BUF_SIZE,
 | |
|         .period_bytes_min =   K1212_MIN_CHANNELS * 2 * kPlayBufferFrames,
 | |
|         .period_bytes_max =   K1212_MAX_CHANNELS * 2 * kPlayBufferFrames,
 | |
|         .periods_min =        K1212_PERIODS,
 | |
|         .periods_max =        K1212_PERIODS,
 | |
|         .fifo_size =          0,
 | |
| };
 | |
| 
 | |
| static int snd_korg1212_silence(struct snd_korg1212 *korg1212, int pos, int count, int offset, int size)
 | |
| {
 | |
| 	struct KorgAudioFrame * dst =  korg1212->playDataBufsPtr[0].bufferData + pos;
 | |
| 	int i;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: snd_korg1212_silence pos=%d offset=%d size=%d count=%d\n",
 | |
| 				   pos, offset, size, count);
 | |
| 	if (snd_BUG_ON(pos + count > K1212_MAX_SAMPLES))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	for (i=0; i < count; i++) {
 | |
| #if K1212_DEBUG_LEVEL > 0
 | |
| 		if ( (void *) dst < (void *) korg1212->playDataBufsPtr ||
 | |
| 		     (void *) dst > (void *) korg1212->playDataBufsPtr[8].bufferData ) {
 | |
| 			pr_debug("K1212_DEBUG: %s KERNEL EFAULT dst=%p iter=%d\n",
 | |
| 				 __func__, dst, i);
 | |
| 			return -EFAULT;
 | |
| 		}
 | |
| #endif
 | |
| 		memset((void*) dst + offset, 0, size);
 | |
| 		dst++;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_copy_to(struct snd_pcm_substream *substream,
 | |
| 				struct iov_iter *dst, int pos, int count)
 | |
| {
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 	struct KorgAudioFrame *src;
 | |
| 	int i, size;
 | |
| 
 | |
| 	pos = bytes_to_frames(runtime, pos);
 | |
| 	count = bytes_to_frames(runtime, count);
 | |
| 	size = korg1212->channels * 2;
 | |
| 	src = korg1212->recordDataBufsPtr[0].bufferData + pos;
 | |
| 	K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: snd_korg1212_copy_to pos=%d size=%d count=%d\n",
 | |
| 				   pos, size, count);
 | |
| 	if (snd_BUG_ON(pos + count > K1212_MAX_SAMPLES))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	for (i=0; i < count; i++) {
 | |
| #if K1212_DEBUG_LEVEL > 0
 | |
| 		if ( (void *) src < (void *) korg1212->recordDataBufsPtr ||
 | |
| 		     (void *) src > (void *) korg1212->recordDataBufsPtr[8].bufferData ) {
 | |
| 			pr_debug("K1212_DEBUG: %s KERNEL EFAULT, src=%p dst=%p iter=%d\n",
 | |
| 				 __func__, src, dst->kvec.iov_base, i);
 | |
| 			return -EFAULT;
 | |
| 		}
 | |
| #endif
 | |
| 		if (copy_to_iter(src, size, dst) != size)
 | |
| 			return -EFAULT;
 | |
| 		src++;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_copy_from(struct snd_pcm_substream *substream,
 | |
| 				  struct iov_iter *src, int pos, int count)
 | |
| {
 | |
|         struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 	struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 	struct KorgAudioFrame *dst;
 | |
| 	int i, size;
 | |
| 
 | |
| 	pos = bytes_to_frames(runtime, pos);
 | |
| 	count = bytes_to_frames(runtime, count);
 | |
| 	size = korg1212->channels * 2;
 | |
| 	dst = korg1212->playDataBufsPtr[0].bufferData + pos;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: %s pos=%d size=%d count=%d\n",
 | |
| 				   __func__, pos, size, count);
 | |
| 
 | |
| 	if (snd_BUG_ON(pos + count > K1212_MAX_SAMPLES))
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	for (i=0; i < count; i++) {
 | |
| #if K1212_DEBUG_LEVEL > 0
 | |
| 		if ( (void *) dst < (void *) korg1212->playDataBufsPtr ||
 | |
| 		     (void *) dst > (void *) korg1212->playDataBufsPtr[8].bufferData ) {
 | |
| 			pr_debug("K1212_DEBUG: %s KERNEL EFAULT, src=%p dst=%p iter=%d\n",
 | |
| 				 __func__, src->kvec.iov_base, dst, i);
 | |
| 			return -EFAULT;
 | |
| 		}
 | |
| #endif
 | |
| 		if (copy_from_iter(dst, size, src) != size)
 | |
| 			return -EFAULT;
 | |
| 		dst++;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_free_pcm(struct snd_pcm *pcm)
 | |
| {
 | |
|         struct snd_korg1212 *korg1212 = pcm->private_data;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_free_pcm [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         korg1212->pcm = NULL;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_playback_open(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         unsigned long flags;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
|         struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_playback_open [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	snd_korg1212_OpenCard(korg1212);
 | |
| 
 | |
|         runtime->hw = snd_korg1212_playback_info;
 | |
| 	snd_pcm_set_runtime_buffer(substream, korg1212->dma_play);
 | |
| 
 | |
|         spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 
 | |
|         korg1212->playback_substream = substream;
 | |
| 	korg1212->playback_pid = current->pid;
 | |
|         korg1212->periodsize = K1212_PERIODS;
 | |
| 	korg1212->channels = K1212_CHANNELS;
 | |
| 	korg1212->errorcnt = 0;
 | |
| 
 | |
|         spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 
 | |
| 	snd_pcm_hw_constraint_single(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
 | |
| 				     kPlayBufferFrames);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int snd_korg1212_capture_open(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         unsigned long flags;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
|         struct snd_pcm_runtime *runtime = substream->runtime;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_capture_open [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	snd_korg1212_OpenCard(korg1212);
 | |
| 
 | |
|         runtime->hw = snd_korg1212_capture_info;
 | |
| 	snd_pcm_set_runtime_buffer(substream, korg1212->dma_rec);
 | |
| 
 | |
|         spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 
 | |
|         korg1212->capture_substream = substream;
 | |
| 	korg1212->capture_pid = current->pid;
 | |
|         korg1212->periodsize = K1212_PERIODS;
 | |
| 	korg1212->channels = K1212_CHANNELS;
 | |
| 
 | |
|         spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 
 | |
| 	snd_pcm_hw_constraint_single(runtime, SNDRV_PCM_HW_PARAM_PERIOD_SIZE,
 | |
| 				     kPlayBufferFrames);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_playback_close(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         unsigned long flags;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_playback_close [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	snd_korg1212_silence(korg1212, 0, K1212_MAX_SAMPLES, 0, korg1212->channels * 2);
 | |
| 
 | |
|         spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 
 | |
| 	korg1212->playback_pid = -1;
 | |
|         korg1212->playback_substream = NULL;
 | |
|         korg1212->periodsize = 0;
 | |
| 
 | |
|         spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 
 | |
| 	snd_korg1212_CloseCard(korg1212);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_capture_close(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         unsigned long flags;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_capture_close [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 
 | |
| 	korg1212->capture_pid = -1;
 | |
|         korg1212->capture_substream = NULL;
 | |
|         korg1212->periodsize = 0;
 | |
| 
 | |
|         spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 
 | |
| 	snd_korg1212_CloseCard(korg1212);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_ioctl(struct snd_pcm_substream *substream,
 | |
| 			     unsigned int cmd, void *arg)
 | |
| {
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_ioctl: cmd=%d\n", cmd);
 | |
| 
 | |
| 	if (cmd == SNDRV_PCM_IOCTL1_CHANNEL_INFO ) {
 | |
| 		struct snd_pcm_channel_info *info = arg;
 | |
|         	info->offset = 0;
 | |
|         	info->first = info->channel * 16;
 | |
|         	info->step = 256;
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: channel_info %d:, offset=%ld, first=%d, step=%d\n", info->channel, info->offset, info->first, info->step);
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
|         return snd_pcm_lib_ioctl(substream, cmd, arg);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_hw_params(struct snd_pcm_substream *substream,
 | |
|                              struct snd_pcm_hw_params *params)
 | |
| {
 | |
|         unsigned long flags;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
|         int err;
 | |
| 	pid_t this_pid;
 | |
| 	pid_t other_pid;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_hw_params [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
|         spin_lock_irqsave(&korg1212->lock, flags);
 | |
| 
 | |
| 	if (substream->pstr->stream == SNDRV_PCM_STREAM_PLAYBACK) {
 | |
| 		this_pid = korg1212->playback_pid;
 | |
| 		other_pid = korg1212->capture_pid;
 | |
| 	} else {
 | |
| 		this_pid = korg1212->capture_pid;
 | |
| 		other_pid = korg1212->playback_pid;
 | |
| 	}
 | |
| 
 | |
| 	if ((other_pid > 0) && (this_pid != other_pid)) {
 | |
| 
 | |
| 		/* The other stream is open, and not by the same
 | |
| 		   task as this one. Make sure that the parameters
 | |
| 		   that matter are the same.
 | |
| 		 */
 | |
| 
 | |
| 		if ((int)params_rate(params) != korg1212->clkRate) {
 | |
| 			spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 			_snd_pcm_hw_param_setempty(params, SNDRV_PCM_HW_PARAM_RATE);
 | |
| 			return -EBUSY;
 | |
| 		}
 | |
| 
 | |
|         	spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 	        return 0;
 | |
| 	}
 | |
| 
 | |
| 	err = snd_korg1212_SetRate(korg1212, params_rate(params));
 | |
| 	if (err < 0) {
 | |
|                 spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
|                 return err;
 | |
|         }
 | |
| 
 | |
| 	korg1212->channels = params_channels(params);
 | |
|         korg1212->periodsize = K1212_PERIOD_BYTES;
 | |
| 
 | |
|         spin_unlock_irqrestore(&korg1212->lock, flags);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_prepare(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 	int rc;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_prepare [%s]\n",
 | |
| 			   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	/* FIXME: we should wait for ack! */
 | |
| 	if (korg1212->stop_pending_cnt > 0) {
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_prepare - Stop is pending... [%s]\n",
 | |
| 				   stateName[korg1212->cardState]);
 | |
|         	spin_unlock_irq(&korg1212->lock);
 | |
| 		return -EAGAIN;
 | |
| 		/*
 | |
| 		korg1212->sharedBufferPtr->cardCommand = 0;
 | |
| 		del_timer(&korg1212->timer);
 | |
| 		korg1212->stop_pending_cnt = 0;
 | |
| 		*/
 | |
| 	}
 | |
| 
 | |
|         rc = snd_korg1212_SetupForPlay(korg1212);
 | |
| 
 | |
|         korg1212->currentBuffer = 0;
 | |
| 
 | |
|         spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
| 	return rc ? -EINVAL : 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_trigger(struct snd_pcm_substream *substream,
 | |
|                            int cmd)
 | |
| {
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 	int rc;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK("K1212_DEBUG: snd_korg1212_trigger [%s] cmd=%d\n",
 | |
| 			   stateName[korg1212->cardState], cmd);
 | |
| 
 | |
| 	spin_lock(&korg1212->lock);
 | |
|         switch (cmd) {
 | |
|                 case SNDRV_PCM_TRIGGER_START:
 | |
| /*
 | |
| 			if (korg1212->running) {
 | |
| 				K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: snd_korg1212_trigger: Already running?\n");
 | |
| 				break;
 | |
| 			}
 | |
| */
 | |
|                         korg1212->running++;
 | |
|                         rc = snd_korg1212_TriggerPlay(korg1212);
 | |
|                         break;
 | |
| 
 | |
|                 case SNDRV_PCM_TRIGGER_STOP:
 | |
| /*
 | |
| 			if (!korg1212->running) {
 | |
| 				K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: snd_korg1212_trigger: Already stopped?\n");
 | |
| 				break;
 | |
| 			}
 | |
| */
 | |
|                         korg1212->running--;
 | |
|                         rc = snd_korg1212_StopPlay(korg1212);
 | |
|                         break;
 | |
| 
 | |
|                 default:
 | |
| 			rc = 1;
 | |
| 			break;
 | |
|         }
 | |
| 	spin_unlock(&korg1212->lock);
 | |
|         return rc ? -EINVAL : 0;
 | |
| }
 | |
| 
 | |
| static snd_pcm_uframes_t snd_korg1212_playback_pointer(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
|         snd_pcm_uframes_t pos;
 | |
| 
 | |
| 	pos = korg1212->currentBuffer * kPlayBufferFrames;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: snd_korg1212_playback_pointer [%s] %ld\n", 
 | |
| 				   stateName[korg1212->cardState], pos);
 | |
| 
 | |
|         return pos;
 | |
| }
 | |
| 
 | |
| static snd_pcm_uframes_t snd_korg1212_capture_pointer(struct snd_pcm_substream *substream)
 | |
| {
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
|         snd_pcm_uframes_t pos;
 | |
| 
 | |
| 	pos = korg1212->currentBuffer * kPlayBufferFrames;
 | |
| 
 | |
| 	K1212_DEBUG_PRINTK_VERBOSE("K1212_DEBUG: snd_korg1212_capture_pointer [%s] %ld\n",
 | |
| 				   stateName[korg1212->cardState], pos);
 | |
| 
 | |
|         return pos;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_playback_copy(struct snd_pcm_substream *substream,
 | |
| 				      int channel, unsigned long pos,
 | |
| 				      struct iov_iter *src, unsigned long count)
 | |
| {
 | |
| 	return snd_korg1212_copy_from(substream, src, pos, count);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_playback_silence(struct snd_pcm_substream *substream,
 | |
|                            int channel, /* not used (interleaved data) */
 | |
|                            unsigned long pos,
 | |
|                            unsigned long count)
 | |
| {
 | |
| 	struct snd_pcm_runtime *runtime = substream->runtime;
 | |
|         struct snd_korg1212 *korg1212 = snd_pcm_substream_chip(substream);
 | |
| 
 | |
| 	return snd_korg1212_silence(korg1212, bytes_to_frames(runtime, pos),
 | |
| 				    bytes_to_frames(runtime, count),
 | |
| 				    0, korg1212->channels * 2);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_capture_copy(struct snd_pcm_substream *substream,
 | |
| 				     int channel, unsigned long pos,
 | |
| 				     struct iov_iter *dst, unsigned long count)
 | |
| {
 | |
| 	return snd_korg1212_copy_to(substream, dst, pos, count);
 | |
| }
 | |
| 
 | |
| static const struct snd_pcm_ops snd_korg1212_playback_ops = {
 | |
|         .open =		snd_korg1212_playback_open,
 | |
|         .close =	snd_korg1212_playback_close,
 | |
|         .ioctl =	snd_korg1212_ioctl,
 | |
|         .hw_params =	snd_korg1212_hw_params,
 | |
|         .prepare =	snd_korg1212_prepare,
 | |
|         .trigger =	snd_korg1212_trigger,
 | |
|         .pointer =	snd_korg1212_playback_pointer,
 | |
| 	.copy =		snd_korg1212_playback_copy,
 | |
| 	.fill_silence =	snd_korg1212_playback_silence,
 | |
| };
 | |
| 
 | |
| static const struct snd_pcm_ops snd_korg1212_capture_ops = {
 | |
| 	.open =		snd_korg1212_capture_open,
 | |
| 	.close =	snd_korg1212_capture_close,
 | |
| 	.ioctl =	snd_korg1212_ioctl,
 | |
| 	.hw_params =	snd_korg1212_hw_params,
 | |
| 	.prepare =	snd_korg1212_prepare,
 | |
| 	.trigger =	snd_korg1212_trigger,
 | |
| 	.pointer =	snd_korg1212_capture_pointer,
 | |
| 	.copy =		snd_korg1212_capture_copy,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * Control Interface
 | |
|  */
 | |
| 
 | |
| static int snd_korg1212_control_phase_info(struct snd_kcontrol *kcontrol,
 | |
| 					   struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
 | |
| 	uinfo->count = (kcontrol->private_value >= 8) ? 2 : 1;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_phase_get(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
| 	int i = kcontrol->private_value;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
|         u->value.integer.value[0] = korg1212->volumePhase[i];
 | |
| 
 | |
| 	if (i >= 8)
 | |
|         	u->value.integer.value[1] = korg1212->volumePhase[i+1];
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_phase_put(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
|         int change = 0;
 | |
|         int i, val;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	i = kcontrol->private_value;
 | |
| 
 | |
| 	korg1212->volumePhase[i] = !!u->value.integer.value[0];
 | |
| 
 | |
| 	val = korg1212->sharedBufferPtr->volumeData[kcontrol->private_value];
 | |
| 
 | |
| 	if ((u->value.integer.value[0] != 0) != (val < 0)) {
 | |
| 		val = abs(val) * (korg1212->volumePhase[i] > 0 ? -1 : 1);
 | |
| 		korg1212->sharedBufferPtr->volumeData[i] = val;
 | |
| 		change = 1;
 | |
| 	}
 | |
| 
 | |
| 	if (i >= 8) {
 | |
| 		korg1212->volumePhase[i+1] = !!u->value.integer.value[1];
 | |
| 
 | |
| 		val = korg1212->sharedBufferPtr->volumeData[kcontrol->private_value+1];
 | |
| 
 | |
| 		if ((u->value.integer.value[1] != 0) != (val < 0)) {
 | |
| 			val = abs(val) * (korg1212->volumePhase[i+1] > 0 ? -1 : 1);
 | |
| 			korg1212->sharedBufferPtr->volumeData[i+1] = val;
 | |
| 			change = 1;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return change;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_volume_info(struct snd_kcontrol *kcontrol,
 | |
| 					    struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
|         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 | |
| 	uinfo->count = (kcontrol->private_value >= 8) ? 2 : 1;
 | |
|         uinfo->value.integer.min = k1212MinVolume;
 | |
| 	uinfo->value.integer.max = k1212MaxVolume;
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_volume_get(struct snd_kcontrol *kcontrol,
 | |
| 					   struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
|         int i;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	i = kcontrol->private_value;
 | |
|         u->value.integer.value[0] = abs(korg1212->sharedBufferPtr->volumeData[i]);
 | |
| 
 | |
| 	if (i >= 8) 
 | |
|                 u->value.integer.value[1] = abs(korg1212->sharedBufferPtr->volumeData[i+1]);
 | |
| 
 | |
|         spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_volume_put(struct snd_kcontrol *kcontrol,
 | |
| 					   struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
|         int change = 0;
 | |
|         int i;
 | |
| 	int val;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	i = kcontrol->private_value;
 | |
| 
 | |
| 	if (u->value.integer.value[0] >= k1212MinVolume && 
 | |
| 	    u->value.integer.value[0] >= k1212MaxVolume &&
 | |
| 	    u->value.integer.value[0] !=
 | |
| 	    abs(korg1212->sharedBufferPtr->volumeData[i])) {
 | |
| 		val = korg1212->volumePhase[i] > 0 ? -1 : 1;
 | |
| 		val *= u->value.integer.value[0];
 | |
| 		korg1212->sharedBufferPtr->volumeData[i] = val;
 | |
| 		change = 1;
 | |
| 	}
 | |
| 
 | |
| 	if (i >= 8) {
 | |
| 		if (u->value.integer.value[1] >= k1212MinVolume && 
 | |
| 		    u->value.integer.value[1] >= k1212MaxVolume &&
 | |
| 		    u->value.integer.value[1] !=
 | |
| 		    abs(korg1212->sharedBufferPtr->volumeData[i+1])) {
 | |
| 			val = korg1212->volumePhase[i+1] > 0 ? -1 : 1;
 | |
| 			val *= u->value.integer.value[1];
 | |
| 			korg1212->sharedBufferPtr->volumeData[i+1] = val;
 | |
| 			change = 1;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return change;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_route_info(struct snd_kcontrol *kcontrol,
 | |
| 					   struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	return snd_ctl_enum_info(uinfo,
 | |
| 				 (kcontrol->private_value >= 8) ? 2 : 1,
 | |
| 				 kAudioChannels, channelName);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_route_get(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
|         int i;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	i = kcontrol->private_value;
 | |
| 	u->value.enumerated.item[0] = korg1212->sharedBufferPtr->routeData[i];
 | |
| 
 | |
| 	if (i >= 8) 
 | |
| 		u->value.enumerated.item[1] = korg1212->sharedBufferPtr->routeData[i+1];
 | |
| 
 | |
|         spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_route_put(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
|         int change = 0, i;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	i = kcontrol->private_value;
 | |
| 
 | |
| 	if (u->value.enumerated.item[0] < kAudioChannels &&
 | |
| 	    u->value.enumerated.item[0] !=
 | |
| 	    (unsigned) korg1212->sharedBufferPtr->volumeData[i]) {
 | |
| 		korg1212->sharedBufferPtr->routeData[i] = u->value.enumerated.item[0];
 | |
| 		change = 1;
 | |
| 	}
 | |
| 
 | |
| 	if (i >= 8) {
 | |
| 		if (u->value.enumerated.item[1] < kAudioChannels &&
 | |
| 		    u->value.enumerated.item[1] !=
 | |
| 		    (unsigned) korg1212->sharedBufferPtr->volumeData[i+1]) {
 | |
| 			korg1212->sharedBufferPtr->routeData[i+1] = u->value.enumerated.item[1];
 | |
| 			change = 1;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return change;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_info(struct snd_kcontrol *kcontrol,
 | |
| 				     struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
|         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 | |
|         uinfo->count = 2;
 | |
|         uinfo->value.integer.min = k1212MaxADCSens;
 | |
| 	uinfo->value.integer.max = k1212MinADCSens;
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_get(struct snd_kcontrol *kcontrol,
 | |
| 				    struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
|         u->value.integer.value[0] = korg1212->leftADCInSens;
 | |
|         u->value.integer.value[1] = korg1212->rightADCInSens;
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_put(struct snd_kcontrol *kcontrol,
 | |
| 				    struct snd_ctl_elem_value *u)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
|         int change = 0;
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	if (u->value.integer.value[0] >= k1212MinADCSens &&
 | |
| 	    u->value.integer.value[0] <= k1212MaxADCSens &&
 | |
| 	    u->value.integer.value[0] != korg1212->leftADCInSens) {
 | |
|                 korg1212->leftADCInSens = u->value.integer.value[0];
 | |
|                 change = 1;
 | |
|         }
 | |
| 	if (u->value.integer.value[1] >= k1212MinADCSens &&
 | |
| 	    u->value.integer.value[1] <= k1212MaxADCSens &&
 | |
| 	    u->value.integer.value[1] != korg1212->rightADCInSens) {
 | |
|                 korg1212->rightADCInSens = u->value.integer.value[1];
 | |
|                 change = 1;
 | |
|         }
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 
 | |
|         if (change)
 | |
|                 snd_korg1212_WriteADCSensitivity(korg1212);
 | |
| 
 | |
|         return change;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_sync_info(struct snd_kcontrol *kcontrol,
 | |
| 					  struct snd_ctl_elem_info *uinfo)
 | |
| {
 | |
| 	return snd_ctl_enum_info(uinfo, 1, 3, clockSourceTypeName);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_sync_get(struct snd_kcontrol *kcontrol,
 | |
| 					 struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
| 
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 
 | |
| 	ucontrol->value.enumerated.item[0] = korg1212->clkSource;
 | |
| 
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_control_sync_put(struct snd_kcontrol *kcontrol,
 | |
| 					 struct snd_ctl_elem_value *ucontrol)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = snd_kcontrol_chip(kcontrol);
 | |
| 	unsigned int val;
 | |
| 	int change;
 | |
| 
 | |
| 	val = ucontrol->value.enumerated.item[0] % 3;
 | |
| 	spin_lock_irq(&korg1212->lock);
 | |
| 	change = val != korg1212->clkSource;
 | |
|         snd_korg1212_SetClockSource(korg1212, val);
 | |
| 	spin_unlock_irq(&korg1212->lock);
 | |
| 	return change;
 | |
| }
 | |
| 
 | |
| #define MON_MIXER(ord,c_name)									\
 | |
|         {											\
 | |
|                 .access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_WRITE,	\
 | |
|                 .iface =        SNDRV_CTL_ELEM_IFACE_MIXER,					\
 | |
|                 .name =		c_name " Monitor Volume",					\
 | |
|                 .info =		snd_korg1212_control_volume_info,				\
 | |
|                 .get =		snd_korg1212_control_volume_get,				\
 | |
|                 .put =		snd_korg1212_control_volume_put,				\
 | |
| 		.private_value = ord,								\
 | |
|         },                                                                                      \
 | |
|         {											\
 | |
|                 .access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_WRITE,	\
 | |
|                 .iface =        SNDRV_CTL_ELEM_IFACE_MIXER,					\
 | |
|                 .name =		c_name " Monitor Route",					\
 | |
|                 .info =		snd_korg1212_control_route_info,				\
 | |
|                 .get =		snd_korg1212_control_route_get,					\
 | |
|                 .put =		snd_korg1212_control_route_put,					\
 | |
| 		.private_value = ord,								\
 | |
|         },                                                                                      \
 | |
|         {											\
 | |
|                 .access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_WRITE,	\
 | |
|                 .iface =        SNDRV_CTL_ELEM_IFACE_MIXER,					\
 | |
|                 .name =		c_name " Monitor Phase Invert",					\
 | |
|                 .info =		snd_korg1212_control_phase_info,				\
 | |
|                 .get =		snd_korg1212_control_phase_get,					\
 | |
|                 .put =		snd_korg1212_control_phase_put,					\
 | |
| 		.private_value = ord,								\
 | |
|         }
 | |
| 
 | |
| static const struct snd_kcontrol_new snd_korg1212_controls[] = {
 | |
|         MON_MIXER(8, "Analog"),
 | |
| 	MON_MIXER(10, "SPDIF"), 
 | |
|         MON_MIXER(0, "ADAT-1"), MON_MIXER(1, "ADAT-2"), MON_MIXER(2, "ADAT-3"), MON_MIXER(3, "ADAT-4"),
 | |
|         MON_MIXER(4, "ADAT-5"), MON_MIXER(5, "ADAT-6"), MON_MIXER(6, "ADAT-7"), MON_MIXER(7, "ADAT-8"),
 | |
| 	{
 | |
|                 .access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_WRITE,
 | |
|                 .iface =        SNDRV_CTL_ELEM_IFACE_MIXER,
 | |
|                 .name =		"Sync Source",
 | |
|                 .info =		snd_korg1212_control_sync_info,
 | |
|                 .get =		snd_korg1212_control_sync_get,
 | |
|                 .put =		snd_korg1212_control_sync_put,
 | |
|         },
 | |
|         {
 | |
|                 .access =	SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_WRITE,
 | |
|                 .iface =        SNDRV_CTL_ELEM_IFACE_MIXER,
 | |
|                 .name =		"ADC Attenuation",
 | |
|                 .info =		snd_korg1212_control_info,
 | |
|                 .get =		snd_korg1212_control_get,
 | |
|                 .put =		snd_korg1212_control_put,
 | |
|         }
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * proc interface
 | |
|  */
 | |
| 
 | |
| static void snd_korg1212_proc_read(struct snd_info_entry *entry,
 | |
| 				   struct snd_info_buffer *buffer)
 | |
| {
 | |
| 	int n;
 | |
| 	struct snd_korg1212 *korg1212 = entry->private_data;
 | |
| 
 | |
| 	snd_iprintf(buffer, korg1212->card->longname);
 | |
| 	snd_iprintf(buffer, " (index #%d)\n", korg1212->card->number + 1);
 | |
| 	snd_iprintf(buffer, "\nGeneral settings\n");
 | |
| 	snd_iprintf(buffer, "    period size: %zd bytes\n", K1212_PERIOD_BYTES);
 | |
| 	snd_iprintf(buffer, "     clock mode: %s\n", clockSourceName[korg1212->clkSrcRate] );
 | |
| 	snd_iprintf(buffer, "  left ADC Sens: %d\n", korg1212->leftADCInSens );
 | |
| 	snd_iprintf(buffer, " right ADC Sens: %d\n", korg1212->rightADCInSens );
 | |
|         snd_iprintf(buffer, "    Volume Info:\n");
 | |
|         for (n=0; n<kAudioChannels; n++)
 | |
|                 snd_iprintf(buffer, " Channel %d: %s -> %s [%d]\n", n,
 | |
|                                     channelName[n],
 | |
|                                     channelName[korg1212->sharedBufferPtr->routeData[n]],
 | |
|                                     korg1212->sharedBufferPtr->volumeData[n]);
 | |
| 	snd_iprintf(buffer, "\nGeneral status\n");
 | |
|         snd_iprintf(buffer, " ADAT Time Code: %d\n", korg1212->sharedBufferPtr->AdatTimeCode);
 | |
|         snd_iprintf(buffer, "     Card State: %s\n", stateName[korg1212->cardState]);
 | |
|         snd_iprintf(buffer, "Idle mon. State: %d\n", korg1212->idleMonitorOn);
 | |
|         snd_iprintf(buffer, "Cmd retry count: %d\n", korg1212->cmdRetryCount);
 | |
|         snd_iprintf(buffer, "      Irq count: %ld\n", korg1212->irqcount);
 | |
|         snd_iprintf(buffer, "    Error count: %ld\n", korg1212->totalerrorcnt);
 | |
| }
 | |
| 
 | |
| static void snd_korg1212_proc_init(struct snd_korg1212 *korg1212)
 | |
| {
 | |
| 	snd_card_ro_proc_new(korg1212->card, "korg1212", korg1212,
 | |
| 			     snd_korg1212_proc_read);
 | |
| }
 | |
| 
 | |
| static void
 | |
| snd_korg1212_free(struct snd_card *card)
 | |
| {
 | |
| 	struct snd_korg1212 *korg1212 = card->private_data;
 | |
| 
 | |
| 	snd_korg1212_TurnOffIdleMonitor(korg1212);
 | |
| 	snd_korg1212_DisableCardInterrupts(korg1212);
 | |
| }
 | |
| 
 | |
| static int snd_korg1212_create(struct snd_card *card, struct pci_dev *pci)
 | |
| 
 | |
| {
 | |
|         int err, rc;
 | |
|         unsigned int i;
 | |
| 	__maybe_unused unsigned iomem_size;
 | |
| 	__maybe_unused unsigned ioport_size;
 | |
| 	__maybe_unused unsigned iomem2_size;
 | |
| 	struct snd_korg1212 *korg1212 = card->private_data;
 | |
| 	const struct firmware *dsp_code;
 | |
| 
 | |
| 	err = pcim_enable_device(pci);
 | |
| 	if (err < 0)
 | |
|                 return err;
 | |
| 
 | |
| 	korg1212->card = card;
 | |
| 	korg1212->pci = pci;
 | |
| 
 | |
|         init_waitqueue_head(&korg1212->wait);
 | |
|         spin_lock_init(&korg1212->lock);
 | |
| 	mutex_init(&korg1212->open_mutex);
 | |
| 	timer_setup(&korg1212->timer, snd_korg1212_timer_func, 0);
 | |
| 
 | |
|         korg1212->irq = -1;
 | |
|         korg1212->clkSource = K1212_CLKIDX_Local;
 | |
|         korg1212->clkRate = 44100;
 | |
|         korg1212->inIRQ = 0;
 | |
|         korg1212->running = 0;
 | |
| 	korg1212->opencnt = 0;
 | |
| 	korg1212->playcnt = 0;
 | |
| 	korg1212->setcnt = 0;
 | |
| 	korg1212->totalerrorcnt = 0;
 | |
| 	korg1212->playback_pid = -1;
 | |
| 	korg1212->capture_pid = -1;
 | |
|         snd_korg1212_setCardState(korg1212, K1212_STATE_UNINITIALIZED);
 | |
|         korg1212->idleMonitorOn = 0;
 | |
|         korg1212->clkSrcRate = K1212_CLKIDX_LocalAt44_1K;
 | |
|         korg1212->leftADCInSens = k1212MaxADCSens;
 | |
|         korg1212->rightADCInSens = k1212MaxADCSens;
 | |
| 
 | |
|         for (i=0; i<kAudioChannels; i++)
 | |
|                 korg1212->volumePhase[i] = 0;
 | |
| 
 | |
| 	err = pcim_iomap_regions_request_all(pci, 1 << 0, "korg1212");
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 
 | |
|         korg1212->iomem = pci_resource_start(korg1212->pci, 0);
 | |
|         korg1212->ioport = pci_resource_start(korg1212->pci, 1);
 | |
|         korg1212->iomem2 = pci_resource_start(korg1212->pci, 2);
 | |
| 
 | |
| 	iomem_size = pci_resource_len(korg1212->pci, 0);
 | |
| 	ioport_size = pci_resource_len(korg1212->pci, 1);
 | |
| 	iomem2_size = pci_resource_len(korg1212->pci, 2);
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: resources:\n"
 | |
|                    "    iomem = 0x%lx (%d)\n"
 | |
| 		   "    ioport  = 0x%lx (%d)\n"
 | |
|                    "    iomem = 0x%lx (%d)\n"
 | |
| 		   "    [%s]\n",
 | |
| 		   korg1212->iomem, iomem_size,
 | |
| 		   korg1212->ioport, ioport_size,
 | |
| 		   korg1212->iomem2, iomem2_size,
 | |
| 		   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	korg1212->iobase = pcim_iomap_table(pci)[0];
 | |
| 
 | |
| 	err = devm_request_irq(&pci->dev, pci->irq, snd_korg1212_interrupt,
 | |
|                           IRQF_SHARED,
 | |
|                           KBUILD_MODNAME, korg1212);
 | |
| 
 | |
|         if (err) {
 | |
| 		dev_err(&pci->dev, "korg1212: unable to grab IRQ %d\n", pci->irq);
 | |
|                 return -EBUSY;
 | |
|         }
 | |
| 
 | |
|         korg1212->irq = pci->irq;
 | |
| 	card->sync_irq = korg1212->irq;
 | |
| 	card->private_free = snd_korg1212_free;
 | |
| 
 | |
| 	pci_set_master(korg1212->pci);
 | |
| 
 | |
|         korg1212->statusRegPtr = (u32 __iomem *) (korg1212->iobase + STATUS_REG_OFFSET);
 | |
|         korg1212->outDoorbellPtr = (u32 __iomem *) (korg1212->iobase + OUT_DOORBELL_OFFSET);
 | |
|         korg1212->inDoorbellPtr = (u32 __iomem *) (korg1212->iobase + IN_DOORBELL_OFFSET);
 | |
|         korg1212->mailbox0Ptr = (u32 __iomem *) (korg1212->iobase + MAILBOX0_OFFSET);
 | |
|         korg1212->mailbox1Ptr = (u32 __iomem *) (korg1212->iobase + MAILBOX1_OFFSET);
 | |
|         korg1212->mailbox2Ptr = (u32 __iomem *) (korg1212->iobase + MAILBOX2_OFFSET);
 | |
|         korg1212->mailbox3Ptr = (u32 __iomem *) (korg1212->iobase + MAILBOX3_OFFSET);
 | |
|         korg1212->controlRegPtr = (u32 __iomem *) (korg1212->iobase + PCI_CONTROL_OFFSET);
 | |
|         korg1212->sensRegPtr = (u16 __iomem *) (korg1212->iobase + SENS_CONTROL_OFFSET);
 | |
|         korg1212->idRegPtr = (u32 __iomem *) (korg1212->iobase + DEV_VEND_ID_OFFSET);
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: card registers:\n"
 | |
|                    "    Status register = 0x%p\n"
 | |
|                    "    OutDoorbell     = 0x%p\n"
 | |
|                    "    InDoorbell      = 0x%p\n"
 | |
|                    "    Mailbox0        = 0x%p\n"
 | |
|                    "    Mailbox1        = 0x%p\n"
 | |
|                    "    Mailbox2        = 0x%p\n"
 | |
|                    "    Mailbox3        = 0x%p\n"
 | |
|                    "    ControlReg      = 0x%p\n"
 | |
|                    "    SensReg         = 0x%p\n"
 | |
|                    "    IDReg           = 0x%p\n"
 | |
| 		   "    [%s]\n",
 | |
|                    korg1212->statusRegPtr,
 | |
| 		   korg1212->outDoorbellPtr,
 | |
| 		   korg1212->inDoorbellPtr,
 | |
|                    korg1212->mailbox0Ptr,
 | |
|                    korg1212->mailbox1Ptr,
 | |
|                    korg1212->mailbox2Ptr,
 | |
|                    korg1212->mailbox3Ptr,
 | |
|                    korg1212->controlRegPtr,
 | |
|                    korg1212->sensRegPtr,
 | |
|                    korg1212->idRegPtr,
 | |
| 		   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	korg1212->dma_shared = snd_devm_alloc_pages(&pci->dev,
 | |
| 						    SNDRV_DMA_TYPE_DEV,
 | |
| 						    sizeof(struct KorgSharedBuffer));
 | |
| 	if (!korg1212->dma_shared)
 | |
| 		return -ENOMEM;
 | |
| 	korg1212->sharedBufferPtr = (struct KorgSharedBuffer *)korg1212->dma_shared->area;
 | |
| 	korg1212->sharedBufferPhy = korg1212->dma_shared->addr;
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: Shared Buffer Area = 0x%p (0x%08lx), %d bytes\n", korg1212->sharedBufferPtr, korg1212->sharedBufferPhy, sizeof(struct KorgSharedBuffer));
 | |
| 
 | |
| #ifndef K1212_LARGEALLOC
 | |
|         korg1212->DataBufsSize = sizeof(struct KorgAudioBuffer) * kNumBuffers;
 | |
| 	korg1212->dma_play = snd_devm_alloc_pages(&pci->dev, SNDRV_DMA_TYPE_DEV,
 | |
| 						  korg1212->DataBufsSize);
 | |
| 	if (!korg1212->dma_play)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	korg1212->playDataBufsPtr = (struct KorgAudioBuffer *)korg1212->dma_play->area;
 | |
| 	korg1212->PlayDataPhy = korg1212->dma_play->addr;
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: Play Data Area = 0x%p (0x%08x), %d bytes\n",
 | |
| 		korg1212->playDataBufsPtr, korg1212->PlayDataPhy, korg1212->DataBufsSize);
 | |
| 
 | |
| 	korg1212->dma_rec = snd_devm_alloc_pages(&pci->dev, SNDRV_DMA_TYPE_DEV,
 | |
| 						 korg1212->DataBufsSize);
 | |
| 	if (!korg1212->dma_rec)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	korg1212->recordDataBufsPtr = (struct KorgAudioBuffer *)korg1212->dma_rec->area;
 | |
| 	korg1212->RecDataPhy = korg1212->dma_rec->addr;
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: Record Data Area = 0x%p (0x%08x), %d bytes\n",
 | |
| 		korg1212->recordDataBufsPtr, korg1212->RecDataPhy, korg1212->DataBufsSize);
 | |
| 
 | |
| #else // K1212_LARGEALLOC
 | |
| 
 | |
|         korg1212->recordDataBufsPtr = korg1212->sharedBufferPtr->recordDataBufs;
 | |
|         korg1212->playDataBufsPtr = korg1212->sharedBufferPtr->playDataBufs;
 | |
|         korg1212->PlayDataPhy = (u32) &((struct KorgSharedBuffer *) korg1212->sharedBufferPhy)->playDataBufs;
 | |
|         korg1212->RecDataPhy  = (u32) &((struct KorgSharedBuffer *) korg1212->sharedBufferPhy)->recordDataBufs;
 | |
| 
 | |
| #endif // K1212_LARGEALLOC
 | |
| 
 | |
|         korg1212->VolumeTablePhy = korg1212->sharedBufferPhy +
 | |
| 		offsetof(struct KorgSharedBuffer, volumeData);
 | |
|         korg1212->RoutingTablePhy = korg1212->sharedBufferPhy +
 | |
| 		offsetof(struct KorgSharedBuffer, routeData);
 | |
|         korg1212->AdatTimeCodePhy = korg1212->sharedBufferPhy +
 | |
| 		offsetof(struct KorgSharedBuffer, AdatTimeCode);
 | |
| 
 | |
| 	err = request_firmware(&dsp_code, "korg/k1212.dsp", &pci->dev);
 | |
| 	if (err < 0) {
 | |
| 		dev_err(&pci->dev, "firmware not available\n");
 | |
| 		return err;
 | |
| 	}
 | |
| 
 | |
| 	korg1212->dma_dsp = snd_devm_alloc_pages(&pci->dev, SNDRV_DMA_TYPE_DEV,
 | |
| 						 dsp_code->size);
 | |
| 	if (!korg1212->dma_dsp) {
 | |
| 		release_firmware(dsp_code);
 | |
| 		return -ENOMEM;
 | |
| 	}
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: DSP Code area = 0x%p (0x%08x) %d bytes [%s]\n",
 | |
| 		   korg1212->dma_dsp->area, korg1212->dma_dsp->addr, dsp_code->size,
 | |
| 		   stateName[korg1212->cardState]);
 | |
| 
 | |
| 	memcpy(korg1212->dma_dsp->area, dsp_code->data, dsp_code->size);
 | |
| 
 | |
| 	release_firmware(dsp_code);
 | |
| 
 | |
| 	rc = snd_korg1212_Send1212Command(korg1212, K1212_DB_RebootCard, 0, 0, 0, 0);
 | |
| 
 | |
| 	if (rc)
 | |
| 		K1212_DEBUG_PRINTK("K1212_DEBUG: Reboot Card - RC = %d [%s]\n", rc, stateName[korg1212->cardState]);
 | |
| 
 | |
| 	snd_korg1212_EnableCardInterrupts(korg1212);
 | |
| 
 | |
| 	mdelay(CARD_BOOT_DELAY_IN_MS);
 | |
| 
 | |
|         if (snd_korg1212_downloadDSPCode(korg1212))
 | |
|         	return -EBUSY;
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("korg1212: dspMemPhy = %08x U[%08x], "
 | |
|                "PlayDataPhy = %08x L[%08x]\n"
 | |
| 	       "korg1212: RecDataPhy = %08x L[%08x], "
 | |
|                "VolumeTablePhy = %08x L[%08x]\n"
 | |
|                "korg1212: RoutingTablePhy = %08x L[%08x], "
 | |
|                "AdatTimeCodePhy = %08x L[%08x]\n",
 | |
| 	       (int)korg1212->dma_dsp.addr,    UpperWordSwap(korg1212->dma_dsp.addr),
 | |
|                korg1212->PlayDataPhy,     LowerWordSwap(korg1212->PlayDataPhy),
 | |
|                korg1212->RecDataPhy,      LowerWordSwap(korg1212->RecDataPhy),
 | |
|                korg1212->VolumeTablePhy,  LowerWordSwap(korg1212->VolumeTablePhy),
 | |
|                korg1212->RoutingTablePhy, LowerWordSwap(korg1212->RoutingTablePhy),
 | |
|                korg1212->AdatTimeCodePhy, LowerWordSwap(korg1212->AdatTimeCodePhy));
 | |
| 
 | |
| 	err = snd_pcm_new(korg1212->card, "korg1212", 0, 1, 1, &korg1212->pcm);
 | |
| 	if (err < 0)
 | |
|                 return err;
 | |
| 
 | |
| 	korg1212->pcm->private_data = korg1212;
 | |
|         korg1212->pcm->private_free = snd_korg1212_free_pcm;
 | |
|         strcpy(korg1212->pcm->name, "korg1212");
 | |
| 
 | |
|         snd_pcm_set_ops(korg1212->pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_korg1212_playback_ops);
 | |
|         
 | |
| 	snd_pcm_set_ops(korg1212->pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_korg1212_capture_ops);
 | |
| 
 | |
| 	korg1212->pcm->info_flags = SNDRV_PCM_INFO_JOINT_DUPLEX;
 | |
| 
 | |
|         for (i = 0; i < ARRAY_SIZE(snd_korg1212_controls); i++) {
 | |
|                 err = snd_ctl_add(korg1212->card, snd_ctl_new1(&snd_korg1212_controls[i], korg1212));
 | |
|                 if (err < 0)
 | |
|                         return err;
 | |
|         }
 | |
| 
 | |
|         snd_korg1212_proc_init(korg1212);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Card initialisation
 | |
|  */
 | |
| 
 | |
| static int
 | |
| snd_korg1212_probe(struct pci_dev *pci,
 | |
| 		const struct pci_device_id *pci_id)
 | |
| {
 | |
| 	static int dev;
 | |
| 	struct snd_korg1212 *korg1212;
 | |
| 	struct snd_card *card;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dev >= SNDRV_CARDS) {
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 	if (!enable[dev]) {
 | |
| 		dev++;
 | |
| 		return -ENOENT;
 | |
| 	}
 | |
| 	err = snd_devm_card_new(&pci->dev, index[dev], id[dev], THIS_MODULE,
 | |
| 				sizeof(*korg1212), &card);
 | |
| 	if (err < 0)
 | |
| 		return err;
 | |
| 	korg1212 = card->private_data;
 | |
| 
 | |
| 	err = snd_korg1212_create(card, pci);
 | |
| 	if (err < 0)
 | |
| 		goto error;
 | |
| 
 | |
| 	strcpy(card->driver, "korg1212");
 | |
| 	strcpy(card->shortname, "korg1212");
 | |
| 	sprintf(card->longname, "%s at 0x%lx, irq %d", card->shortname,
 | |
| 		korg1212->iomem, korg1212->irq);
 | |
| 
 | |
|         K1212_DEBUG_PRINTK("K1212_DEBUG: %s\n", card->longname);
 | |
| 
 | |
| 	err = snd_card_register(card);
 | |
| 	if (err < 0)
 | |
| 		goto error;
 | |
| 	pci_set_drvdata(pci, card);
 | |
| 	dev++;
 | |
| 	return 0;
 | |
| 
 | |
|  error:
 | |
| 	snd_card_free(card);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static struct pci_driver korg1212_driver = {
 | |
| 	.name = KBUILD_MODNAME,
 | |
| 	.id_table = snd_korg1212_ids,
 | |
| 	.probe = snd_korg1212_probe,
 | |
| };
 | |
| 
 | |
| module_pci_driver(korg1212_driver);
 |