int err;	if (!dev || !dev->priv ||	    ((struct sm_state *)dev->priv)->hdrv.magic != HDLCDRV_MAGIC) {		printk(KERN_ERR "sm_open: invalid device struct\n");		return -EINVAL;	}	sm = (struct sm_state *)dev->priv;	if (!sm->mode_tx || !sm->mode_rx || !sm->hwdrv || !sm->hwdrv->open)		return -ENODEV;	sm->hdrv.par.bitrate = sm->mode_rx->bitrate;	err = sm->hwdrv->open(dev, sm);	if (err)		return err;	sm_output_open(sm, dev->name);	MOD_INC_USE_COUNT;	printk(KERN_INFO "%s: %s mode %s.%s at iobase 0x%lx irq %u dma %u dma2 %u\n",	       sm_drvname, sm->hwdrv->hw_name, sm->mode_tx->name,	       sm->mode_rx->name, dev->base_addr, dev->irq, dev->dma, sm->hdrv.ptt_out.dma2);	return 0;}/* --------------------------------------------------------------------- */static int sm_close(struct net_device *dev){	struct sm_state *sm;	int err = -ENODEV;	if (!dev || !dev->priv ||	    ((struct sm_state *)dev->priv)->hdrv.magic != HDLCDRV_MAGIC) {		printk(KERN_ERR "sm_close: invalid device struct\n");		return -EINVAL;	}	sm = (struct sm_state *)dev->priv;	if (sm->hwdrv && sm->hwdrv->close)		err = sm->hwdrv && sm->hwdrv->close(dev, sm);	sm_output_close(sm);	MOD_DEC_USE_COUNT;	printk(KERN_INFO "%s: close %s at iobase 0x%lx irq %u dma %u\n",	       sm_drvname, sm->hwdrv->hw_name, dev->base_addr, dev->irq, dev->dma);	return err;}/* --------------------------------------------------------------------- */static int sethw(struct net_device *dev, struct sm_state *sm, char *mode){	char *cp = strchr(mode, ':');	const struct hardware_info **hwp = sm_hardware_table;	if (!cp)		cp = mode;	else {		*cp++ = '\0';		while (hwp && (*hwp) && (*hwp)->hw_name && strcmp((*hwp)->hw_name, mode))			hwp++;		if (!hwp || !*hwp || !(*hwp)->hw_name)			return -EINVAL;		if ((*hwp)->loc_storage > sizeof(sm->hw)) {			printk(KERN_ERR "%s: insufficient storage for hw driver %s (%d)\n",			       sm_drvname, (*hwp)->hw_name, (*hwp)->loc_storage);			return -EINVAL;		}		sm->hwdrv = *hwp;	}	if (!*cp)		return 0;	if (sm->hwdrv && sm->hwdrv->sethw)		return sm->hwdrv->sethw(dev, sm, cp);	return -EINVAL;}/* --------------------------------------------------------------------- */static int sm_ioctl(struct net_device *dev, struct ifreq *ifr,		    struct hdlcdrv_ioctl *hi, int cmd){	struct sm_state *sm;	struct sm_ioctl bi;	unsigned long flags;	unsigned int newdiagmode;	unsigned int newdiagflags;	char *cp;	const struct modem_tx_info **mtp = sm_modem_tx_table;	const struct modem_rx_info **mrp = sm_modem_rx_table;	const struct hardware_info **hwp = sm_hardware_table;	if (!dev || !dev->priv ||	    ((struct sm_state *)dev->priv)->hdrv.magic != HDLCDRV_MAGIC) {		printk(KERN_ERR "sm_ioctl: invalid device struct\n");		return -EINVAL;	}	sm = (struct sm_state *)dev->priv;	if (cmd != SIOCDEVPRIVATE) {		if (!sm->hwdrv || !sm->hwdrv->ioctl)			return sm->hwdrv->ioctl(dev, sm, ifr, hi, cmd);		return -ENOIOCTLCMD;	}	switch (hi->cmd) {	default:		if (sm->hwdrv && sm->hwdrv->ioctl)			return sm->hwdrv->ioctl(dev, sm, ifr, hi, cmd);		return -ENOIOCTLCMD;	case HDLCDRVCTL_GETMODE:		cp = hi->data.modename;		if (sm->hwdrv && sm->hwdrv->hw_name)			cp += sprintf(cp, "%s:", sm->hwdrv->hw_name);		else			cp += sprintf(cp, "<unspec>:");		if (sm->mode_tx && sm->mode_tx->name)			cp += sprintf(cp, "%s", sm->mode_tx->name);		else			cp += sprintf(cp, "<unspec>");		if (!sm->mode_rx || !sm->mode_rx ||		    strcmp(sm->mode_rx->name, sm->mode_tx->name)) {			if (sm->mode_rx && sm->mode_rx->name)				cp += sprintf(cp, ",%s", sm->mode_rx->name);			else				cp += sprintf(cp, ",<unspec>");		}		if (copy_to_user(ifr->ifr_data, hi, sizeof(*hi)))			return -EFAULT;		return 0;	case HDLCDRVCTL_SETMODE:		if (netif_running(dev) || !capable(CAP_NET_ADMIN))			return -EACCES;		hi->data.modename[sizeof(hi->data.modename)-1] = '\0';		return sethw(dev, sm, hi->data.modename);	case HDLCDRVCTL_MODELIST:		cp = hi->data.modename;		while (*hwp) {			if ((*hwp)->hw_name)				cp += sprintf(cp, "%s:,", (*hwp)->hw_name);			hwp++;		}		while (*mtp) {			if ((*mtp)->name)				cp += sprintf(cp, ">%s,", (*mtp)->name);			mtp++;		}		while (*mrp) {			if ((*mrp)->name)				cp += sprintf(cp, "<%s,", (*mrp)->name);			mrp++;		}		cp[-1] = '\0';		if (copy_to_user(ifr->ifr_data, hi, sizeof(*hi)))			return -EFAULT;		return 0;#ifdef SM_DEBUG	case SMCTL_GETDEBUG:		if (copy_from_user(&bi, ifr->ifr_data, sizeof(bi)))			return -EFAULT;		bi.data.dbg.int_rate = sm->debug_vals.last_intcnt;		bi.data.dbg.mod_cycles = sm->debug_vals.mod_cyc;		bi.data.dbg.demod_cycles = sm->debug_vals.demod_cyc;		bi.data.dbg.dma_residue = sm->debug_vals.dma_residue;		sm->debug_vals.mod_cyc = sm->debug_vals.demod_cyc =			sm->debug_vals.dma_residue = 0;		if (copy_to_user(ifr->ifr_data, &bi, sizeof(bi)))			return -EFAULT;		return 0;#endif /* SM_DEBUG */	case SMCTL_DIAGNOSE:		if (copy_from_user(&bi, ifr->ifr_data, sizeof(bi)))			return -EFAULT;		newdiagmode = bi.data.diag.mode;		newdiagflags = bi.data.diag.flags;		if (newdiagmode > SM_DIAGMODE_CONSTELLATION)			return -EINVAL;		bi.data.diag.mode = sm->diag.mode;		bi.data.diag.flags = sm->diag.flags;		bi.data.diag.samplesperbit = sm->mode_rx->sperbit;		if (sm->diag.mode != newdiagmode) {			save_flags(flags);			cli();			sm->diag.ptr = -1;			sm->diag.flags = newdiagflags & ~SM_DIAGFLAG_VALID;			sm->diag.mode = newdiagmode;			restore_flags(flags);			if (copy_to_user(ifr->ifr_data, &bi, sizeof(bi)))				return -EFAULT;			return 0;		}		if (sm->diag.ptr < 0 || sm->diag.mode == SM_DIAGMODE_OFF) {			if (copy_to_user(ifr->ifr_data, &bi, sizeof(bi)))				return -EFAULT;			return 0;		}		if (bi.data.diag.datalen > DIAGDATALEN)			bi.data.diag.datalen = DIAGDATALEN;		if (sm->diag.ptr < bi.data.diag.datalen) {			if (copy_to_user(ifr->ifr_data, &bi, sizeof(bi)))				return -EFAULT;			return 0;		}		if (copy_to_user(bi.data.diag.data, sm->diag.data,				 bi.data.diag.datalen * sizeof(short)))			return -EFAULT;		bi.data.diag.flags |= SM_DIAGFLAG_VALID;		save_flags(flags);		cli();		sm->diag.ptr = -1;		sm->diag.flags = newdiagflags & ~SM_DIAGFLAG_VALID;		sm->diag.mode = newdiagmode;		restore_flags(flags);		if (copy_to_user(ifr->ifr_data, &bi, sizeof(bi)))			return -EFAULT;		return 0;	}}/* --------------------------------------------------------------------- *//* * command line settable parameters */static char *mode[NR_PORTS] = { [0 ... NR_PORTS-1] = NULL };static int iobase[NR_PORTS] = { [0 ... NR_PORTS-1] = -1 };static int irq[NR_PORTS] = { [0 ... NR_PORTS-1] = -1 };static int dma[NR_PORTS] = { [0 ... NR_PORTS-1] = -1 };static int dma2[NR_PORTS] = { [0 ... NR_PORTS-1] = -1 };static int serio[NR_PORTS] = { [0 ... NR_PORTS-1] = 0 };static int pario[NR_PORTS] = { [0 ... NR_PORTS-1] = 0 };static int midiio[NR_PORTS] = { [0 ... NR_PORTS-1] = 0 };MODULE_PARM(mode, "1-" __MODULE_STRING(NR_PORTS) "s");MODULE_PARM_DESC(mode, "soundmodem operating mode; eg. sbc:afsk1200 or wss:fsk9600");MODULE_PARM(iobase, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(iobase, "soundmodem base address");MODULE_PARM(irq, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(irq, "soundmodem interrupt");MODULE_PARM(dma, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(dma, "soundmodem dma channel");MODULE_PARM(dma2, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(dma2, "soundmodem 2nd dma channel; full duplex only");MODULE_PARM(serio, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(serio, "soundmodem PTT output on serial port");MODULE_PARM(pario, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(pario, "soundmodem PTT output on parallel port");MODULE_PARM(midiio, "1-" __MODULE_STRING(NR_PORTS) "i");MODULE_PARM_DESC(midiio, "soundmodem PTT output on midi port");MODULE_AUTHOR("Thomas M. Sailer, sailer@ife.ee.ethz.ch, hb9jnx@hb9w.che.eu");MODULE_DESCRIPTION("Soundcard amateur radio modem driver");/* --------------------------------------------------------------------- */static int __init init_soundmodem(void){	int i, j, found = 0;	char set_hw = 1;	struct sm_state *sm;	printk(sm_drvinfo);	/*	 * register net devices	 */	for (i = 0; i < NR_PORTS; i++) {		struct net_device *dev = sm_device+i;		char ifname[IFNAMSIZ];		sprintf(ifname, "sm%d", i);		if (!mode[i])			set_hw = 0;		else {			if (!strncmp(mode[i], "sbc", 3)) {				if (iobase[i] == -1)					iobase[i] = 0x220;				if (irq[i] == -1)					irq[i] = 5;				if (dma[i] == -1)					dma[i] = 1;			} else {				if (iobase[i] == -1)					iobase[i] = 0x530;				if (irq[i] == -1)					irq[i] = 11;				if (dma[i] == -1)					dma[i] = 1;			}		}		if (!set_hw)			iobase[i] = irq[i] = 0;		j = hdlcdrv_register_hdlcdrv(dev, &sm_ops, sizeof(struct sm_state), ifname, iobase[i], irq[i], dma[i]);		if (!j) {			sm = (struct sm_state *)dev->priv;			sm->hdrv.ptt_out.dma2 = dma2[i];			sm->hdrv.ptt_out.seriobase = serio[i];			sm->hdrv.ptt_out.pariobase = pario[i];			sm->hdrv.ptt_out.midiiobase = midiio[i];			if (set_hw && sethw(dev, sm, mode[i]))				set_hw = 0;			found++;		} else {			printk(KERN_WARNING "%s: cannot register net device\n", sm_drvname);		}	}	if (!found)		return -ENXIO;	return 0;}static void __exit cleanup_soundmodem(void){	int i;	printk(KERN_INFO "sm: cleanup_module called\n");	for(i = 0; i < NR_PORTS; i++) {		struct net_device *dev = sm_device+i;		struct sm_state *sm = (struct sm_state *)dev->priv;		if (sm) {			if (sm->hdrv.magic != HDLCDRV_MAGIC)				printk(KERN_ERR "sm: invalid magic in "				       "cleanup_module\n");			else				hdlcdrv_unregister_hdlcdrv(dev);		}	}}module_init(init_soundmodem);module_exit(cleanup_soundmodem);/* --------------------------------------------------------------------- */#ifndef MODULE/* * format: soundmodem=io,irq,dma[,dma2[,serio[,pario]]],mode * mode: hw:modem * hw: sbc, wss, wssfdx * modem: afsk1200, fsk9600 */static int __init sm_setup(char *str){	static unsigned nr_dev;	int ints[8];	if (nr_dev >= NR_PORTS)		return 0;	str = get_options(str, 8, ints);	mode[nr_dev] = str;	if (ints[0] >= 1)		iobase[nr_dev] = ints[1];	if (ints[0] >= 2)		irq[nr_dev] = ints[2];	if (ints[0] >= 3)		dma[nr_dev] = ints[3];	if (ints[0] >= 4)		dma2[nr_dev] = ints[4];	if (ints[0] >= 5)		serio[nr_dev] = ints[5];	if (ints[0] >= 6)		pario[nr_dev] = ints[6];	if (ints[0] >= 7)		midiio[nr_dev] = ints[7];	nr_dev++;	return 1;}__setup("soundmodem=", sm_setup);#endif /* MODULE *//* --------------------------------------------------------------------- */MODULE_LICENSE("GPL");