18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci *   Driver for Midiman Portman2x4 parallel port midi interface
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci *   Copyright (c) by Levent Guendogdu <levon@feature-it.com>
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * ChangeLog
88c2ecf20Sopenharmony_ci * Jan 24 2007 Matthias Koenig <mkoenig@suse.de>
98c2ecf20Sopenharmony_ci *      - cleanup and rewrite
108c2ecf20Sopenharmony_ci * Sep 30 2004 Tobias Gehrig <tobias@gehrig.tk>
118c2ecf20Sopenharmony_ci *      - source code cleanup
128c2ecf20Sopenharmony_ci * Sep 03 2004 Tobias Gehrig <tobias@gehrig.tk>
138c2ecf20Sopenharmony_ci *      - fixed compilation problem with alsa 1.0.6a (removed MODULE_CLASSES,
148c2ecf20Sopenharmony_ci *        MODULE_PARM_SYNTAX and changed MODULE_DEVICES to
158c2ecf20Sopenharmony_ci *        MODULE_SUPPORTED_DEVICE)
168c2ecf20Sopenharmony_ci * Mar 24 2004 Tobias Gehrig <tobias@gehrig.tk>
178c2ecf20Sopenharmony_ci *      - added 2.6 kernel support
188c2ecf20Sopenharmony_ci * Mar 18 2004 Tobias Gehrig <tobias@gehrig.tk>
198c2ecf20Sopenharmony_ci *      - added parport_unregister_driver to the startup routine if the driver fails to detect a portman
208c2ecf20Sopenharmony_ci *      - added support for all 4 output ports in portman_putmidi
218c2ecf20Sopenharmony_ci * Mar 17 2004 Tobias Gehrig <tobias@gehrig.tk>
228c2ecf20Sopenharmony_ci *      - added checks for opened input device in interrupt handler
238c2ecf20Sopenharmony_ci * Feb 20 2004 Tobias Gehrig <tobias@gehrig.tk>
248c2ecf20Sopenharmony_ci *      - ported from alsa 0.5 to 1.0
258c2ecf20Sopenharmony_ci */
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci#include <linux/init.h>
288c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
298c2ecf20Sopenharmony_ci#include <linux/parport.h>
308c2ecf20Sopenharmony_ci#include <linux/spinlock.h>
318c2ecf20Sopenharmony_ci#include <linux/delay.h>
328c2ecf20Sopenharmony_ci#include <linux/slab.h>
338c2ecf20Sopenharmony_ci#include <linux/module.h>
348c2ecf20Sopenharmony_ci#include <sound/core.h>
358c2ecf20Sopenharmony_ci#include <sound/initval.h>
368c2ecf20Sopenharmony_ci#include <sound/rawmidi.h>
378c2ecf20Sopenharmony_ci#include <sound/control.h>
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci#define CARD_NAME "Portman 2x4"
408c2ecf20Sopenharmony_ci#define DRIVER_NAME "portman"
418c2ecf20Sopenharmony_ci#define PLATFORM_DRIVER "snd_portman2x4"
428c2ecf20Sopenharmony_ci
438c2ecf20Sopenharmony_cistatic int index[SNDRV_CARDS]  = SNDRV_DEFAULT_IDX;
448c2ecf20Sopenharmony_cistatic char *id[SNDRV_CARDS]   = SNDRV_DEFAULT_STR;
458c2ecf20Sopenharmony_cistatic bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_cistatic struct platform_device *platform_devices[SNDRV_CARDS];
488c2ecf20Sopenharmony_cistatic int device_count;
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_cimodule_param_array(index, int, NULL, 0444);
518c2ecf20Sopenharmony_ciMODULE_PARM_DESC(index, "Index value for " CARD_NAME " soundcard.");
528c2ecf20Sopenharmony_cimodule_param_array(id, charp, NULL, 0444);
538c2ecf20Sopenharmony_ciMODULE_PARM_DESC(id, "ID string for " CARD_NAME " soundcard.");
548c2ecf20Sopenharmony_cimodule_param_array(enable, bool, NULL, 0444);
558c2ecf20Sopenharmony_ciMODULE_PARM_DESC(enable, "Enable " CARD_NAME " soundcard.");
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_ciMODULE_AUTHOR("Levent Guendogdu, Tobias Gehrig, Matthias Koenig");
588c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Midiman Portman2x4");
598c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
608c2ecf20Sopenharmony_ciMODULE_SUPPORTED_DEVICE("{{Midiman,Portman2x4}}");
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci/*********************************************************************
638c2ecf20Sopenharmony_ci * Chip specific
648c2ecf20Sopenharmony_ci *********************************************************************/
658c2ecf20Sopenharmony_ci#define PORTMAN_NUM_INPUT_PORTS 2
668c2ecf20Sopenharmony_ci#define PORTMAN_NUM_OUTPUT_PORTS 4
678c2ecf20Sopenharmony_ci
688c2ecf20Sopenharmony_cistruct portman {
698c2ecf20Sopenharmony_ci	spinlock_t reg_lock;
708c2ecf20Sopenharmony_ci	struct snd_card *card;
718c2ecf20Sopenharmony_ci	struct snd_rawmidi *rmidi;
728c2ecf20Sopenharmony_ci	struct pardevice *pardev;
738c2ecf20Sopenharmony_ci	int open_count;
748c2ecf20Sopenharmony_ci	int mode[PORTMAN_NUM_INPUT_PORTS];
758c2ecf20Sopenharmony_ci	struct snd_rawmidi_substream *midi_input[PORTMAN_NUM_INPUT_PORTS];
768c2ecf20Sopenharmony_ci};
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_cistatic int portman_free(struct portman *pm)
798c2ecf20Sopenharmony_ci{
808c2ecf20Sopenharmony_ci	kfree(pm);
818c2ecf20Sopenharmony_ci	return 0;
828c2ecf20Sopenharmony_ci}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_cistatic int portman_create(struct snd_card *card,
858c2ecf20Sopenharmony_ci			  struct pardevice *pardev,
868c2ecf20Sopenharmony_ci			  struct portman **rchip)
878c2ecf20Sopenharmony_ci{
888c2ecf20Sopenharmony_ci	struct portman *pm;
898c2ecf20Sopenharmony_ci
908c2ecf20Sopenharmony_ci	*rchip = NULL;
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_ci	pm = kzalloc(sizeof(struct portman), GFP_KERNEL);
938c2ecf20Sopenharmony_ci	if (pm == NULL)
948c2ecf20Sopenharmony_ci		return -ENOMEM;
958c2ecf20Sopenharmony_ci
968c2ecf20Sopenharmony_ci	/* Init chip specific data */
978c2ecf20Sopenharmony_ci	spin_lock_init(&pm->reg_lock);
988c2ecf20Sopenharmony_ci	pm->card = card;
998c2ecf20Sopenharmony_ci	pm->pardev = pardev;
1008c2ecf20Sopenharmony_ci
1018c2ecf20Sopenharmony_ci	*rchip = pm;
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ci	return 0;
1048c2ecf20Sopenharmony_ci}
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci/*********************************************************************
1078c2ecf20Sopenharmony_ci * HW related constants
1088c2ecf20Sopenharmony_ci *********************************************************************/
1098c2ecf20Sopenharmony_ci
1108c2ecf20Sopenharmony_ci/* Standard PC parallel port status register equates. */
1118c2ecf20Sopenharmony_ci#define	PP_STAT_BSY   	0x80	/* Busy status.  Inverted. */
1128c2ecf20Sopenharmony_ci#define	PP_STAT_ACK   	0x40	/* Acknowledge.  Non-Inverted. */
1138c2ecf20Sopenharmony_ci#define	PP_STAT_POUT  	0x20	/* Paper Out.    Non-Inverted. */
1148c2ecf20Sopenharmony_ci#define	PP_STAT_SEL   	0x10	/* Select.       Non-Inverted. */
1158c2ecf20Sopenharmony_ci#define	PP_STAT_ERR   	0x08	/* Error.        Non-Inverted. */
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci/* Standard PC parallel port command register equates. */
1188c2ecf20Sopenharmony_ci#define	PP_CMD_IEN  	0x10	/* IRQ Enable.   Non-Inverted. */
1198c2ecf20Sopenharmony_ci#define	PP_CMD_SELI 	0x08	/* Select Input. Inverted. */
1208c2ecf20Sopenharmony_ci#define	PP_CMD_INIT 	0x04	/* Init Printer. Non-Inverted. */
1218c2ecf20Sopenharmony_ci#define	PP_CMD_FEED 	0x02	/* Auto Feed.    Inverted. */
1228c2ecf20Sopenharmony_ci#define	PP_CMD_STB      0x01	/* Strobe.       Inverted. */
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci/* Parallel Port Command Register as implemented by PCP2x4. */
1258c2ecf20Sopenharmony_ci#define	INT_EN	 	PP_CMD_IEN	/* Interrupt enable. */
1268c2ecf20Sopenharmony_ci#define	STROBE	        PP_CMD_STB	/* Command strobe. */
1278c2ecf20Sopenharmony_ci
1288c2ecf20Sopenharmony_ci/* The parallel port command register field (b1..b3) selects the
1298c2ecf20Sopenharmony_ci * various "registers" within the PC/P 2x4.  These are the internal
1308c2ecf20Sopenharmony_ci * address of these "registers" that must be written to the parallel
1318c2ecf20Sopenharmony_ci * port command register.
1328c2ecf20Sopenharmony_ci */
1338c2ecf20Sopenharmony_ci#define	RXDATA0		(0 << 1)	/* PCP RxData channel 0. */
1348c2ecf20Sopenharmony_ci#define	RXDATA1		(1 << 1)	/* PCP RxData channel 1. */
1358c2ecf20Sopenharmony_ci#define	GEN_CTL		(2 << 1)	/* PCP General Control Register. */
1368c2ecf20Sopenharmony_ci#define	SYNC_CTL 	(3 << 1)	/* PCP Sync Control Register. */
1378c2ecf20Sopenharmony_ci#define	TXDATA0		(4 << 1)	/* PCP TxData channel 0. */
1388c2ecf20Sopenharmony_ci#define	TXDATA1		(5 << 1)	/* PCP TxData channel 1. */
1398c2ecf20Sopenharmony_ci#define	TXDATA2		(6 << 1)	/* PCP TxData channel 2. */
1408c2ecf20Sopenharmony_ci#define	TXDATA3		(7 << 1)	/* PCP TxData channel 3. */
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_ci/* Parallel Port Status Register as implemented by PCP2x4. */
1438c2ecf20Sopenharmony_ci#define	ESTB		PP_STAT_POUT	/* Echoed strobe. */
1448c2ecf20Sopenharmony_ci#define	INT_REQ         PP_STAT_ACK	/* Input data int request. */
1458c2ecf20Sopenharmony_ci#define	BUSY            PP_STAT_ERR	/* Interface Busy. */
1468c2ecf20Sopenharmony_ci
1478c2ecf20Sopenharmony_ci/* Parallel Port Status Register BUSY and SELECT lines are multiplexed
1488c2ecf20Sopenharmony_ci * between several functions.  Depending on which 2x4 "register" is
1498c2ecf20Sopenharmony_ci * currently selected (b1..b3), the BUSY and SELECT lines are
1508c2ecf20Sopenharmony_ci * assigned as follows:
1518c2ecf20Sopenharmony_ci *
1528c2ecf20Sopenharmony_ci *   SELECT LINE:                                                    A3 A2 A1
1538c2ecf20Sopenharmony_ci *                                                                   --------
1548c2ecf20Sopenharmony_ci */
1558c2ecf20Sopenharmony_ci#define	RXAVAIL		PP_STAT_SEL	/* Rx Available, channel 0.   0 0 0 */
1568c2ecf20Sopenharmony_ci//  RXAVAIL1    PP_STAT_SEL             /* Rx Available, channel 1.   0 0 1 */
1578c2ecf20Sopenharmony_ci#define	SYNC_STAT	PP_STAT_SEL	/* Reserved - Sync Status.    0 1 0 */
1588c2ecf20Sopenharmony_ci//                                      /* Reserved.                  0 1 1 */
1598c2ecf20Sopenharmony_ci#define	TXEMPTY		PP_STAT_SEL	/* Tx Empty, channel 0.       1 0 0 */
1608c2ecf20Sopenharmony_ci//      TXEMPTY1        PP_STAT_SEL     /* Tx Empty, channel 1.       1 0 1 */
1618c2ecf20Sopenharmony_ci//  TXEMPTY2    PP_STAT_SEL             /* Tx Empty, channel 2.       1 1 0 */
1628c2ecf20Sopenharmony_ci//  TXEMPTY3    PP_STAT_SEL             /* Tx Empty, channel 3.       1 1 1 */
1638c2ecf20Sopenharmony_ci
1648c2ecf20Sopenharmony_ci/*   BUSY LINE:                                                      A3 A2 A1
1658c2ecf20Sopenharmony_ci *                                                                   --------
1668c2ecf20Sopenharmony_ci */
1678c2ecf20Sopenharmony_ci#define	RXDATA		PP_STAT_BSY	/* Rx Input Data, channel 0.  0 0 0 */
1688c2ecf20Sopenharmony_ci//      RXDATA1         PP_STAT_BSY     /* Rx Input Data, channel 1.  0 0 1 */
1698c2ecf20Sopenharmony_ci#define	SYNC_DATA       PP_STAT_BSY	/* Reserved - Sync Data.      0 1 0 */
1708c2ecf20Sopenharmony_ci					/* Reserved.                  0 1 1 */
1718c2ecf20Sopenharmony_ci#define	DATA_ECHO       PP_STAT_BSY	/* Parallel Port Data Echo.   1 0 0 */
1728c2ecf20Sopenharmony_ci#define	A0_ECHO         PP_STAT_BSY	/* Address 0 Echo.            1 0 1 */
1738c2ecf20Sopenharmony_ci#define	A1_ECHO         PP_STAT_BSY	/* Address 1 Echo.            1 1 0 */
1748c2ecf20Sopenharmony_ci#define	A2_ECHO         PP_STAT_BSY	/* Address 2 Echo.            1 1 1 */
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci#define PORTMAN2X4_MODE_INPUT_TRIGGERED	 0x01
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_ci/*********************************************************************
1798c2ecf20Sopenharmony_ci * Hardware specific functions
1808c2ecf20Sopenharmony_ci *********************************************************************/
1818c2ecf20Sopenharmony_cistatic inline void portman_write_command(struct portman *pm, u8 value)
1828c2ecf20Sopenharmony_ci{
1838c2ecf20Sopenharmony_ci	parport_write_control(pm->pardev->port, value);
1848c2ecf20Sopenharmony_ci}
1858c2ecf20Sopenharmony_ci
1868c2ecf20Sopenharmony_cistatic inline u8 portman_read_command(struct portman *pm)
1878c2ecf20Sopenharmony_ci{
1888c2ecf20Sopenharmony_ci	return parport_read_control(pm->pardev->port);
1898c2ecf20Sopenharmony_ci}
1908c2ecf20Sopenharmony_ci
1918c2ecf20Sopenharmony_cistatic inline u8 portman_read_status(struct portman *pm)
1928c2ecf20Sopenharmony_ci{
1938c2ecf20Sopenharmony_ci	return parport_read_status(pm->pardev->port);
1948c2ecf20Sopenharmony_ci}
1958c2ecf20Sopenharmony_ci
1968c2ecf20Sopenharmony_cistatic inline u8 portman_read_data(struct portman *pm)
1978c2ecf20Sopenharmony_ci{
1988c2ecf20Sopenharmony_ci	return parport_read_data(pm->pardev->port);
1998c2ecf20Sopenharmony_ci}
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_cistatic inline void portman_write_data(struct portman *pm, u8 value)
2028c2ecf20Sopenharmony_ci{
2038c2ecf20Sopenharmony_ci	parport_write_data(pm->pardev->port, value);
2048c2ecf20Sopenharmony_ci}
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_cistatic void portman_write_midi(struct portman *pm,
2078c2ecf20Sopenharmony_ci			       int port, u8 mididata)
2088c2ecf20Sopenharmony_ci{
2098c2ecf20Sopenharmony_ci	int command = ((port + 4) << 1);
2108c2ecf20Sopenharmony_ci
2118c2ecf20Sopenharmony_ci	/* Get entering data byte and port number in BL and BH respectively.
2128c2ecf20Sopenharmony_ci	 * Set up Tx Channel address field for use with PP Cmd Register.
2138c2ecf20Sopenharmony_ci	 * Store address field in BH register.
2148c2ecf20Sopenharmony_ci	 * Inputs:      AH = Output port number (0..3).
2158c2ecf20Sopenharmony_ci	 *              AL = Data byte.
2168c2ecf20Sopenharmony_ci	 *    command = TXDATA0 | INT_EN;
2178c2ecf20Sopenharmony_ci	 * Align port num with address field (b1...b3),
2188c2ecf20Sopenharmony_ci	 * set address for TXDatax, Strobe=0
2198c2ecf20Sopenharmony_ci	 */
2208c2ecf20Sopenharmony_ci	command |= INT_EN;
2218c2ecf20Sopenharmony_ci
2228c2ecf20Sopenharmony_ci	/* Disable interrupts so that the process is not interrupted, then
2238c2ecf20Sopenharmony_ci	 * write the address associated with the current Tx channel to the
2248c2ecf20Sopenharmony_ci	 * PP Command Reg.  Do not set the Strobe signal yet.
2258c2ecf20Sopenharmony_ci	 */
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	do {
2288c2ecf20Sopenharmony_ci		portman_write_command(pm, command);
2298c2ecf20Sopenharmony_ci
2308c2ecf20Sopenharmony_ci		/* While the address lines settle, write parallel output data to
2318c2ecf20Sopenharmony_ci		 * PP Data Reg.  This has no effect until Strobe signal is asserted.
2328c2ecf20Sopenharmony_ci		 */
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci		portman_write_data(pm, mididata);
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci		/* If PCP channel's TxEmpty is set (TxEmpty is read through the PP
2378c2ecf20Sopenharmony_ci		 * Status Register), then go write data.  Else go back and wait.
2388c2ecf20Sopenharmony_ci		 */
2398c2ecf20Sopenharmony_ci	} while ((portman_read_status(pm) & TXEMPTY) != TXEMPTY);
2408c2ecf20Sopenharmony_ci
2418c2ecf20Sopenharmony_ci	/* TxEmpty is set.  Maintain PC/P destination address and assert
2428c2ecf20Sopenharmony_ci	 * Strobe through the PP Command Reg.  This will Strobe data into
2438c2ecf20Sopenharmony_ci	 * the PC/P transmitter and set the PC/P BUSY signal.
2448c2ecf20Sopenharmony_ci	 */
2458c2ecf20Sopenharmony_ci
2468c2ecf20Sopenharmony_ci	portman_write_command(pm, command | STROBE);
2478c2ecf20Sopenharmony_ci
2488c2ecf20Sopenharmony_ci	/* Wait for strobe line to settle and echo back through hardware.
2498c2ecf20Sopenharmony_ci	 * Once it has echoed back, assume that the address and data lines
2508c2ecf20Sopenharmony_ci	 * have settled!
2518c2ecf20Sopenharmony_ci	 */
2528c2ecf20Sopenharmony_ci
2538c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == 0)
2548c2ecf20Sopenharmony_ci		cpu_relax();
2558c2ecf20Sopenharmony_ci
2568c2ecf20Sopenharmony_ci	/* Release strobe and immediately re-allow interrupts. */
2578c2ecf20Sopenharmony_ci	portman_write_command(pm, command);
2588c2ecf20Sopenharmony_ci
2598c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == ESTB)
2608c2ecf20Sopenharmony_ci		cpu_relax();
2618c2ecf20Sopenharmony_ci
2628c2ecf20Sopenharmony_ci	/* PC/P BUSY is now set.  We must wait until BUSY resets itself.
2638c2ecf20Sopenharmony_ci	 * We'll reenable ints while we're waiting.
2648c2ecf20Sopenharmony_ci	 */
2658c2ecf20Sopenharmony_ci
2668c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & BUSY) == BUSY)
2678c2ecf20Sopenharmony_ci		cpu_relax();
2688c2ecf20Sopenharmony_ci
2698c2ecf20Sopenharmony_ci	/* Data sent. */
2708c2ecf20Sopenharmony_ci}
2718c2ecf20Sopenharmony_ci
2728c2ecf20Sopenharmony_ci
2738c2ecf20Sopenharmony_ci/*
2748c2ecf20Sopenharmony_ci *  Read MIDI byte from port
2758c2ecf20Sopenharmony_ci *  Attempt to read input byte from specified hardware input port (0..).
2768c2ecf20Sopenharmony_ci *  Return -1 if no data
2778c2ecf20Sopenharmony_ci */
2788c2ecf20Sopenharmony_cistatic int portman_read_midi(struct portman *pm, int port)
2798c2ecf20Sopenharmony_ci{
2808c2ecf20Sopenharmony_ci	unsigned char midi_data = 0;
2818c2ecf20Sopenharmony_ci	unsigned char cmdout;	/* Saved address+IE bit. */
2828c2ecf20Sopenharmony_ci
2838c2ecf20Sopenharmony_ci	/* Make sure clocking edge is down before starting... */
2848c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Make sure edge is down. */
2858c2ecf20Sopenharmony_ci
2868c2ecf20Sopenharmony_ci	/* Set destination address to PCP. */
2878c2ecf20Sopenharmony_ci	cmdout = (port << 1) | INT_EN;	/* Address + IE + No Strobe. */
2888c2ecf20Sopenharmony_ci	portman_write_command(pm, cmdout);
2898c2ecf20Sopenharmony_ci
2908c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == ESTB)
2918c2ecf20Sopenharmony_ci		cpu_relax();	/* Wait for strobe echo. */
2928c2ecf20Sopenharmony_ci
2938c2ecf20Sopenharmony_ci	/* After the address lines settle, check multiplexed RxAvail signal.
2948c2ecf20Sopenharmony_ci	 * If data is available, read it.
2958c2ecf20Sopenharmony_ci	 */
2968c2ecf20Sopenharmony_ci	if ((portman_read_status(pm) & RXAVAIL) == 0)
2978c2ecf20Sopenharmony_ci		return -1;	/* No data. */
2988c2ecf20Sopenharmony_ci
2998c2ecf20Sopenharmony_ci	/* Set the Strobe signal to enable the Rx clocking circuitry. */
3008c2ecf20Sopenharmony_ci	portman_write_command(pm, cmdout | STROBE);	/* Write address+IE+Strobe. */
3018c2ecf20Sopenharmony_ci
3028c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == 0)
3038c2ecf20Sopenharmony_ci		cpu_relax(); /* Wait for strobe echo. */
3048c2ecf20Sopenharmony_ci
3058c2ecf20Sopenharmony_ci	/* The first data bit (msb) is already sitting on the input line. */
3068c2ecf20Sopenharmony_ci	midi_data = (portman_read_status(pm) & 128);
3078c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3088c2ecf20Sopenharmony_ci
3098c2ecf20Sopenharmony_ci	/* Data bit 6. */
3108c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3118c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 1) & 64;
3128c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3138c2ecf20Sopenharmony_ci
3148c2ecf20Sopenharmony_ci	/* Data bit 5. */
3158c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3168c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 2) & 32;
3178c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3188c2ecf20Sopenharmony_ci
3198c2ecf20Sopenharmony_ci	/* Data bit 4. */
3208c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3218c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 3) & 16;
3228c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3238c2ecf20Sopenharmony_ci
3248c2ecf20Sopenharmony_ci	/* Data bit 3. */
3258c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3268c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 4) & 8;
3278c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3288c2ecf20Sopenharmony_ci
3298c2ecf20Sopenharmony_ci	/* Data bit 2. */
3308c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3318c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 5) & 4;
3328c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3338c2ecf20Sopenharmony_ci
3348c2ecf20Sopenharmony_ci	/* Data bit 1. */
3358c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3368c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 6) & 2;
3378c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3388c2ecf20Sopenharmony_ci
3398c2ecf20Sopenharmony_ci	/* Data bit 0. */
3408c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Cause falling edge while data settles. */
3418c2ecf20Sopenharmony_ci	midi_data |= (portman_read_status(pm) >> 7) & 1;
3428c2ecf20Sopenharmony_ci	portman_write_data(pm, 1);	/* Cause rising edge, which shifts data. */
3438c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);	/* Return data clock low. */
3448c2ecf20Sopenharmony_ci
3458c2ecf20Sopenharmony_ci
3468c2ecf20Sopenharmony_ci	/* De-assert Strobe and return data. */
3478c2ecf20Sopenharmony_ci	portman_write_command(pm, cmdout);	/* Output saved address+IE. */
3488c2ecf20Sopenharmony_ci
3498c2ecf20Sopenharmony_ci	/* Wait for strobe echo. */
3508c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == ESTB)
3518c2ecf20Sopenharmony_ci		cpu_relax();
3528c2ecf20Sopenharmony_ci
3538c2ecf20Sopenharmony_ci	return (midi_data & 255);	/* Shift back and return value. */
3548c2ecf20Sopenharmony_ci}
3558c2ecf20Sopenharmony_ci
3568c2ecf20Sopenharmony_ci/*
3578c2ecf20Sopenharmony_ci *  Checks if any input data on the given channel is available
3588c2ecf20Sopenharmony_ci *  Checks RxAvail
3598c2ecf20Sopenharmony_ci */
3608c2ecf20Sopenharmony_cistatic int portman_data_avail(struct portman *pm, int channel)
3618c2ecf20Sopenharmony_ci{
3628c2ecf20Sopenharmony_ci	int command = INT_EN;
3638c2ecf20Sopenharmony_ci	switch (channel) {
3648c2ecf20Sopenharmony_ci	case 0:
3658c2ecf20Sopenharmony_ci		command |= RXDATA0;
3668c2ecf20Sopenharmony_ci		break;
3678c2ecf20Sopenharmony_ci	case 1:
3688c2ecf20Sopenharmony_ci		command |= RXDATA1;
3698c2ecf20Sopenharmony_ci		break;
3708c2ecf20Sopenharmony_ci	}
3718c2ecf20Sopenharmony_ci	/* Write hardware (assumme STROBE=0) */
3728c2ecf20Sopenharmony_ci	portman_write_command(pm, command);
3738c2ecf20Sopenharmony_ci	/* Check multiplexed RxAvail signal */
3748c2ecf20Sopenharmony_ci	if ((portman_read_status(pm) & RXAVAIL) == RXAVAIL)
3758c2ecf20Sopenharmony_ci		return 1;	/* Data available */
3768c2ecf20Sopenharmony_ci
3778c2ecf20Sopenharmony_ci	/* No Data available */
3788c2ecf20Sopenharmony_ci	return 0;
3798c2ecf20Sopenharmony_ci}
3808c2ecf20Sopenharmony_ci
3818c2ecf20Sopenharmony_ci
3828c2ecf20Sopenharmony_ci/*
3838c2ecf20Sopenharmony_ci *  Flushes any input
3848c2ecf20Sopenharmony_ci */
3858c2ecf20Sopenharmony_cistatic void portman_flush_input(struct portman *pm, unsigned char port)
3868c2ecf20Sopenharmony_ci{
3878c2ecf20Sopenharmony_ci	/* Local variable for counting things */
3888c2ecf20Sopenharmony_ci	unsigned int i = 0;
3898c2ecf20Sopenharmony_ci	unsigned char command = 0;
3908c2ecf20Sopenharmony_ci
3918c2ecf20Sopenharmony_ci	switch (port) {
3928c2ecf20Sopenharmony_ci	case 0:
3938c2ecf20Sopenharmony_ci		command = RXDATA0;
3948c2ecf20Sopenharmony_ci		break;
3958c2ecf20Sopenharmony_ci	case 1:
3968c2ecf20Sopenharmony_ci		command = RXDATA1;
3978c2ecf20Sopenharmony_ci		break;
3988c2ecf20Sopenharmony_ci	default:
3998c2ecf20Sopenharmony_ci		snd_printk(KERN_WARNING
4008c2ecf20Sopenharmony_ci			   "portman_flush_input() Won't flush port %i\n",
4018c2ecf20Sopenharmony_ci			   port);
4028c2ecf20Sopenharmony_ci		return;
4038c2ecf20Sopenharmony_ci	}
4048c2ecf20Sopenharmony_ci
4058c2ecf20Sopenharmony_ci	/* Set address for specified channel in port and allow to settle. */
4068c2ecf20Sopenharmony_ci	portman_write_command(pm, command);
4078c2ecf20Sopenharmony_ci
4088c2ecf20Sopenharmony_ci	/* Assert the Strobe and wait for echo back. */
4098c2ecf20Sopenharmony_ci	portman_write_command(pm, command | STROBE);
4108c2ecf20Sopenharmony_ci
4118c2ecf20Sopenharmony_ci	/* Wait for ESTB */
4128c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == 0)
4138c2ecf20Sopenharmony_ci		cpu_relax();
4148c2ecf20Sopenharmony_ci
4158c2ecf20Sopenharmony_ci	/* Output clock cycles to the Rx circuitry. */
4168c2ecf20Sopenharmony_ci	portman_write_data(pm, 0);
4178c2ecf20Sopenharmony_ci
4188c2ecf20Sopenharmony_ci	/* Flush 250 bits... */
4198c2ecf20Sopenharmony_ci	for (i = 0; i < 250; i++) {
4208c2ecf20Sopenharmony_ci		portman_write_data(pm, 1);
4218c2ecf20Sopenharmony_ci		portman_write_data(pm, 0);
4228c2ecf20Sopenharmony_ci	}
4238c2ecf20Sopenharmony_ci
4248c2ecf20Sopenharmony_ci	/* Deassert the Strobe signal of the port and wait for it to settle. */
4258c2ecf20Sopenharmony_ci	portman_write_command(pm, command | INT_EN);
4268c2ecf20Sopenharmony_ci
4278c2ecf20Sopenharmony_ci	/* Wait for settling */
4288c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & ESTB) == ESTB)
4298c2ecf20Sopenharmony_ci		cpu_relax();
4308c2ecf20Sopenharmony_ci}
4318c2ecf20Sopenharmony_ci
4328c2ecf20Sopenharmony_cistatic int portman_probe(struct parport *p)
4338c2ecf20Sopenharmony_ci{
4348c2ecf20Sopenharmony_ci	/* Initialize the parallel port data register.  Will set Rx clocks
4358c2ecf20Sopenharmony_ci	 * low in case we happen to be addressing the Rx ports at this time.
4368c2ecf20Sopenharmony_ci	 */
4378c2ecf20Sopenharmony_ci	/* 1 */
4388c2ecf20Sopenharmony_ci	parport_write_data(p, 0);
4398c2ecf20Sopenharmony_ci
4408c2ecf20Sopenharmony_ci	/* Initialize the parallel port command register, thus initializing
4418c2ecf20Sopenharmony_ci	 * hardware handshake lines to midi box:
4428c2ecf20Sopenharmony_ci	 *
4438c2ecf20Sopenharmony_ci	 *                                  Strobe = 0
4448c2ecf20Sopenharmony_ci	 *                                  Interrupt Enable = 0
4458c2ecf20Sopenharmony_ci	 */
4468c2ecf20Sopenharmony_ci	/* 2 */
4478c2ecf20Sopenharmony_ci	parport_write_control(p, 0);
4488c2ecf20Sopenharmony_ci
4498c2ecf20Sopenharmony_ci	/* Check if Portman PC/P 2x4 is out there. */
4508c2ecf20Sopenharmony_ci	/* 3 */
4518c2ecf20Sopenharmony_ci	parport_write_control(p, RXDATA0);	/* Write Strobe=0 to command reg. */
4528c2ecf20Sopenharmony_ci
4538c2ecf20Sopenharmony_ci	/* Check for ESTB to be clear */
4548c2ecf20Sopenharmony_ci	/* 4 */
4558c2ecf20Sopenharmony_ci	if ((parport_read_status(p) & ESTB) == ESTB)
4568c2ecf20Sopenharmony_ci		return 1;	/* CODE 1 - Strobe Failure. */
4578c2ecf20Sopenharmony_ci
4588c2ecf20Sopenharmony_ci	/* Set for RXDATA0 where no damage will be done. */
4598c2ecf20Sopenharmony_ci	/* 5 */
4608c2ecf20Sopenharmony_ci	parport_write_control(p, RXDATA0 | STROBE);	/* Write Strobe=1 to command reg. */
4618c2ecf20Sopenharmony_ci
4628c2ecf20Sopenharmony_ci	/* 6 */
4638c2ecf20Sopenharmony_ci	if ((parport_read_status(p) & ESTB) != ESTB)
4648c2ecf20Sopenharmony_ci		return 1;	/* CODE 1 - Strobe Failure. */
4658c2ecf20Sopenharmony_ci
4668c2ecf20Sopenharmony_ci	/* 7 */
4678c2ecf20Sopenharmony_ci	parport_write_control(p, 0);	/* Reset Strobe=0. */
4688c2ecf20Sopenharmony_ci
4698c2ecf20Sopenharmony_ci	/* Check if Tx circuitry is functioning properly.  If initialized
4708c2ecf20Sopenharmony_ci	 * unit TxEmpty is false, send out char and see if it goes true.
4718c2ecf20Sopenharmony_ci	 */
4728c2ecf20Sopenharmony_ci	/* 8 */
4738c2ecf20Sopenharmony_ci	parport_write_control(p, TXDATA0);	/* Tx channel 0, strobe off. */
4748c2ecf20Sopenharmony_ci
4758c2ecf20Sopenharmony_ci	/* If PCP channel's TxEmpty is set (TxEmpty is read through the PP
4768c2ecf20Sopenharmony_ci	 * Status Register), then go write data.  Else go back and wait.
4778c2ecf20Sopenharmony_ci	 */
4788c2ecf20Sopenharmony_ci	/* 9 */
4798c2ecf20Sopenharmony_ci	if ((parport_read_status(p) & TXEMPTY) == 0)
4808c2ecf20Sopenharmony_ci		return 2;
4818c2ecf20Sopenharmony_ci
4828c2ecf20Sopenharmony_ci	/* Return OK status. */
4838c2ecf20Sopenharmony_ci	return 0;
4848c2ecf20Sopenharmony_ci}
4858c2ecf20Sopenharmony_ci
4868c2ecf20Sopenharmony_cistatic int portman_device_init(struct portman *pm)
4878c2ecf20Sopenharmony_ci{
4888c2ecf20Sopenharmony_ci	portman_flush_input(pm, 0);
4898c2ecf20Sopenharmony_ci	portman_flush_input(pm, 1);
4908c2ecf20Sopenharmony_ci
4918c2ecf20Sopenharmony_ci	return 0;
4928c2ecf20Sopenharmony_ci}
4938c2ecf20Sopenharmony_ci
4948c2ecf20Sopenharmony_ci/*********************************************************************
4958c2ecf20Sopenharmony_ci * Rawmidi
4968c2ecf20Sopenharmony_ci *********************************************************************/
4978c2ecf20Sopenharmony_cistatic int snd_portman_midi_open(struct snd_rawmidi_substream *substream)
4988c2ecf20Sopenharmony_ci{
4998c2ecf20Sopenharmony_ci	return 0;
5008c2ecf20Sopenharmony_ci}
5018c2ecf20Sopenharmony_ci
5028c2ecf20Sopenharmony_cistatic int snd_portman_midi_close(struct snd_rawmidi_substream *substream)
5038c2ecf20Sopenharmony_ci{
5048c2ecf20Sopenharmony_ci	return 0;
5058c2ecf20Sopenharmony_ci}
5068c2ecf20Sopenharmony_ci
5078c2ecf20Sopenharmony_cistatic void snd_portman_midi_input_trigger(struct snd_rawmidi_substream *substream,
5088c2ecf20Sopenharmony_ci					   int up)
5098c2ecf20Sopenharmony_ci{
5108c2ecf20Sopenharmony_ci	struct portman *pm = substream->rmidi->private_data;
5118c2ecf20Sopenharmony_ci	unsigned long flags;
5128c2ecf20Sopenharmony_ci
5138c2ecf20Sopenharmony_ci	spin_lock_irqsave(&pm->reg_lock, flags);
5148c2ecf20Sopenharmony_ci	if (up)
5158c2ecf20Sopenharmony_ci		pm->mode[substream->number] |= PORTMAN2X4_MODE_INPUT_TRIGGERED;
5168c2ecf20Sopenharmony_ci	else
5178c2ecf20Sopenharmony_ci		pm->mode[substream->number] &= ~PORTMAN2X4_MODE_INPUT_TRIGGERED;
5188c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&pm->reg_lock, flags);
5198c2ecf20Sopenharmony_ci}
5208c2ecf20Sopenharmony_ci
5218c2ecf20Sopenharmony_cistatic void snd_portman_midi_output_trigger(struct snd_rawmidi_substream *substream,
5228c2ecf20Sopenharmony_ci					    int up)
5238c2ecf20Sopenharmony_ci{
5248c2ecf20Sopenharmony_ci	struct portman *pm = substream->rmidi->private_data;
5258c2ecf20Sopenharmony_ci	unsigned long flags;
5268c2ecf20Sopenharmony_ci	unsigned char byte;
5278c2ecf20Sopenharmony_ci
5288c2ecf20Sopenharmony_ci	spin_lock_irqsave(&pm->reg_lock, flags);
5298c2ecf20Sopenharmony_ci	if (up) {
5308c2ecf20Sopenharmony_ci		while ((snd_rawmidi_transmit(substream, &byte, 1) == 1))
5318c2ecf20Sopenharmony_ci			portman_write_midi(pm, substream->number, byte);
5328c2ecf20Sopenharmony_ci	}
5338c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&pm->reg_lock, flags);
5348c2ecf20Sopenharmony_ci}
5358c2ecf20Sopenharmony_ci
5368c2ecf20Sopenharmony_cistatic const struct snd_rawmidi_ops snd_portman_midi_output = {
5378c2ecf20Sopenharmony_ci	.open =		snd_portman_midi_open,
5388c2ecf20Sopenharmony_ci	.close =	snd_portman_midi_close,
5398c2ecf20Sopenharmony_ci	.trigger =	snd_portman_midi_output_trigger,
5408c2ecf20Sopenharmony_ci};
5418c2ecf20Sopenharmony_ci
5428c2ecf20Sopenharmony_cistatic const struct snd_rawmidi_ops snd_portman_midi_input = {
5438c2ecf20Sopenharmony_ci	.open =		snd_portman_midi_open,
5448c2ecf20Sopenharmony_ci	.close =	snd_portman_midi_close,
5458c2ecf20Sopenharmony_ci	.trigger =	snd_portman_midi_input_trigger,
5468c2ecf20Sopenharmony_ci};
5478c2ecf20Sopenharmony_ci
5488c2ecf20Sopenharmony_ci/* Create and initialize the rawmidi component */
5498c2ecf20Sopenharmony_cistatic int snd_portman_rawmidi_create(struct snd_card *card)
5508c2ecf20Sopenharmony_ci{
5518c2ecf20Sopenharmony_ci	struct portman *pm = card->private_data;
5528c2ecf20Sopenharmony_ci	struct snd_rawmidi *rmidi;
5538c2ecf20Sopenharmony_ci	struct snd_rawmidi_substream *substream;
5548c2ecf20Sopenharmony_ci	int err;
5558c2ecf20Sopenharmony_ci
5568c2ecf20Sopenharmony_ci	err = snd_rawmidi_new(card, CARD_NAME, 0,
5578c2ecf20Sopenharmony_ci			      PORTMAN_NUM_OUTPUT_PORTS,
5588c2ecf20Sopenharmony_ci			      PORTMAN_NUM_INPUT_PORTS,
5598c2ecf20Sopenharmony_ci			      &rmidi);
5608c2ecf20Sopenharmony_ci	if (err < 0)
5618c2ecf20Sopenharmony_ci		return err;
5628c2ecf20Sopenharmony_ci
5638c2ecf20Sopenharmony_ci	rmidi->private_data = pm;
5648c2ecf20Sopenharmony_ci	strcpy(rmidi->name, CARD_NAME);
5658c2ecf20Sopenharmony_ci	rmidi->info_flags = SNDRV_RAWMIDI_INFO_OUTPUT |
5668c2ecf20Sopenharmony_ci		            SNDRV_RAWMIDI_INFO_INPUT |
5678c2ecf20Sopenharmony_ci                            SNDRV_RAWMIDI_INFO_DUPLEX;
5688c2ecf20Sopenharmony_ci
5698c2ecf20Sopenharmony_ci	pm->rmidi = rmidi;
5708c2ecf20Sopenharmony_ci
5718c2ecf20Sopenharmony_ci	/* register rawmidi ops */
5728c2ecf20Sopenharmony_ci	snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_OUTPUT,
5738c2ecf20Sopenharmony_ci			    &snd_portman_midi_output);
5748c2ecf20Sopenharmony_ci	snd_rawmidi_set_ops(rmidi, SNDRV_RAWMIDI_STREAM_INPUT,
5758c2ecf20Sopenharmony_ci			    &snd_portman_midi_input);
5768c2ecf20Sopenharmony_ci
5778c2ecf20Sopenharmony_ci	/* name substreams */
5788c2ecf20Sopenharmony_ci	/* output */
5798c2ecf20Sopenharmony_ci	list_for_each_entry(substream,
5808c2ecf20Sopenharmony_ci			    &rmidi->streams[SNDRV_RAWMIDI_STREAM_OUTPUT].substreams,
5818c2ecf20Sopenharmony_ci			    list) {
5828c2ecf20Sopenharmony_ci		sprintf(substream->name,
5838c2ecf20Sopenharmony_ci			"Portman2x4 %d", substream->number+1);
5848c2ecf20Sopenharmony_ci	}
5858c2ecf20Sopenharmony_ci	/* input */
5868c2ecf20Sopenharmony_ci	list_for_each_entry(substream,
5878c2ecf20Sopenharmony_ci			    &rmidi->streams[SNDRV_RAWMIDI_STREAM_INPUT].substreams,
5888c2ecf20Sopenharmony_ci			    list) {
5898c2ecf20Sopenharmony_ci		pm->midi_input[substream->number] = substream;
5908c2ecf20Sopenharmony_ci		sprintf(substream->name,
5918c2ecf20Sopenharmony_ci			"Portman2x4 %d", substream->number+1);
5928c2ecf20Sopenharmony_ci	}
5938c2ecf20Sopenharmony_ci
5948c2ecf20Sopenharmony_ci	return err;
5958c2ecf20Sopenharmony_ci}
5968c2ecf20Sopenharmony_ci
5978c2ecf20Sopenharmony_ci/*********************************************************************
5988c2ecf20Sopenharmony_ci * parport stuff
5998c2ecf20Sopenharmony_ci *********************************************************************/
6008c2ecf20Sopenharmony_cistatic void snd_portman_interrupt(void *userdata)
6018c2ecf20Sopenharmony_ci{
6028c2ecf20Sopenharmony_ci	unsigned char midivalue = 0;
6038c2ecf20Sopenharmony_ci	struct portman *pm = ((struct snd_card*)userdata)->private_data;
6048c2ecf20Sopenharmony_ci
6058c2ecf20Sopenharmony_ci	spin_lock(&pm->reg_lock);
6068c2ecf20Sopenharmony_ci
6078c2ecf20Sopenharmony_ci	/* While any input data is waiting */
6088c2ecf20Sopenharmony_ci	while ((portman_read_status(pm) & INT_REQ) == INT_REQ) {
6098c2ecf20Sopenharmony_ci		/* If data available on channel 0,
6108c2ecf20Sopenharmony_ci		   read it and stuff it into the queue. */
6118c2ecf20Sopenharmony_ci		if (portman_data_avail(pm, 0)) {
6128c2ecf20Sopenharmony_ci			/* Read Midi */
6138c2ecf20Sopenharmony_ci			midivalue = portman_read_midi(pm, 0);
6148c2ecf20Sopenharmony_ci			/* put midi into queue... */
6158c2ecf20Sopenharmony_ci			if (pm->mode[0] & PORTMAN2X4_MODE_INPUT_TRIGGERED)
6168c2ecf20Sopenharmony_ci				snd_rawmidi_receive(pm->midi_input[0],
6178c2ecf20Sopenharmony_ci						    &midivalue, 1);
6188c2ecf20Sopenharmony_ci
6198c2ecf20Sopenharmony_ci		}
6208c2ecf20Sopenharmony_ci		/* If data available on channel 1,
6218c2ecf20Sopenharmony_ci		   read it and stuff it into the queue. */
6228c2ecf20Sopenharmony_ci		if (portman_data_avail(pm, 1)) {
6238c2ecf20Sopenharmony_ci			/* Read Midi */
6248c2ecf20Sopenharmony_ci			midivalue = portman_read_midi(pm, 1);
6258c2ecf20Sopenharmony_ci			/* put midi into queue... */
6268c2ecf20Sopenharmony_ci			if (pm->mode[1] & PORTMAN2X4_MODE_INPUT_TRIGGERED)
6278c2ecf20Sopenharmony_ci				snd_rawmidi_receive(pm->midi_input[1],
6288c2ecf20Sopenharmony_ci						    &midivalue, 1);
6298c2ecf20Sopenharmony_ci		}
6308c2ecf20Sopenharmony_ci
6318c2ecf20Sopenharmony_ci	}
6328c2ecf20Sopenharmony_ci
6338c2ecf20Sopenharmony_ci	spin_unlock(&pm->reg_lock);
6348c2ecf20Sopenharmony_ci}
6358c2ecf20Sopenharmony_ci
6368c2ecf20Sopenharmony_cistatic void snd_portman_attach(struct parport *p)
6378c2ecf20Sopenharmony_ci{
6388c2ecf20Sopenharmony_ci	struct platform_device *device;
6398c2ecf20Sopenharmony_ci
6408c2ecf20Sopenharmony_ci	device = platform_device_alloc(PLATFORM_DRIVER, device_count);
6418c2ecf20Sopenharmony_ci	if (!device)
6428c2ecf20Sopenharmony_ci		return;
6438c2ecf20Sopenharmony_ci
6448c2ecf20Sopenharmony_ci	/* Temporary assignment to forward the parport */
6458c2ecf20Sopenharmony_ci	platform_set_drvdata(device, p);
6468c2ecf20Sopenharmony_ci
6478c2ecf20Sopenharmony_ci	if (platform_device_add(device) < 0) {
6488c2ecf20Sopenharmony_ci		platform_device_put(device);
6498c2ecf20Sopenharmony_ci		return;
6508c2ecf20Sopenharmony_ci	}
6518c2ecf20Sopenharmony_ci
6528c2ecf20Sopenharmony_ci	/* Since we dont get the return value of probe
6538c2ecf20Sopenharmony_ci	 * We need to check if device probing succeeded or not */
6548c2ecf20Sopenharmony_ci	if (!platform_get_drvdata(device)) {
6558c2ecf20Sopenharmony_ci		platform_device_unregister(device);
6568c2ecf20Sopenharmony_ci		return;
6578c2ecf20Sopenharmony_ci	}
6588c2ecf20Sopenharmony_ci
6598c2ecf20Sopenharmony_ci	/* register device in global table */
6608c2ecf20Sopenharmony_ci	platform_devices[device_count] = device;
6618c2ecf20Sopenharmony_ci	device_count++;
6628c2ecf20Sopenharmony_ci}
6638c2ecf20Sopenharmony_ci
6648c2ecf20Sopenharmony_cistatic void snd_portman_detach(struct parport *p)
6658c2ecf20Sopenharmony_ci{
6668c2ecf20Sopenharmony_ci	/* nothing to do here */
6678c2ecf20Sopenharmony_ci}
6688c2ecf20Sopenharmony_ci
6698c2ecf20Sopenharmony_cistatic int snd_portman_dev_probe(struct pardevice *pardev)
6708c2ecf20Sopenharmony_ci{
6718c2ecf20Sopenharmony_ci	if (strcmp(pardev->name, DRIVER_NAME))
6728c2ecf20Sopenharmony_ci		return -ENODEV;
6738c2ecf20Sopenharmony_ci
6748c2ecf20Sopenharmony_ci	return 0;
6758c2ecf20Sopenharmony_ci}
6768c2ecf20Sopenharmony_ci
6778c2ecf20Sopenharmony_cistatic struct parport_driver portman_parport_driver = {
6788c2ecf20Sopenharmony_ci	.name		= "portman2x4",
6798c2ecf20Sopenharmony_ci	.probe		= snd_portman_dev_probe,
6808c2ecf20Sopenharmony_ci	.match_port	= snd_portman_attach,
6818c2ecf20Sopenharmony_ci	.detach		= snd_portman_detach,
6828c2ecf20Sopenharmony_ci	.devmodel	= true,
6838c2ecf20Sopenharmony_ci};
6848c2ecf20Sopenharmony_ci
6858c2ecf20Sopenharmony_ci/*********************************************************************
6868c2ecf20Sopenharmony_ci * platform stuff
6878c2ecf20Sopenharmony_ci *********************************************************************/
6888c2ecf20Sopenharmony_cistatic void snd_portman_card_private_free(struct snd_card *card)
6898c2ecf20Sopenharmony_ci{
6908c2ecf20Sopenharmony_ci	struct portman *pm = card->private_data;
6918c2ecf20Sopenharmony_ci	struct pardevice *pardev = pm->pardev;
6928c2ecf20Sopenharmony_ci
6938c2ecf20Sopenharmony_ci	if (pardev) {
6948c2ecf20Sopenharmony_ci		parport_release(pardev);
6958c2ecf20Sopenharmony_ci		parport_unregister_device(pardev);
6968c2ecf20Sopenharmony_ci	}
6978c2ecf20Sopenharmony_ci
6988c2ecf20Sopenharmony_ci	portman_free(pm);
6998c2ecf20Sopenharmony_ci}
7008c2ecf20Sopenharmony_ci
7018c2ecf20Sopenharmony_cistatic int snd_portman_probe(struct platform_device *pdev)
7028c2ecf20Sopenharmony_ci{
7038c2ecf20Sopenharmony_ci	struct pardevice *pardev;
7048c2ecf20Sopenharmony_ci	struct parport *p;
7058c2ecf20Sopenharmony_ci	int dev = pdev->id;
7068c2ecf20Sopenharmony_ci	struct snd_card *card = NULL;
7078c2ecf20Sopenharmony_ci	struct portman *pm = NULL;
7088c2ecf20Sopenharmony_ci	int err;
7098c2ecf20Sopenharmony_ci	struct pardev_cb portman_cb = {
7108c2ecf20Sopenharmony_ci		.preempt = NULL,
7118c2ecf20Sopenharmony_ci		.wakeup = NULL,
7128c2ecf20Sopenharmony_ci		.irq_func = snd_portman_interrupt,	/* ISR */
7138c2ecf20Sopenharmony_ci		.flags = PARPORT_DEV_EXCL,		/* flags */
7148c2ecf20Sopenharmony_ci	};
7158c2ecf20Sopenharmony_ci
7168c2ecf20Sopenharmony_ci	p = platform_get_drvdata(pdev);
7178c2ecf20Sopenharmony_ci	platform_set_drvdata(pdev, NULL);
7188c2ecf20Sopenharmony_ci
7198c2ecf20Sopenharmony_ci	if (dev >= SNDRV_CARDS)
7208c2ecf20Sopenharmony_ci		return -ENODEV;
7218c2ecf20Sopenharmony_ci	if (!enable[dev])
7228c2ecf20Sopenharmony_ci		return -ENOENT;
7238c2ecf20Sopenharmony_ci
7248c2ecf20Sopenharmony_ci	err = snd_card_new(&pdev->dev, index[dev], id[dev], THIS_MODULE,
7258c2ecf20Sopenharmony_ci			   0, &card);
7268c2ecf20Sopenharmony_ci	if (err < 0) {
7278c2ecf20Sopenharmony_ci		snd_printd("Cannot create card\n");
7288c2ecf20Sopenharmony_ci		return err;
7298c2ecf20Sopenharmony_ci	}
7308c2ecf20Sopenharmony_ci	strcpy(card->driver, DRIVER_NAME);
7318c2ecf20Sopenharmony_ci	strcpy(card->shortname, CARD_NAME);
7328c2ecf20Sopenharmony_ci	sprintf(card->longname,  "%s at 0x%lx, irq %i",
7338c2ecf20Sopenharmony_ci		card->shortname, p->base, p->irq);
7348c2ecf20Sopenharmony_ci
7358c2ecf20Sopenharmony_ci	portman_cb.private = card;			   /* private */
7368c2ecf20Sopenharmony_ci	pardev = parport_register_dev_model(p,		   /* port */
7378c2ecf20Sopenharmony_ci					    DRIVER_NAME,   /* name */
7388c2ecf20Sopenharmony_ci					    &portman_cb,   /* callbacks */
7398c2ecf20Sopenharmony_ci					    pdev->id);	   /* device number */
7408c2ecf20Sopenharmony_ci	if (pardev == NULL) {
7418c2ecf20Sopenharmony_ci		snd_printd("Cannot register pardevice\n");
7428c2ecf20Sopenharmony_ci		err = -EIO;
7438c2ecf20Sopenharmony_ci		goto __err;
7448c2ecf20Sopenharmony_ci	}
7458c2ecf20Sopenharmony_ci
7468c2ecf20Sopenharmony_ci	/* claim parport */
7478c2ecf20Sopenharmony_ci	if (parport_claim(pardev)) {
7488c2ecf20Sopenharmony_ci		snd_printd("Cannot claim parport 0x%lx\n", pardev->port->base);
7498c2ecf20Sopenharmony_ci		err = -EIO;
7508c2ecf20Sopenharmony_ci		goto free_pardev;
7518c2ecf20Sopenharmony_ci	}
7528c2ecf20Sopenharmony_ci
7538c2ecf20Sopenharmony_ci	if ((err = portman_create(card, pardev, &pm)) < 0) {
7548c2ecf20Sopenharmony_ci		snd_printd("Cannot create main component\n");
7558c2ecf20Sopenharmony_ci		goto release_pardev;
7568c2ecf20Sopenharmony_ci	}
7578c2ecf20Sopenharmony_ci	card->private_data = pm;
7588c2ecf20Sopenharmony_ci	card->private_free = snd_portman_card_private_free;
7598c2ecf20Sopenharmony_ci
7608c2ecf20Sopenharmony_ci	err = portman_probe(p);
7618c2ecf20Sopenharmony_ci	if (err) {
7628c2ecf20Sopenharmony_ci		err = -EIO;
7638c2ecf20Sopenharmony_ci		goto __err;
7648c2ecf20Sopenharmony_ci	}
7658c2ecf20Sopenharmony_ci
7668c2ecf20Sopenharmony_ci	if ((err = snd_portman_rawmidi_create(card)) < 0) {
7678c2ecf20Sopenharmony_ci		snd_printd("Creating Rawmidi component failed\n");
7688c2ecf20Sopenharmony_ci		goto __err;
7698c2ecf20Sopenharmony_ci	}
7708c2ecf20Sopenharmony_ci
7718c2ecf20Sopenharmony_ci	/* init device */
7728c2ecf20Sopenharmony_ci	if ((err = portman_device_init(pm)) < 0)
7738c2ecf20Sopenharmony_ci		goto __err;
7748c2ecf20Sopenharmony_ci
7758c2ecf20Sopenharmony_ci	platform_set_drvdata(pdev, card);
7768c2ecf20Sopenharmony_ci
7778c2ecf20Sopenharmony_ci	/* At this point card will be usable */
7788c2ecf20Sopenharmony_ci	if ((err = snd_card_register(card)) < 0) {
7798c2ecf20Sopenharmony_ci		snd_printd("Cannot register card\n");
7808c2ecf20Sopenharmony_ci		goto __err;
7818c2ecf20Sopenharmony_ci	}
7828c2ecf20Sopenharmony_ci
7838c2ecf20Sopenharmony_ci	snd_printk(KERN_INFO "Portman 2x4 on 0x%lx\n", p->base);
7848c2ecf20Sopenharmony_ci	return 0;
7858c2ecf20Sopenharmony_ci
7868c2ecf20Sopenharmony_cirelease_pardev:
7878c2ecf20Sopenharmony_ci	parport_release(pardev);
7888c2ecf20Sopenharmony_cifree_pardev:
7898c2ecf20Sopenharmony_ci	parport_unregister_device(pardev);
7908c2ecf20Sopenharmony_ci__err:
7918c2ecf20Sopenharmony_ci	snd_card_free(card);
7928c2ecf20Sopenharmony_ci	return err;
7938c2ecf20Sopenharmony_ci}
7948c2ecf20Sopenharmony_ci
7958c2ecf20Sopenharmony_cistatic int snd_portman_remove(struct platform_device *pdev)
7968c2ecf20Sopenharmony_ci{
7978c2ecf20Sopenharmony_ci	struct snd_card *card = platform_get_drvdata(pdev);
7988c2ecf20Sopenharmony_ci
7998c2ecf20Sopenharmony_ci	if (card)
8008c2ecf20Sopenharmony_ci		snd_card_free(card);
8018c2ecf20Sopenharmony_ci
8028c2ecf20Sopenharmony_ci	return 0;
8038c2ecf20Sopenharmony_ci}
8048c2ecf20Sopenharmony_ci
8058c2ecf20Sopenharmony_ci
8068c2ecf20Sopenharmony_cistatic struct platform_driver snd_portman_driver = {
8078c2ecf20Sopenharmony_ci	.probe  = snd_portman_probe,
8088c2ecf20Sopenharmony_ci	.remove = snd_portman_remove,
8098c2ecf20Sopenharmony_ci	.driver = {
8108c2ecf20Sopenharmony_ci		.name = PLATFORM_DRIVER,
8118c2ecf20Sopenharmony_ci	}
8128c2ecf20Sopenharmony_ci};
8138c2ecf20Sopenharmony_ci
8148c2ecf20Sopenharmony_ci/*********************************************************************
8158c2ecf20Sopenharmony_ci * module init stuff
8168c2ecf20Sopenharmony_ci *********************************************************************/
8178c2ecf20Sopenharmony_cistatic void snd_portman_unregister_all(void)
8188c2ecf20Sopenharmony_ci{
8198c2ecf20Sopenharmony_ci	int i;
8208c2ecf20Sopenharmony_ci
8218c2ecf20Sopenharmony_ci	for (i = 0; i < SNDRV_CARDS; ++i) {
8228c2ecf20Sopenharmony_ci		if (platform_devices[i]) {
8238c2ecf20Sopenharmony_ci			platform_device_unregister(platform_devices[i]);
8248c2ecf20Sopenharmony_ci			platform_devices[i] = NULL;
8258c2ecf20Sopenharmony_ci		}
8268c2ecf20Sopenharmony_ci	}
8278c2ecf20Sopenharmony_ci	platform_driver_unregister(&snd_portman_driver);
8288c2ecf20Sopenharmony_ci	parport_unregister_driver(&portman_parport_driver);
8298c2ecf20Sopenharmony_ci}
8308c2ecf20Sopenharmony_ci
8318c2ecf20Sopenharmony_cistatic int __init snd_portman_module_init(void)
8328c2ecf20Sopenharmony_ci{
8338c2ecf20Sopenharmony_ci	int err;
8348c2ecf20Sopenharmony_ci
8358c2ecf20Sopenharmony_ci	if ((err = platform_driver_register(&snd_portman_driver)) < 0)
8368c2ecf20Sopenharmony_ci		return err;
8378c2ecf20Sopenharmony_ci
8388c2ecf20Sopenharmony_ci	if (parport_register_driver(&portman_parport_driver) != 0) {
8398c2ecf20Sopenharmony_ci		platform_driver_unregister(&snd_portman_driver);
8408c2ecf20Sopenharmony_ci		return -EIO;
8418c2ecf20Sopenharmony_ci	}
8428c2ecf20Sopenharmony_ci
8438c2ecf20Sopenharmony_ci	if (device_count == 0) {
8448c2ecf20Sopenharmony_ci		snd_portman_unregister_all();
8458c2ecf20Sopenharmony_ci		return -ENODEV;
8468c2ecf20Sopenharmony_ci	}
8478c2ecf20Sopenharmony_ci
8488c2ecf20Sopenharmony_ci	return 0;
8498c2ecf20Sopenharmony_ci}
8508c2ecf20Sopenharmony_ci
8518c2ecf20Sopenharmony_cistatic void __exit snd_portman_module_exit(void)
8528c2ecf20Sopenharmony_ci{
8538c2ecf20Sopenharmony_ci	snd_portman_unregister_all();
8548c2ecf20Sopenharmony_ci}
8558c2ecf20Sopenharmony_ci
8568c2ecf20Sopenharmony_cimodule_init(snd_portman_module_init);
8578c2ecf20Sopenharmony_cimodule_exit(snd_portman_module_exit);
858