net/hamradio/baycom_par.c

143 static inline void baycom_int_freq(struct baycom_state *bc)
150 	bc->debug_vals.cur_intcnt++;
151 	if (time_after_eq(cur_jiffies, bc->debug_vals.last_jiffies + HZ)) {
152 		bc->debug_vals.last_jiffies = cur_jiffies;
153 		bc->debug_vals.last_intcnt = bc->debug_vals.cur_intcnt;
154 		bc->debug_vals.cur_intcnt = 0;
155 		bc->debug_vals.last_pllcorr = bc->debug_vals.cur_pllcorr;
156 		bc->debug_vals.cur_pllcorr = 0;
179 static inline void par96_tx(struct net_device *dev, struct baycom_state *bc)
182 	unsigned int data = hdlcdrv_getbits(&bc->hdrv);
183 	struct parport *pp = bc->pdev->port;
187 		bc->modem.par96.scram = ((bc->modem.par96.scram << 1) |
188 					 (bc->modem.par96.scram & 1));
190 			bc->modem.par96.scram ^= 1;
191 		if (bc->modem.par96.scram & (PAR96_SCRAM_TAP1 << 1))
192 			bc->modem.par96.scram ^=
194 		if (bc->modem.par96.scram & (PAR96_SCRAM_TAP1 << 2))
203 static inline void par96_rx(struct net_device *dev, struct baycom_state *bc)
207 	struct parport *pp = bc->pdev->port;
213 		bc->modem.par96.descram = (bc->modem.par96.descram << 1);
215 			bc->modem.par96.descram |= 1;
216 		descx = bc->modem.par96.descram ^
217 			(bc->modem.par96.descram >> 1);
227 	hdlcdrv_putbits(&bc->hdrv, data);
231 	if (bc->options & BAYCOM_OPTIONS_SOFTDCD) {
232 		bc->modem.par96.dcd_shreg = (bc->modem.par96.dcd_shreg >> 16)
237 			if ((bc->modem.par96.dcd_shreg & mask) == mask2)
238 				bc->modem.par96.dcd_count = HDLCDRV_MAXFLEN+4;
242 			if (((bc->modem.par96.dcd_shreg & mask) == mask2) &&
243 			    (bc->modem.par96.dcd_count >= 0))
244 				bc->modem.par96.dcd_count -= HDLCDRV_MAXFLEN-10;
246 		if (bc->modem.par96.dcd_count >= 0)
247 			bc->modem.par96.dcd_count -= 2;
248 		hdlcdrv_setdcd(&bc->hdrv, bc->modem.par96.dcd_count > 0);
250 		hdlcdrv_setdcd(&bc->hdrv, !!(pp->ops->read_status(pp) & PAR96_DCD));
259 	struct baycom_state *bc = netdev_priv(dev);
261 	baycom_int_freq(bc);
265 	if (hdlcdrv_ptt(&bc->hdrv))
266 		par96_tx(dev, bc);
268 		par96_rx(dev, bc);
269 		if (--bc->modem.arb_divider <= 0) {
270 			bc->modem.arb_divider = 6;
272 			hdlcdrv_arbitrate(dev, &bc->hdrv);
276 	hdlcdrv_transmitter(dev, &bc->hdrv);
277 	hdlcdrv_receiver(dev, &bc->hdrv);
286 	struct baycom_state *bc = netdev_priv(dev);
289 	if (!parport_claim(bc->pdev))
297 	struct baycom_state *bc = netdev_priv(dev);
302 	if (!dev || !bc)
319 	memset(&bc->modem, 0, sizeof(bc->modem));
320 	bc->hdrv.par.bitrate = 9600;
335 	bc->pdev = parport_register_dev_model(pp, dev->name, &par_cb, i);
337 	if (!bc->pdev) {
341 	if (parport_claim(bc->pdev)) {
343 		parport_unregister_device(bc->pdev);
346 	pp = bc->pdev->port;
349         bc->hdrv.par.bitrate = 9600;
353 	       bc_drvname, dev->base_addr, dev->irq, bc->options);
361 	struct baycom_state *bc = netdev_priv(dev);
364 	if (!dev || !bc)
366 	pp = bc->pdev->port;
371 	parport_release(bc->pdev);
372 	parport_unregister_device(bc->pdev);
398 static int baycom_setmode(struct baycom_state *bc, const char *modestr)
401 		bc->options = 0;
403 		bc->options = BAYCOM_OPTIONS_SOFTDCD;
405 		bc->options = !!strchr(modestr, '*');
414 	struct baycom_state *bc;
420 	bc = netdev_priv(dev);
421 	BUG_ON(bc->hdrv.magic != HDLCDRV_MAGIC);
430 		strcpy(hi->data.modename, bc->options ? "par96" : "picpar");
439 		return baycom_setmode(bc, hi->data.modename);
460 		bi.data.dbg.debug1 = bc->hdrv.ptt_keyed;
461 		bi.data.dbg.debug2 = bc->debug_vals.last_intcnt;
462 		bi.data.dbg.debug3 = bc->debug_vals.last_pllcorr;
525 		struct baycom_state *bc;
541 		bc = netdev_priv(dev);
542 		if (set_hw && baycom_setmode(bc, mode[i]))