?? sm.c
字號:
struct sm_state *sm; 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 *//* --------------------------------------------------------------------- */
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -