hdlcdrv.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*****************************************************************************/
  3. /*
  4. * hdlcdrv.c -- HDLC packet radio network driver.
  5. *
  6. * Copyright (C) 1996-2000 Thomas Sailer ([email protected])
  7. *
  8. * Please note that the GPL allows you to use the driver, NOT the radio.
  9. * In order to use the radio, you need a license from the communications
  10. * authority of your country.
  11. *
  12. * The driver was derived from Donald Beckers skeleton.c
  13. * Written 1993-94 by Donald Becker.
  14. *
  15. * History:
  16. * 0.1 21.09.1996 Started
  17. * 18.10.1996 Changed to new user space access routines
  18. * (copy_{to,from}_user)
  19. * 0.2 21.11.1996 various small changes
  20. * 0.3 03.03.1997 fixed (hopefully) IP not working with ax.25 as a module
  21. * 0.4 16.04.1997 init code/data tagged
  22. * 0.5 30.07.1997 made HDLC buffers bigger (solves a problem with the
  23. * soundmodem driver)
  24. * 0.6 05.04.1998 add spinlocks
  25. * 0.7 03.08.1999 removed some old compatibility cruft
  26. * 0.8 12.02.2000 adapted to softnet driver interface
  27. */
  28. /*****************************************************************************/
  29. #include <linux/capability.h>
  30. #include <linux/compat.h>
  31. #include <linux/module.h>
  32. #include <linux/types.h>
  33. #include <linux/net.h>
  34. #include <linux/in.h>
  35. #include <linux/if.h>
  36. #include <linux/errno.h>
  37. #include <linux/init.h>
  38. #include <linux/bitops.h>
  39. #include <linux/netdevice.h>
  40. #include <linux/if_arp.h>
  41. #include <linux/skbuff.h>
  42. #include <linux/hdlcdrv.h>
  43. #include <linux/random.h>
  44. #include <net/ax25.h>
  45. #include <linux/uaccess.h>
  46. #include <linux/crc-ccitt.h>
  47. /* --------------------------------------------------------------------- */
  48. #define KISS_VERBOSE
  49. /* --------------------------------------------------------------------- */
  50. #define PARAM_TXDELAY 1
  51. #define PARAM_PERSIST 2
  52. #define PARAM_SLOTTIME 3
  53. #define PARAM_TXTAIL 4
  54. #define PARAM_FULLDUP 5
  55. #define PARAM_HARDWARE 6
  56. #define PARAM_RETURN 255
  57. /* --------------------------------------------------------------------- */
  58. /*
  59. * the CRC routines are stolen from WAMPES
  60. * by Dieter Deyke
  61. */
  62. /*---------------------------------------------------------------------------*/
  63. static inline void append_crc_ccitt(unsigned char *buffer, int len)
  64. {
  65. unsigned int crc = crc_ccitt(0xffff, buffer, len) ^ 0xffff;
  66. buffer += len;
  67. *buffer++ = crc;
  68. *buffer++ = crc >> 8;
  69. }
  70. /*---------------------------------------------------------------------------*/
  71. static inline int check_crc_ccitt(const unsigned char *buf, int cnt)
  72. {
  73. return (crc_ccitt(0xffff, buf, cnt) & 0xffff) == 0xf0b8;
  74. }
  75. /*---------------------------------------------------------------------------*/
  76. #if 0
  77. static int calc_crc_ccitt(const unsigned char *buf, int cnt)
  78. {
  79. unsigned int crc = 0xffff;
  80. for (; cnt > 0; cnt--)
  81. crc = (crc >> 8) ^ crc_ccitt_table[(crc ^ *buf++) & 0xff];
  82. crc ^= 0xffff;
  83. return crc & 0xffff;
  84. }
  85. #endif
  86. /* ---------------------------------------------------------------------- */
  87. #define tenms_to_2flags(s,tenms) ((tenms * s->par.bitrate) / 100 / 16)
  88. /* ---------------------------------------------------------------------- */
  89. /*
  90. * The HDLC routines
  91. */
  92. static int hdlc_rx_add_bytes(struct hdlcdrv_state *s, unsigned int bits,
  93. int num)
  94. {
  95. int added = 0;
  96. while (s->hdlcrx.rx_state && num >= 8) {
  97. if (s->hdlcrx.len >= sizeof(s->hdlcrx.buffer)) {
  98. s->hdlcrx.rx_state = 0;
  99. return 0;
  100. }
  101. *s->hdlcrx.bp++ = bits >> (32-num);
  102. s->hdlcrx.len++;
  103. num -= 8;
  104. added += 8;
  105. }
  106. return added;
  107. }
  108. static void hdlc_rx_flag(struct net_device *dev, struct hdlcdrv_state *s)
  109. {
  110. struct sk_buff *skb;
  111. int pkt_len;
  112. unsigned char *cp;
  113. if (s->hdlcrx.len < 4)
  114. return;
  115. if (!check_crc_ccitt(s->hdlcrx.buffer, s->hdlcrx.len))
  116. return;
  117. pkt_len = s->hdlcrx.len - 2 + 1; /* KISS kludge */
  118. if (!(skb = dev_alloc_skb(pkt_len))) {
  119. printk("%s: memory squeeze, dropping packet\n", dev->name);
  120. dev->stats.rx_dropped++;
  121. return;
  122. }
  123. cp = skb_put(skb, pkt_len);
  124. *cp++ = 0; /* KISS kludge */
  125. memcpy(cp, s->hdlcrx.buffer, pkt_len - 1);
  126. skb->protocol = ax25_type_trans(skb, dev);
  127. netif_rx(skb);
  128. dev->stats.rx_packets++;
  129. }
  130. void hdlcdrv_receiver(struct net_device *dev, struct hdlcdrv_state *s)
  131. {
  132. int i;
  133. unsigned int mask1, mask2, mask3, mask4, mask5, mask6, word;
  134. if (!s || s->magic != HDLCDRV_MAGIC)
  135. return;
  136. if (test_and_set_bit(0, &s->hdlcrx.in_hdlc_rx))
  137. return;
  138. while (!hdlcdrv_hbuf_empty(&s->hdlcrx.hbuf)) {
  139. word = hdlcdrv_hbuf_get(&s->hdlcrx.hbuf);
  140. #ifdef HDLCDRV_DEBUG
  141. hdlcdrv_add_bitbuffer_word(&s->bitbuf_hdlc, word);
  142. #endif /* HDLCDRV_DEBUG */
  143. s->hdlcrx.bitstream >>= 16;
  144. s->hdlcrx.bitstream |= word << 16;
  145. s->hdlcrx.bitbuf >>= 16;
  146. s->hdlcrx.bitbuf |= word << 16;
  147. s->hdlcrx.numbits += 16;
  148. for(i = 15, mask1 = 0x1fc00, mask2 = 0x1fe00, mask3 = 0x0fc00,
  149. mask4 = 0x1f800, mask5 = 0xf800, mask6 = 0xffff;
  150. i >= 0;
  151. i--, mask1 <<= 1, mask2 <<= 1, mask3 <<= 1, mask4 <<= 1,
  152. mask5 <<= 1, mask6 = (mask6 << 1) | 1) {
  153. if ((s->hdlcrx.bitstream & mask1) == mask1)
  154. s->hdlcrx.rx_state = 0; /* abort received */
  155. else if ((s->hdlcrx.bitstream & mask2) == mask3) {
  156. /* flag received */
  157. if (s->hdlcrx.rx_state) {
  158. hdlc_rx_add_bytes(s, s->hdlcrx.bitbuf
  159. << (8+i),
  160. s->hdlcrx.numbits
  161. -8-i);
  162. hdlc_rx_flag(dev, s);
  163. }
  164. s->hdlcrx.len = 0;
  165. s->hdlcrx.bp = s->hdlcrx.buffer;
  166. s->hdlcrx.rx_state = 1;
  167. s->hdlcrx.numbits = i;
  168. } else if ((s->hdlcrx.bitstream & mask4) == mask5) {
  169. /* stuffed bit */
  170. s->hdlcrx.numbits--;
  171. s->hdlcrx.bitbuf = (s->hdlcrx.bitbuf & (~mask6)) |
  172. ((s->hdlcrx.bitbuf & mask6) << 1);
  173. }
  174. }
  175. s->hdlcrx.numbits -= hdlc_rx_add_bytes(s, s->hdlcrx.bitbuf,
  176. s->hdlcrx.numbits);
  177. }
  178. clear_bit(0, &s->hdlcrx.in_hdlc_rx);
  179. }
  180. /* ---------------------------------------------------------------------- */
  181. static inline void do_kiss_params(struct hdlcdrv_state *s,
  182. unsigned char *data, unsigned long len)
  183. {
  184. #ifdef KISS_VERBOSE
  185. #define PKP(a,b) printk(KERN_INFO "hdlcdrv.c: channel params: " a "\n", b)
  186. #else /* KISS_VERBOSE */
  187. #define PKP(a,b)
  188. #endif /* KISS_VERBOSE */
  189. if (len < 2)
  190. return;
  191. switch(data[0]) {
  192. case PARAM_TXDELAY:
  193. s->ch_params.tx_delay = data[1];
  194. PKP("TX delay = %ums", 10 * s->ch_params.tx_delay);
  195. break;
  196. case PARAM_PERSIST:
  197. s->ch_params.ppersist = data[1];
  198. PKP("p persistence = %u", s->ch_params.ppersist);
  199. break;
  200. case PARAM_SLOTTIME:
  201. s->ch_params.slottime = data[1];
  202. PKP("slot time = %ums", s->ch_params.slottime);
  203. break;
  204. case PARAM_TXTAIL:
  205. s->ch_params.tx_tail = data[1];
  206. PKP("TX tail = %ums", s->ch_params.tx_tail);
  207. break;
  208. case PARAM_FULLDUP:
  209. s->ch_params.fulldup = !!data[1];
  210. PKP("%s duplex", s->ch_params.fulldup ? "full" : "half");
  211. break;
  212. default:
  213. break;
  214. }
  215. #undef PKP
  216. }
  217. /* ---------------------------------------------------------------------- */
  218. void hdlcdrv_transmitter(struct net_device *dev, struct hdlcdrv_state *s)
  219. {
  220. unsigned int mask1, mask2, mask3;
  221. int i;
  222. struct sk_buff *skb;
  223. int pkt_len;
  224. if (!s || s->magic != HDLCDRV_MAGIC)
  225. return;
  226. if (test_and_set_bit(0, &s->hdlctx.in_hdlc_tx))
  227. return;
  228. for (;;) {
  229. if (s->hdlctx.numbits >= 16) {
  230. if (hdlcdrv_hbuf_full(&s->hdlctx.hbuf)) {
  231. clear_bit(0, &s->hdlctx.in_hdlc_tx);
  232. return;
  233. }
  234. hdlcdrv_hbuf_put(&s->hdlctx.hbuf, s->hdlctx.bitbuf);
  235. s->hdlctx.bitbuf >>= 16;
  236. s->hdlctx.numbits -= 16;
  237. }
  238. switch (s->hdlctx.tx_state) {
  239. default:
  240. clear_bit(0, &s->hdlctx.in_hdlc_tx);
  241. return;
  242. case 0:
  243. case 1:
  244. if (s->hdlctx.numflags) {
  245. s->hdlctx.numflags--;
  246. s->hdlctx.bitbuf |=
  247. 0x7e7e << s->hdlctx.numbits;
  248. s->hdlctx.numbits += 16;
  249. break;
  250. }
  251. if (s->hdlctx.tx_state == 1) {
  252. clear_bit(0, &s->hdlctx.in_hdlc_tx);
  253. return;
  254. }
  255. if (!(skb = s->skb)) {
  256. int flgs = tenms_to_2flags(s, s->ch_params.tx_tail);
  257. if (flgs < 2)
  258. flgs = 2;
  259. s->hdlctx.tx_state = 1;
  260. s->hdlctx.numflags = flgs;
  261. break;
  262. }
  263. s->skb = NULL;
  264. netif_wake_queue(dev);
  265. pkt_len = skb->len-1; /* strip KISS byte */
  266. if (pkt_len >= HDLCDRV_MAXFLEN || pkt_len < 2) {
  267. s->hdlctx.tx_state = 0;
  268. s->hdlctx.numflags = 1;
  269. dev_kfree_skb_irq(skb);
  270. break;
  271. }
  272. skb_copy_from_linear_data_offset(skb, 1,
  273. s->hdlctx.buffer,
  274. pkt_len);
  275. dev_kfree_skb_irq(skb);
  276. s->hdlctx.bp = s->hdlctx.buffer;
  277. append_crc_ccitt(s->hdlctx.buffer, pkt_len);
  278. s->hdlctx.len = pkt_len+2; /* the appended CRC */
  279. s->hdlctx.tx_state = 2;
  280. s->hdlctx.bitstream = 0;
  281. dev->stats.tx_packets++;
  282. break;
  283. case 2:
  284. if (!s->hdlctx.len) {
  285. s->hdlctx.tx_state = 0;
  286. s->hdlctx.numflags = 1;
  287. break;
  288. }
  289. s->hdlctx.len--;
  290. s->hdlctx.bitbuf |= *s->hdlctx.bp <<
  291. s->hdlctx.numbits;
  292. s->hdlctx.bitstream >>= 8;
  293. s->hdlctx.bitstream |= (*s->hdlctx.bp++) << 16;
  294. mask1 = 0x1f000;
  295. mask2 = 0x10000;
  296. mask3 = 0xffffffff >> (31-s->hdlctx.numbits);
  297. s->hdlctx.numbits += 8;
  298. for(i = 0; i < 8; i++, mask1 <<= 1, mask2 <<= 1,
  299. mask3 = (mask3 << 1) | 1) {
  300. if ((s->hdlctx.bitstream & mask1) != mask1)
  301. continue;
  302. s->hdlctx.bitstream &= ~mask2;
  303. s->hdlctx.bitbuf =
  304. (s->hdlctx.bitbuf & mask3) |
  305. ((s->hdlctx.bitbuf &
  306. (~mask3)) << 1);
  307. s->hdlctx.numbits++;
  308. mask3 = (mask3 << 1) | 1;
  309. }
  310. break;
  311. }
  312. }
  313. }
  314. /* ---------------------------------------------------------------------- */
  315. static void start_tx(struct net_device *dev, struct hdlcdrv_state *s)
  316. {
  317. s->hdlctx.tx_state = 0;
  318. s->hdlctx.numflags = tenms_to_2flags(s, s->ch_params.tx_delay);
  319. s->hdlctx.bitbuf = s->hdlctx.bitstream = s->hdlctx.numbits = 0;
  320. hdlcdrv_transmitter(dev, s);
  321. s->hdlctx.ptt = 1;
  322. s->ptt_keyed++;
  323. }
  324. /* ---------------------------------------------------------------------- */
  325. void hdlcdrv_arbitrate(struct net_device *dev, struct hdlcdrv_state *s)
  326. {
  327. if (!s || s->magic != HDLCDRV_MAGIC || s->hdlctx.ptt || !s->skb)
  328. return;
  329. if (s->ch_params.fulldup) {
  330. start_tx(dev, s);
  331. return;
  332. }
  333. if (s->hdlcrx.dcd) {
  334. s->hdlctx.slotcnt = s->ch_params.slottime;
  335. return;
  336. }
  337. if ((--s->hdlctx.slotcnt) > 0)
  338. return;
  339. s->hdlctx.slotcnt = s->ch_params.slottime;
  340. if (get_random_u8() > s->ch_params.ppersist)
  341. return;
  342. start_tx(dev, s);
  343. }
  344. /* --------------------------------------------------------------------- */
  345. /*
  346. * ===================== network driver interface =========================
  347. */
  348. static netdev_tx_t hdlcdrv_send_packet(struct sk_buff *skb,
  349. struct net_device *dev)
  350. {
  351. struct hdlcdrv_state *sm = netdev_priv(dev);
  352. if (skb->protocol == htons(ETH_P_IP))
  353. return ax25_ip_xmit(skb);
  354. if (skb->data[0] != 0) {
  355. do_kiss_params(sm, skb->data, skb->len);
  356. dev_kfree_skb(skb);
  357. return NETDEV_TX_OK;
  358. }
  359. if (sm->skb) {
  360. dev_kfree_skb(skb);
  361. return NETDEV_TX_OK;
  362. }
  363. netif_stop_queue(dev);
  364. sm->skb = skb;
  365. return NETDEV_TX_OK;
  366. }
  367. /* --------------------------------------------------------------------- */
  368. static int hdlcdrv_set_mac_address(struct net_device *dev, void *addr)
  369. {
  370. struct sockaddr *sa = (struct sockaddr *)addr;
  371. /* addr is an AX.25 shifted ASCII mac address */
  372. dev_addr_set(dev, sa->sa_data);
  373. return 0;
  374. }
  375. /* --------------------------------------------------------------------- */
  376. /*
  377. * Open/initialize the board. This is called (in the current kernel)
  378. * sometime after booting when the 'ifconfig' program is run.
  379. *
  380. * This routine should set everything up anew at each open, even
  381. * registers that "should" only need to be set once at boot, so that
  382. * there is non-reboot way to recover if something goes wrong.
  383. */
  384. static int hdlcdrv_open(struct net_device *dev)
  385. {
  386. struct hdlcdrv_state *s = netdev_priv(dev);
  387. int i;
  388. if (!s->ops || !s->ops->open)
  389. return -ENODEV;
  390. /*
  391. * initialise some variables
  392. */
  393. s->opened = 1;
  394. s->hdlcrx.hbuf.rd = s->hdlcrx.hbuf.wr = 0;
  395. s->hdlcrx.in_hdlc_rx = 0;
  396. s->hdlcrx.rx_state = 0;
  397. s->hdlctx.hbuf.rd = s->hdlctx.hbuf.wr = 0;
  398. s->hdlctx.in_hdlc_tx = 0;
  399. s->hdlctx.tx_state = 1;
  400. s->hdlctx.numflags = 0;
  401. s->hdlctx.bitstream = s->hdlctx.bitbuf = s->hdlctx.numbits = 0;
  402. s->hdlctx.ptt = 0;
  403. s->hdlctx.slotcnt = s->ch_params.slottime;
  404. s->hdlctx.calibrate = 0;
  405. i = s->ops->open(dev);
  406. if (i)
  407. return i;
  408. netif_start_queue(dev);
  409. return 0;
  410. }
  411. /* --------------------------------------------------------------------- */
  412. /*
  413. * The inverse routine to hdlcdrv_open().
  414. */
  415. static int hdlcdrv_close(struct net_device *dev)
  416. {
  417. struct hdlcdrv_state *s = netdev_priv(dev);
  418. int i = 0;
  419. netif_stop_queue(dev);
  420. if (s->ops && s->ops->close)
  421. i = s->ops->close(dev);
  422. dev_kfree_skb(s->skb);
  423. s->skb = NULL;
  424. s->opened = 0;
  425. return i;
  426. }
  427. /* --------------------------------------------------------------------- */
  428. static int hdlcdrv_siocdevprivate(struct net_device *dev, struct ifreq *ifr,
  429. void __user *data, int cmd)
  430. {
  431. struct hdlcdrv_state *s = netdev_priv(dev);
  432. struct hdlcdrv_ioctl bi;
  433. if (cmd != SIOCDEVPRIVATE)
  434. return -ENOIOCTLCMD;
  435. if (in_compat_syscall()) /* to be implemented */
  436. return -ENOIOCTLCMD;
  437. if (copy_from_user(&bi, data, sizeof(bi)))
  438. return -EFAULT;
  439. switch (bi.cmd) {
  440. default:
  441. if (s->ops && s->ops->ioctl)
  442. return s->ops->ioctl(dev, data, &bi, cmd);
  443. return -ENOIOCTLCMD;
  444. case HDLCDRVCTL_GETCHANNELPAR:
  445. bi.data.cp.tx_delay = s->ch_params.tx_delay;
  446. bi.data.cp.tx_tail = s->ch_params.tx_tail;
  447. bi.data.cp.slottime = s->ch_params.slottime;
  448. bi.data.cp.ppersist = s->ch_params.ppersist;
  449. bi.data.cp.fulldup = s->ch_params.fulldup;
  450. break;
  451. case HDLCDRVCTL_SETCHANNELPAR:
  452. if (!capable(CAP_NET_ADMIN))
  453. return -EACCES;
  454. s->ch_params.tx_delay = bi.data.cp.tx_delay;
  455. s->ch_params.tx_tail = bi.data.cp.tx_tail;
  456. s->ch_params.slottime = bi.data.cp.slottime;
  457. s->ch_params.ppersist = bi.data.cp.ppersist;
  458. s->ch_params.fulldup = bi.data.cp.fulldup;
  459. s->hdlctx.slotcnt = 1;
  460. return 0;
  461. case HDLCDRVCTL_GETMODEMPAR:
  462. bi.data.mp.iobase = dev->base_addr;
  463. bi.data.mp.irq = dev->irq;
  464. bi.data.mp.dma = dev->dma;
  465. bi.data.mp.dma2 = s->ptt_out.dma2;
  466. bi.data.mp.seriobase = s->ptt_out.seriobase;
  467. bi.data.mp.pariobase = s->ptt_out.pariobase;
  468. bi.data.mp.midiiobase = s->ptt_out.midiiobase;
  469. break;
  470. case HDLCDRVCTL_SETMODEMPAR:
  471. if ((!capable(CAP_SYS_RAWIO)) || netif_running(dev))
  472. return -EACCES;
  473. dev->base_addr = bi.data.mp.iobase;
  474. dev->irq = bi.data.mp.irq;
  475. dev->dma = bi.data.mp.dma;
  476. s->ptt_out.dma2 = bi.data.mp.dma2;
  477. s->ptt_out.seriobase = bi.data.mp.seriobase;
  478. s->ptt_out.pariobase = bi.data.mp.pariobase;
  479. s->ptt_out.midiiobase = bi.data.mp.midiiobase;
  480. return 0;
  481. case HDLCDRVCTL_GETSTAT:
  482. bi.data.cs.ptt = hdlcdrv_ptt(s);
  483. bi.data.cs.dcd = s->hdlcrx.dcd;
  484. bi.data.cs.ptt_keyed = s->ptt_keyed;
  485. bi.data.cs.tx_packets = dev->stats.tx_packets;
  486. bi.data.cs.tx_errors = dev->stats.tx_errors;
  487. bi.data.cs.rx_packets = dev->stats.rx_packets;
  488. bi.data.cs.rx_errors = dev->stats.rx_errors;
  489. break;
  490. case HDLCDRVCTL_OLDGETSTAT:
  491. bi.data.ocs.ptt = hdlcdrv_ptt(s);
  492. bi.data.ocs.dcd = s->hdlcrx.dcd;
  493. bi.data.ocs.ptt_keyed = s->ptt_keyed;
  494. break;
  495. case HDLCDRVCTL_CALIBRATE:
  496. if(!capable(CAP_SYS_RAWIO))
  497. return -EPERM;
  498. if (s->par.bitrate <= 0)
  499. return -EINVAL;
  500. if (bi.data.calibrate > INT_MAX / s->par.bitrate)
  501. return -EINVAL;
  502. s->hdlctx.calibrate = bi.data.calibrate * s->par.bitrate / 16;
  503. return 0;
  504. case HDLCDRVCTL_GETSAMPLES:
  505. #ifndef HDLCDRV_DEBUG
  506. return -EPERM;
  507. #else /* HDLCDRV_DEBUG */
  508. if (s->bitbuf_channel.rd == s->bitbuf_channel.wr)
  509. return -EAGAIN;
  510. bi.data.bits =
  511. s->bitbuf_channel.buffer[s->bitbuf_channel.rd];
  512. s->bitbuf_channel.rd = (s->bitbuf_channel.rd+1) %
  513. sizeof(s->bitbuf_channel.buffer);
  514. break;
  515. #endif /* HDLCDRV_DEBUG */
  516. case HDLCDRVCTL_GETBITS:
  517. #ifndef HDLCDRV_DEBUG
  518. return -EPERM;
  519. #else /* HDLCDRV_DEBUG */
  520. if (s->bitbuf_hdlc.rd == s->bitbuf_hdlc.wr)
  521. return -EAGAIN;
  522. bi.data.bits =
  523. s->bitbuf_hdlc.buffer[s->bitbuf_hdlc.rd];
  524. s->bitbuf_hdlc.rd = (s->bitbuf_hdlc.rd+1) %
  525. sizeof(s->bitbuf_hdlc.buffer);
  526. break;
  527. #endif /* HDLCDRV_DEBUG */
  528. case HDLCDRVCTL_DRIVERNAME:
  529. if (s->ops && s->ops->drvname) {
  530. strscpy(bi.data.drivername, s->ops->drvname,
  531. sizeof(bi.data.drivername));
  532. break;
  533. }
  534. bi.data.drivername[0] = '\0';
  535. break;
  536. }
  537. if (copy_to_user(data, &bi, sizeof(bi)))
  538. return -EFAULT;
  539. return 0;
  540. }
  541. /* --------------------------------------------------------------------- */
  542. static const struct net_device_ops hdlcdrv_netdev = {
  543. .ndo_open = hdlcdrv_open,
  544. .ndo_stop = hdlcdrv_close,
  545. .ndo_start_xmit = hdlcdrv_send_packet,
  546. .ndo_siocdevprivate = hdlcdrv_siocdevprivate,
  547. .ndo_set_mac_address = hdlcdrv_set_mac_address,
  548. };
  549. /*
  550. * Initialize fields in hdlcdrv
  551. */
  552. static void hdlcdrv_setup(struct net_device *dev)
  553. {
  554. static const struct hdlcdrv_channel_params dflt_ch_params = {
  555. 20, 2, 10, 40, 0
  556. };
  557. struct hdlcdrv_state *s = netdev_priv(dev);
  558. /*
  559. * initialize the hdlcdrv_state struct
  560. */
  561. s->ch_params = dflt_ch_params;
  562. s->ptt_keyed = 0;
  563. spin_lock_init(&s->hdlcrx.hbuf.lock);
  564. s->hdlcrx.hbuf.rd = s->hdlcrx.hbuf.wr = 0;
  565. s->hdlcrx.in_hdlc_rx = 0;
  566. s->hdlcrx.rx_state = 0;
  567. spin_lock_init(&s->hdlctx.hbuf.lock);
  568. s->hdlctx.hbuf.rd = s->hdlctx.hbuf.wr = 0;
  569. s->hdlctx.in_hdlc_tx = 0;
  570. s->hdlctx.tx_state = 1;
  571. s->hdlctx.numflags = 0;
  572. s->hdlctx.bitstream = s->hdlctx.bitbuf = s->hdlctx.numbits = 0;
  573. s->hdlctx.ptt = 0;
  574. s->hdlctx.slotcnt = s->ch_params.slottime;
  575. s->hdlctx.calibrate = 0;
  576. #ifdef HDLCDRV_DEBUG
  577. s->bitbuf_channel.rd = s->bitbuf_channel.wr = 0;
  578. s->bitbuf_channel.shreg = 0x80;
  579. s->bitbuf_hdlc.rd = s->bitbuf_hdlc.wr = 0;
  580. s->bitbuf_hdlc.shreg = 0x80;
  581. #endif /* HDLCDRV_DEBUG */
  582. /* Fill in the fields of the device structure */
  583. s->skb = NULL;
  584. dev->netdev_ops = &hdlcdrv_netdev;
  585. dev->header_ops = &ax25_header_ops;
  586. dev->type = ARPHRD_AX25; /* AF_AX25 device */
  587. dev->hard_header_len = AX25_MAX_HEADER_LEN + AX25_BPQ_HEADER_LEN;
  588. dev->mtu = AX25_DEF_PACLEN; /* eth_mtu is the default */
  589. dev->addr_len = AX25_ADDR_LEN; /* sizeof an ax.25 address */
  590. memcpy(dev->broadcast, &ax25_bcast, AX25_ADDR_LEN);
  591. dev_addr_set(dev, (u8 *)&ax25_defaddr);
  592. dev->tx_queue_len = 16;
  593. }
  594. /* --------------------------------------------------------------------- */
  595. struct net_device *hdlcdrv_register(const struct hdlcdrv_ops *ops,
  596. unsigned int privsize, const char *ifname,
  597. unsigned int baseaddr, unsigned int irq,
  598. unsigned int dma)
  599. {
  600. struct net_device *dev;
  601. struct hdlcdrv_state *s;
  602. int err;
  603. if (privsize < sizeof(struct hdlcdrv_state))
  604. privsize = sizeof(struct hdlcdrv_state);
  605. dev = alloc_netdev(privsize, ifname, NET_NAME_UNKNOWN, hdlcdrv_setup);
  606. if (!dev)
  607. return ERR_PTR(-ENOMEM);
  608. /*
  609. * initialize part of the hdlcdrv_state struct
  610. */
  611. s = netdev_priv(dev);
  612. s->magic = HDLCDRV_MAGIC;
  613. s->ops = ops;
  614. dev->base_addr = baseaddr;
  615. dev->irq = irq;
  616. dev->dma = dma;
  617. err = register_netdev(dev);
  618. if (err < 0) {
  619. printk(KERN_WARNING "hdlcdrv: cannot register net "
  620. "device %s\n", dev->name);
  621. free_netdev(dev);
  622. dev = ERR_PTR(err);
  623. }
  624. return dev;
  625. }
  626. /* --------------------------------------------------------------------- */
  627. void hdlcdrv_unregister(struct net_device *dev)
  628. {
  629. struct hdlcdrv_state *s = netdev_priv(dev);
  630. BUG_ON(s->magic != HDLCDRV_MAGIC);
  631. if (s->opened && s->ops->close)
  632. s->ops->close(dev);
  633. unregister_netdev(dev);
  634. free_netdev(dev);
  635. }
  636. /* --------------------------------------------------------------------- */
  637. EXPORT_SYMBOL(hdlcdrv_receiver);
  638. EXPORT_SYMBOL(hdlcdrv_transmitter);
  639. EXPORT_SYMBOL(hdlcdrv_arbitrate);
  640. EXPORT_SYMBOL(hdlcdrv_register);
  641. EXPORT_SYMBOL(hdlcdrv_unregister);
  642. /* --------------------------------------------------------------------- */
  643. static int __init hdlcdrv_init_driver(void)
  644. {
  645. printk(KERN_INFO "hdlcdrv: (C) 1996-2000 Thomas Sailer HB9JNX/AE4WA\n");
  646. printk(KERN_INFO "hdlcdrv: version 0.8\n");
  647. return 0;
  648. }
  649. /* --------------------------------------------------------------------- */
  650. static void __exit hdlcdrv_cleanup_driver(void)
  651. {
  652. printk(KERN_INFO "hdlcdrv: cleanup\n");
  653. }
  654. /* --------------------------------------------------------------------- */
  655. MODULE_AUTHOR("Thomas M. Sailer, [email protected], [email protected]");
  656. MODULE_DESCRIPTION("Packet Radio network interface HDLC encoder/decoder");
  657. MODULE_LICENSE("GPL");
  658. module_init(hdlcdrv_init_driver);
  659. module_exit(hdlcdrv_cleanup_driver);
  660. /* --------------------------------------------------------------------- */