Lines Matching refs:s
119 #define tenms_to_2flags(s,tenms) ((tenms * s->par.bitrate) / 100 / 16) argument
126 static int hdlc_rx_add_bytes(struct hdlcdrv_state *s, unsigned int bits, in hdlc_rx_add_bytes() argument
131 while (s->hdlcrx.rx_state && num >= 8) { in hdlc_rx_add_bytes()
132 if (s->hdlcrx.len >= sizeof(s->hdlcrx.buffer)) { in hdlc_rx_add_bytes()
133 s->hdlcrx.rx_state = 0; in hdlc_rx_add_bytes()
136 *s->hdlcrx.bp++ = bits >> (32-num); in hdlc_rx_add_bytes()
137 s->hdlcrx.len++; in hdlc_rx_add_bytes()
144 static void hdlc_rx_flag(struct net_device *dev, struct hdlcdrv_state *s) in hdlc_rx_flag() argument
150 if (s->hdlcrx.len < 4) in hdlc_rx_flag()
152 if (!check_crc_ccitt(s->hdlcrx.buffer, s->hdlcrx.len)) in hdlc_rx_flag()
154 pkt_len = s->hdlcrx.len - 2 + 1; /* KISS kludge */ in hdlc_rx_flag()
162 memcpy(cp, s->hdlcrx.buffer, pkt_len - 1); in hdlc_rx_flag()
168 void hdlcdrv_receiver(struct net_device *dev, struct hdlcdrv_state *s) in hdlcdrv_receiver() argument
173 if (!s || s->magic != HDLCDRV_MAGIC) in hdlcdrv_receiver()
175 if (test_and_set_bit(0, &s->hdlcrx.in_hdlc_rx)) in hdlcdrv_receiver()
178 while (!hdlcdrv_hbuf_empty(&s->hdlcrx.hbuf)) { in hdlcdrv_receiver()
179 word = hdlcdrv_hbuf_get(&s->hdlcrx.hbuf); in hdlcdrv_receiver()
182 hdlcdrv_add_bitbuffer_word(&s->bitbuf_hdlc, word); in hdlcdrv_receiver()
184 s->hdlcrx.bitstream >>= 16; in hdlcdrv_receiver()
185 s->hdlcrx.bitstream |= word << 16; in hdlcdrv_receiver()
186 s->hdlcrx.bitbuf >>= 16; in hdlcdrv_receiver()
187 s->hdlcrx.bitbuf |= word << 16; in hdlcdrv_receiver()
188 s->hdlcrx.numbits += 16; in hdlcdrv_receiver()
194 if ((s->hdlcrx.bitstream & mask1) == mask1) in hdlcdrv_receiver()
195 s->hdlcrx.rx_state = 0; /* abort received */ in hdlcdrv_receiver()
196 else if ((s->hdlcrx.bitstream & mask2) == mask3) { in hdlcdrv_receiver()
198 if (s->hdlcrx.rx_state) { in hdlcdrv_receiver()
199 hdlc_rx_add_bytes(s, s->hdlcrx.bitbuf in hdlcdrv_receiver()
201 s->hdlcrx.numbits in hdlcdrv_receiver()
203 hdlc_rx_flag(dev, s); in hdlcdrv_receiver()
205 s->hdlcrx.len = 0; in hdlcdrv_receiver()
206 s->hdlcrx.bp = s->hdlcrx.buffer; in hdlcdrv_receiver()
207 s->hdlcrx.rx_state = 1; in hdlcdrv_receiver()
208 s->hdlcrx.numbits = i; in hdlcdrv_receiver()
209 } else if ((s->hdlcrx.bitstream & mask4) == mask5) { in hdlcdrv_receiver()
211 s->hdlcrx.numbits--; in hdlcdrv_receiver()
212 s->hdlcrx.bitbuf = (s->hdlcrx.bitbuf & (~mask6)) | in hdlcdrv_receiver()
213 ((s->hdlcrx.bitbuf & mask6) << 1); in hdlcdrv_receiver()
216 s->hdlcrx.numbits -= hdlc_rx_add_bytes(s, s->hdlcrx.bitbuf, in hdlcdrv_receiver()
217 s->hdlcrx.numbits); in hdlcdrv_receiver()
219 clear_bit(0, &s->hdlcrx.in_hdlc_rx); in hdlcdrv_receiver()
224 static inline void do_kiss_params(struct hdlcdrv_state *s, in do_kiss_params() argument
238 s->ch_params.tx_delay = data[1]; in do_kiss_params()
239 PKP("TX delay = %ums", 10 * s->ch_params.tx_delay); in do_kiss_params()
242 s->ch_params.ppersist = data[1]; in do_kiss_params()
243 PKP("p persistence = %u", s->ch_params.ppersist); in do_kiss_params()
246 s->ch_params.slottime = data[1]; in do_kiss_params()
247 PKP("slot time = %ums", s->ch_params.slottime); in do_kiss_params()
250 s->ch_params.tx_tail = data[1]; in do_kiss_params()
251 PKP("TX tail = %ums", s->ch_params.tx_tail); in do_kiss_params()
254 s->ch_params.fulldup = !!data[1]; in do_kiss_params()
255 PKP("%s duplex", s->ch_params.fulldup ? "full" : "half"); in do_kiss_params()
265 void hdlcdrv_transmitter(struct net_device *dev, struct hdlcdrv_state *s) in hdlcdrv_transmitter() argument
272 if (!s || s->magic != HDLCDRV_MAGIC) in hdlcdrv_transmitter()
274 if (test_and_set_bit(0, &s->hdlctx.in_hdlc_tx)) in hdlcdrv_transmitter()
277 if (s->hdlctx.numbits >= 16) { in hdlcdrv_transmitter()
278 if (hdlcdrv_hbuf_full(&s->hdlctx.hbuf)) { in hdlcdrv_transmitter()
279 clear_bit(0, &s->hdlctx.in_hdlc_tx); in hdlcdrv_transmitter()
282 hdlcdrv_hbuf_put(&s->hdlctx.hbuf, s->hdlctx.bitbuf); in hdlcdrv_transmitter()
283 s->hdlctx.bitbuf >>= 16; in hdlcdrv_transmitter()
284 s->hdlctx.numbits -= 16; in hdlcdrv_transmitter()
286 switch (s->hdlctx.tx_state) { in hdlcdrv_transmitter()
288 clear_bit(0, &s->hdlctx.in_hdlc_tx); in hdlcdrv_transmitter()
292 if (s->hdlctx.numflags) { in hdlcdrv_transmitter()
293 s->hdlctx.numflags--; in hdlcdrv_transmitter()
294 s->hdlctx.bitbuf |= in hdlcdrv_transmitter()
295 0x7e7e << s->hdlctx.numbits; in hdlcdrv_transmitter()
296 s->hdlctx.numbits += 16; in hdlcdrv_transmitter()
299 if (s->hdlctx.tx_state == 1) { in hdlcdrv_transmitter()
300 clear_bit(0, &s->hdlctx.in_hdlc_tx); in hdlcdrv_transmitter()
303 if (!(skb = s->skb)) { in hdlcdrv_transmitter()
304 int flgs = tenms_to_2flags(s, s->ch_params.tx_tail); in hdlcdrv_transmitter()
307 s->hdlctx.tx_state = 1; in hdlcdrv_transmitter()
308 s->hdlctx.numflags = flgs; in hdlcdrv_transmitter()
311 s->skb = NULL; in hdlcdrv_transmitter()
315 s->hdlctx.tx_state = 0; in hdlcdrv_transmitter()
316 s->hdlctx.numflags = 1; in hdlcdrv_transmitter()
321 s->hdlctx.buffer, in hdlcdrv_transmitter()
324 s->hdlctx.bp = s->hdlctx.buffer; in hdlcdrv_transmitter()
325 append_crc_ccitt(s->hdlctx.buffer, pkt_len); in hdlcdrv_transmitter()
326 s->hdlctx.len = pkt_len+2; /* the appended CRC */ in hdlcdrv_transmitter()
327 s->hdlctx.tx_state = 2; in hdlcdrv_transmitter()
328 s->hdlctx.bitstream = 0; in hdlcdrv_transmitter()
332 if (!s->hdlctx.len) { in hdlcdrv_transmitter()
333 s->hdlctx.tx_state = 0; in hdlcdrv_transmitter()
334 s->hdlctx.numflags = 1; in hdlcdrv_transmitter()
337 s->hdlctx.len--; in hdlcdrv_transmitter()
338 s->hdlctx.bitbuf |= *s->hdlctx.bp << in hdlcdrv_transmitter()
339 s->hdlctx.numbits; in hdlcdrv_transmitter()
340 s->hdlctx.bitstream >>= 8; in hdlcdrv_transmitter()
341 s->hdlctx.bitstream |= (*s->hdlctx.bp++) << 16; in hdlcdrv_transmitter()
344 mask3 = 0xffffffff >> (31-s->hdlctx.numbits); in hdlcdrv_transmitter()
345 s->hdlctx.numbits += 8; in hdlcdrv_transmitter()
348 if ((s->hdlctx.bitstream & mask1) != mask1) in hdlcdrv_transmitter()
350 s->hdlctx.bitstream &= ~mask2; in hdlcdrv_transmitter()
351 s->hdlctx.bitbuf = in hdlcdrv_transmitter()
352 (s->hdlctx.bitbuf & mask3) | in hdlcdrv_transmitter()
353 ((s->hdlctx.bitbuf & in hdlcdrv_transmitter()
355 s->hdlctx.numbits++; in hdlcdrv_transmitter()
365 static void start_tx(struct net_device *dev, struct hdlcdrv_state *s) in start_tx() argument
367 s->hdlctx.tx_state = 0; in start_tx()
368 s->hdlctx.numflags = tenms_to_2flags(s, s->ch_params.tx_delay); in start_tx()
369 s->hdlctx.bitbuf = s->hdlctx.bitstream = s->hdlctx.numbits = 0; in start_tx()
370 hdlcdrv_transmitter(dev, s); in start_tx()
371 s->hdlctx.ptt = 1; in start_tx()
372 s->ptt_keyed++; in start_tx()
377 void hdlcdrv_arbitrate(struct net_device *dev, struct hdlcdrv_state *s) in hdlcdrv_arbitrate() argument
379 if (!s || s->magic != HDLCDRV_MAGIC || s->hdlctx.ptt || !s->skb) in hdlcdrv_arbitrate()
381 if (s->ch_params.fulldup) { in hdlcdrv_arbitrate()
382 start_tx(dev, s); in hdlcdrv_arbitrate()
385 if (s->hdlcrx.dcd) { in hdlcdrv_arbitrate()
386 s->hdlctx.slotcnt = s->ch_params.slottime; in hdlcdrv_arbitrate()
389 if ((--s->hdlctx.slotcnt) > 0) in hdlcdrv_arbitrate()
391 s->hdlctx.slotcnt = s->ch_params.slottime; in hdlcdrv_arbitrate()
392 if ((prandom_u32() % 256) > s->ch_params.ppersist) in hdlcdrv_arbitrate()
394 start_tx(dev, s); in hdlcdrv_arbitrate()
445 struct hdlcdrv_state *s = netdev_priv(dev); in hdlcdrv_open() local
448 if (!s->ops || !s->ops->open) in hdlcdrv_open()
454 s->opened = 1; in hdlcdrv_open()
455 s->hdlcrx.hbuf.rd = s->hdlcrx.hbuf.wr = 0; in hdlcdrv_open()
456 s->hdlcrx.in_hdlc_rx = 0; in hdlcdrv_open()
457 s->hdlcrx.rx_state = 0; in hdlcdrv_open()
459 s->hdlctx.hbuf.rd = s->hdlctx.hbuf.wr = 0; in hdlcdrv_open()
460 s->hdlctx.in_hdlc_tx = 0; in hdlcdrv_open()
461 s->hdlctx.tx_state = 1; in hdlcdrv_open()
462 s->hdlctx.numflags = 0; in hdlcdrv_open()
463 s->hdlctx.bitstream = s->hdlctx.bitbuf = s->hdlctx.numbits = 0; in hdlcdrv_open()
464 s->hdlctx.ptt = 0; in hdlcdrv_open()
465 s->hdlctx.slotcnt = s->ch_params.slottime; in hdlcdrv_open()
466 s->hdlctx.calibrate = 0; in hdlcdrv_open()
468 i = s->ops->open(dev); in hdlcdrv_open()
482 struct hdlcdrv_state *s = netdev_priv(dev); in hdlcdrv_close() local
487 if (s->ops && s->ops->close) in hdlcdrv_close()
488 i = s->ops->close(dev); in hdlcdrv_close()
489 if (s->skb) in hdlcdrv_close()
490 dev_kfree_skb(s->skb); in hdlcdrv_close()
491 s->skb = NULL; in hdlcdrv_close()
492 s->opened = 0; in hdlcdrv_close()
500 struct hdlcdrv_state *s = netdev_priv(dev); in hdlcdrv_ioctl() local
504 if (s->ops && s->ops->ioctl) in hdlcdrv_ioctl()
505 return s->ops->ioctl(dev, ifr, &bi, cmd); in hdlcdrv_ioctl()
513 if (s->ops && s->ops->ioctl) in hdlcdrv_ioctl()
514 return s->ops->ioctl(dev, ifr, &bi, cmd); in hdlcdrv_ioctl()
518 bi.data.cp.tx_delay = s->ch_params.tx_delay; in hdlcdrv_ioctl()
519 bi.data.cp.tx_tail = s->ch_params.tx_tail; in hdlcdrv_ioctl()
520 bi.data.cp.slottime = s->ch_params.slottime; in hdlcdrv_ioctl()
521 bi.data.cp.ppersist = s->ch_params.ppersist; in hdlcdrv_ioctl()
522 bi.data.cp.fulldup = s->ch_params.fulldup; in hdlcdrv_ioctl()
528 s->ch_params.tx_delay = bi.data.cp.tx_delay; in hdlcdrv_ioctl()
529 s->ch_params.tx_tail = bi.data.cp.tx_tail; in hdlcdrv_ioctl()
530 s->ch_params.slottime = bi.data.cp.slottime; in hdlcdrv_ioctl()
531 s->ch_params.ppersist = bi.data.cp.ppersist; in hdlcdrv_ioctl()
532 s->ch_params.fulldup = bi.data.cp.fulldup; in hdlcdrv_ioctl()
533 s->hdlctx.slotcnt = 1; in hdlcdrv_ioctl()
540 bi.data.mp.dma2 = s->ptt_out.dma2; in hdlcdrv_ioctl()
541 bi.data.mp.seriobase = s->ptt_out.seriobase; in hdlcdrv_ioctl()
542 bi.data.mp.pariobase = s->ptt_out.pariobase; in hdlcdrv_ioctl()
543 bi.data.mp.midiiobase = s->ptt_out.midiiobase; in hdlcdrv_ioctl()
552 s->ptt_out.dma2 = bi.data.mp.dma2; in hdlcdrv_ioctl()
553 s->ptt_out.seriobase = bi.data.mp.seriobase; in hdlcdrv_ioctl()
554 s->ptt_out.pariobase = bi.data.mp.pariobase; in hdlcdrv_ioctl()
555 s->ptt_out.midiiobase = bi.data.mp.midiiobase; in hdlcdrv_ioctl()
559 bi.data.cs.ptt = hdlcdrv_ptt(s); in hdlcdrv_ioctl()
560 bi.data.cs.dcd = s->hdlcrx.dcd; in hdlcdrv_ioctl()
561 bi.data.cs.ptt_keyed = s->ptt_keyed; in hdlcdrv_ioctl()
569 bi.data.ocs.ptt = hdlcdrv_ptt(s); in hdlcdrv_ioctl()
570 bi.data.ocs.dcd = s->hdlcrx.dcd; in hdlcdrv_ioctl()
571 bi.data.ocs.ptt_keyed = s->ptt_keyed; in hdlcdrv_ioctl()
577 if (s->par.bitrate <= 0) in hdlcdrv_ioctl()
579 if (bi.data.calibrate > INT_MAX / s->par.bitrate) in hdlcdrv_ioctl()
581 s->hdlctx.calibrate = bi.data.calibrate * s->par.bitrate / 16; in hdlcdrv_ioctl()
588 if (s->bitbuf_channel.rd == s->bitbuf_channel.wr) in hdlcdrv_ioctl()
591 s->bitbuf_channel.buffer[s->bitbuf_channel.rd]; in hdlcdrv_ioctl()
592 s->bitbuf_channel.rd = (s->bitbuf_channel.rd+1) % in hdlcdrv_ioctl()
593 sizeof(s->bitbuf_channel.buffer); in hdlcdrv_ioctl()
601 if (s->bitbuf_hdlc.rd == s->bitbuf_hdlc.wr) in hdlcdrv_ioctl()
604 s->bitbuf_hdlc.buffer[s->bitbuf_hdlc.rd]; in hdlcdrv_ioctl()
605 s->bitbuf_hdlc.rd = (s->bitbuf_hdlc.rd+1) % in hdlcdrv_ioctl()
606 sizeof(s->bitbuf_hdlc.buffer); in hdlcdrv_ioctl()
611 if (s->ops && s->ops->drvname) { in hdlcdrv_ioctl()
612 strncpy(bi.data.drivername, s->ops->drvname, in hdlcdrv_ioctl()
644 struct hdlcdrv_state *s = netdev_priv(dev); in hdlcdrv_setup() local
649 s->ch_params = dflt_ch_params; in hdlcdrv_setup()
650 s->ptt_keyed = 0; in hdlcdrv_setup()
652 spin_lock_init(&s->hdlcrx.hbuf.lock); in hdlcdrv_setup()
653 s->hdlcrx.hbuf.rd = s->hdlcrx.hbuf.wr = 0; in hdlcdrv_setup()
654 s->hdlcrx.in_hdlc_rx = 0; in hdlcdrv_setup()
655 s->hdlcrx.rx_state = 0; in hdlcdrv_setup()
657 spin_lock_init(&s->hdlctx.hbuf.lock); in hdlcdrv_setup()
658 s->hdlctx.hbuf.rd = s->hdlctx.hbuf.wr = 0; in hdlcdrv_setup()
659 s->hdlctx.in_hdlc_tx = 0; in hdlcdrv_setup()
660 s->hdlctx.tx_state = 1; in hdlcdrv_setup()
661 s->hdlctx.numflags = 0; in hdlcdrv_setup()
662 s->hdlctx.bitstream = s->hdlctx.bitbuf = s->hdlctx.numbits = 0; in hdlcdrv_setup()
663 s->hdlctx.ptt = 0; in hdlcdrv_setup()
664 s->hdlctx.slotcnt = s->ch_params.slottime; in hdlcdrv_setup()
665 s->hdlctx.calibrate = 0; in hdlcdrv_setup()
668 s->bitbuf_channel.rd = s->bitbuf_channel.wr = 0; in hdlcdrv_setup()
669 s->bitbuf_channel.shreg = 0x80; in hdlcdrv_setup()
671 s->bitbuf_hdlc.rd = s->bitbuf_hdlc.wr = 0; in hdlcdrv_setup()
672 s->bitbuf_hdlc.shreg = 0x80; in hdlcdrv_setup()
678 s->skb = NULL; in hdlcdrv_setup()
699 struct hdlcdrv_state *s; in hdlcdrv_register() local
714 s = netdev_priv(dev); in hdlcdrv_register()
715 s->magic = HDLCDRV_MAGIC; in hdlcdrv_register()
716 s->ops = ops; in hdlcdrv_register()
735 struct hdlcdrv_state *s = netdev_priv(dev); in hdlcdrv_unregister() local
737 BUG_ON(s->magic != HDLCDRV_MAGIC); in hdlcdrv_unregister()
739 if (s->opened && s->ops->close) in hdlcdrv_unregister()
740 s->ops->close(dev); in hdlcdrv_unregister()