netjet.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164
  1. /*
  2. * NETJet mISDN driver
  3. *
  4. * Author Karsten Keil <keil@isdn4linux.de>
  5. *
  6. * Copyright 2009 by Karsten Keil <keil@isdn4linux.de>
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License version 2 as
  10. * published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20. *
  21. */
  22. #include <linux/interrupt.h>
  23. #include <linux/module.h>
  24. #include <linux/pci.h>
  25. #include <linux/delay.h>
  26. #include <linux/mISDNhw.h>
  27. #include <linux/slab.h>
  28. #include "ipac.h"
  29. #include "iohelper.h"
  30. #include "netjet.h"
  31. #include <linux/isdn/hdlc.h>
  32. #define NETJET_REV "2.0"
  33. enum nj_types {
  34. NETJET_S_TJ300,
  35. NETJET_S_TJ320,
  36. ENTERNOW__TJ320,
  37. };
  38. struct tiger_dma {
  39. size_t size;
  40. u32 *start;
  41. int idx;
  42. u32 dmastart;
  43. u32 dmairq;
  44. u32 dmaend;
  45. u32 dmacur;
  46. };
  47. struct tiger_hw;
  48. struct tiger_ch {
  49. struct bchannel bch;
  50. struct tiger_hw *nj;
  51. int idx;
  52. int free;
  53. int lastrx;
  54. u16 rxstate;
  55. u16 txstate;
  56. struct isdnhdlc_vars hsend;
  57. struct isdnhdlc_vars hrecv;
  58. u8 *hsbuf;
  59. u8 *hrbuf;
  60. };
  61. #define TX_INIT 0x0001
  62. #define TX_IDLE 0x0002
  63. #define TX_RUN 0x0004
  64. #define TX_UNDERRUN 0x0100
  65. #define RX_OVERRUN 0x0100
  66. #define LOG_SIZE 64
  67. struct tiger_hw {
  68. struct list_head list;
  69. struct pci_dev *pdev;
  70. char name[MISDN_MAX_IDLEN];
  71. enum nj_types typ;
  72. int irq;
  73. u32 irqcnt;
  74. u32 base;
  75. size_t base_s;
  76. dma_addr_t dma;
  77. void *dma_p;
  78. spinlock_t lock; /* lock HW */
  79. struct isac_hw isac;
  80. struct tiger_dma send;
  81. struct tiger_dma recv;
  82. struct tiger_ch bc[2];
  83. u8 ctrlreg;
  84. u8 dmactrl;
  85. u8 auxd;
  86. u8 last_is0;
  87. u8 irqmask0;
  88. char log[LOG_SIZE];
  89. };
  90. static LIST_HEAD(Cards);
  91. static DEFINE_RWLOCK(card_lock); /* protect Cards */
  92. static u32 debug;
  93. static int nj_cnt;
  94. static void
  95. _set_debug(struct tiger_hw *card)
  96. {
  97. card->isac.dch.debug = debug;
  98. card->bc[0].bch.debug = debug;
  99. card->bc[1].bch.debug = debug;
  100. }
  101. static int
  102. set_debug(const char *val, struct kernel_param *kp)
  103. {
  104. int ret;
  105. struct tiger_hw *card;
  106. ret = param_set_uint(val, kp);
  107. if (!ret) {
  108. read_lock(&card_lock);
  109. list_for_each_entry(card, &Cards, list)
  110. _set_debug(card);
  111. read_unlock(&card_lock);
  112. }
  113. return ret;
  114. }
  115. MODULE_AUTHOR("Karsten Keil");
  116. MODULE_LICENSE("GPL v2");
  117. MODULE_VERSION(NETJET_REV);
  118. module_param_call(debug, set_debug, param_get_uint, &debug, S_IRUGO | S_IWUSR);
  119. MODULE_PARM_DESC(debug, "Netjet debug mask");
  120. static void
  121. nj_disable_hwirq(struct tiger_hw *card)
  122. {
  123. outb(0, card->base + NJ_IRQMASK0);
  124. outb(0, card->base + NJ_IRQMASK1);
  125. }
  126. static u8
  127. ReadISAC_nj(void *p, u8 offset)
  128. {
  129. struct tiger_hw *card = p;
  130. u8 ret;
  131. card->auxd &= 0xfc;
  132. card->auxd |= (offset >> 4) & 3;
  133. outb(card->auxd, card->base + NJ_AUXDATA);
  134. ret = inb(card->base + NJ_ISAC_OFF + ((offset & 0x0f) << 2));
  135. return ret;
  136. }
  137. static void
  138. WriteISAC_nj(void *p, u8 offset, u8 value)
  139. {
  140. struct tiger_hw *card = p;
  141. card->auxd &= 0xfc;
  142. card->auxd |= (offset >> 4) & 3;
  143. outb(card->auxd, card->base + NJ_AUXDATA);
  144. outb(value, card->base + NJ_ISAC_OFF + ((offset & 0x0f) << 2));
  145. }
  146. static void
  147. ReadFiFoISAC_nj(void *p, u8 offset, u8 *data, int size)
  148. {
  149. struct tiger_hw *card = p;
  150. card->auxd &= 0xfc;
  151. outb(card->auxd, card->base + NJ_AUXDATA);
  152. insb(card->base + NJ_ISAC_OFF, data, size);
  153. }
  154. static void
  155. WriteFiFoISAC_nj(void *p, u8 offset, u8 *data, int size)
  156. {
  157. struct tiger_hw *card = p;
  158. card->auxd &= 0xfc;
  159. outb(card->auxd, card->base + NJ_AUXDATA);
  160. outsb(card->base + NJ_ISAC_OFF, data, size);
  161. }
  162. static void
  163. fill_mem(struct tiger_ch *bc, u32 idx, u32 cnt, u32 fill)
  164. {
  165. struct tiger_hw *card = bc->bch.hw;
  166. u32 mask = 0xff, val;
  167. pr_debug("%s: B%1d fill %02x len %d idx %d/%d\n", card->name,
  168. bc->bch.nr, fill, cnt, idx, card->send.idx);
  169. if (bc->bch.nr & 2) {
  170. fill <<= 8;
  171. mask <<= 8;
  172. }
  173. mask ^= 0xffffffff;
  174. while (cnt--) {
  175. val = card->send.start[idx];
  176. val &= mask;
  177. val |= fill;
  178. card->send.start[idx++] = val;
  179. if (idx >= card->send.size)
  180. idx = 0;
  181. }
  182. }
  183. static int
  184. mode_tiger(struct tiger_ch *bc, u32 protocol)
  185. {
  186. struct tiger_hw *card = bc->bch.hw;
  187. pr_debug("%s: B%1d protocol %x-->%x\n", card->name,
  188. bc->bch.nr, bc->bch.state, protocol);
  189. switch (protocol) {
  190. case ISDN_P_NONE:
  191. if (bc->bch.state == ISDN_P_NONE)
  192. break;
  193. fill_mem(bc, 0, card->send.size, 0xff);
  194. bc->bch.state = protocol;
  195. /* only stop dma and interrupts if both channels NULL */
  196. if ((card->bc[0].bch.state == ISDN_P_NONE) &&
  197. (card->bc[1].bch.state == ISDN_P_NONE)) {
  198. card->dmactrl = 0;
  199. outb(card->dmactrl, card->base + NJ_DMACTRL);
  200. outb(0, card->base + NJ_IRQMASK0);
  201. }
  202. test_and_clear_bit(FLG_HDLC, &bc->bch.Flags);
  203. test_and_clear_bit(FLG_TRANSPARENT, &bc->bch.Flags);
  204. bc->txstate = 0;
  205. bc->rxstate = 0;
  206. bc->lastrx = -1;
  207. break;
  208. case ISDN_P_B_RAW:
  209. test_and_set_bit(FLG_TRANSPARENT, &bc->bch.Flags);
  210. bc->bch.state = protocol;
  211. bc->idx = 0;
  212. bc->free = card->send.size / 2;
  213. bc->rxstate = 0;
  214. bc->txstate = TX_INIT | TX_IDLE;
  215. bc->lastrx = -1;
  216. if (!card->dmactrl) {
  217. card->dmactrl = 1;
  218. outb(card->dmactrl, card->base + NJ_DMACTRL);
  219. outb(0x0f, card->base + NJ_IRQMASK0);
  220. }
  221. break;
  222. case ISDN_P_B_HDLC:
  223. test_and_set_bit(FLG_HDLC, &bc->bch.Flags);
  224. bc->bch.state = protocol;
  225. bc->idx = 0;
  226. bc->free = card->send.size / 2;
  227. bc->rxstate = 0;
  228. bc->txstate = TX_INIT | TX_IDLE;
  229. isdnhdlc_rcv_init(&bc->hrecv, 0);
  230. isdnhdlc_out_init(&bc->hsend, 0);
  231. bc->lastrx = -1;
  232. if (!card->dmactrl) {
  233. card->dmactrl = 1;
  234. outb(card->dmactrl, card->base + NJ_DMACTRL);
  235. outb(0x0f, card->base + NJ_IRQMASK0);
  236. }
  237. break;
  238. default:
  239. pr_info("%s: %s protocol %x not handled\n", card->name,
  240. __func__, protocol);
  241. return -ENOPROTOOPT;
  242. }
  243. card->send.dmacur = inl(card->base + NJ_DMA_READ_ADR);
  244. card->recv.dmacur = inl(card->base + NJ_DMA_WRITE_ADR);
  245. card->send.idx = (card->send.dmacur - card->send.dmastart) >> 2;
  246. card->recv.idx = (card->recv.dmacur - card->recv.dmastart) >> 2;
  247. pr_debug("%s: %s ctrl %x irq %02x/%02x idx %d/%d\n",
  248. card->name, __func__,
  249. inb(card->base + NJ_DMACTRL),
  250. inb(card->base + NJ_IRQMASK0),
  251. inb(card->base + NJ_IRQSTAT0),
  252. card->send.idx,
  253. card->recv.idx);
  254. return 0;
  255. }
  256. static void
  257. nj_reset(struct tiger_hw *card)
  258. {
  259. outb(0xff, card->base + NJ_CTRL); /* Reset On */
  260. mdelay(1);
  261. /* now edge triggered for TJ320 GE 13/07/00 */
  262. /* see comment in IRQ function */
  263. if (card->typ == NETJET_S_TJ320) /* TJ320 */
  264. card->ctrlreg = 0x40; /* Reset Off and status read clear */
  265. else
  266. card->ctrlreg = 0x00; /* Reset Off and status read clear */
  267. outb(card->ctrlreg, card->base + NJ_CTRL);
  268. mdelay(10);
  269. /* configure AUX pins (all output except ISAC IRQ pin) */
  270. card->auxd = 0;
  271. card->dmactrl = 0;
  272. outb(~NJ_ISACIRQ, card->base + NJ_AUXCTRL);
  273. outb(NJ_ISACIRQ, card->base + NJ_IRQMASK1);
  274. outb(card->auxd, card->base + NJ_AUXDATA);
  275. }
  276. static int
  277. inittiger(struct tiger_hw *card)
  278. {
  279. int i;
  280. card->dma_p = pci_alloc_consistent(card->pdev, NJ_DMA_SIZE,
  281. &card->dma);
  282. if (!card->dma_p) {
  283. pr_info("%s: No DMA memory\n", card->name);
  284. return -ENOMEM;
  285. }
  286. if ((u64)card->dma > 0xffffffff) {
  287. pr_info("%s: DMA outside 32 bit\n", card->name);
  288. return -ENOMEM;
  289. }
  290. for (i = 0; i < 2; i++) {
  291. card->bc[i].hsbuf = kmalloc(NJ_DMA_TXSIZE, GFP_ATOMIC);
  292. if (!card->bc[i].hsbuf) {
  293. pr_info("%s: no B%d send buffer\n", card->name, i + 1);
  294. return -ENOMEM;
  295. }
  296. card->bc[i].hrbuf = kmalloc(NJ_DMA_RXSIZE, GFP_ATOMIC);
  297. if (!card->bc[i].hrbuf) {
  298. pr_info("%s: no B%d recv buffer\n", card->name, i + 1);
  299. return -ENOMEM;
  300. }
  301. }
  302. memset(card->dma_p, 0xff, NJ_DMA_SIZE);
  303. card->send.start = card->dma_p;
  304. card->send.dmastart = (u32)card->dma;
  305. card->send.dmaend = card->send.dmastart +
  306. (4 * (NJ_DMA_TXSIZE - 1));
  307. card->send.dmairq = card->send.dmastart +
  308. (4 * ((NJ_DMA_TXSIZE / 2) - 1));
  309. card->send.size = NJ_DMA_TXSIZE;
  310. if (debug & DEBUG_HW)
  311. pr_notice("%s: send buffer phy %#x - %#x - %#x virt %p"
  312. " size %zu u32\n", card->name,
  313. card->send.dmastart, card->send.dmairq,
  314. card->send.dmaend, card->send.start, card->send.size);
  315. outl(card->send.dmastart, card->base + NJ_DMA_READ_START);
  316. outl(card->send.dmairq, card->base + NJ_DMA_READ_IRQ);
  317. outl(card->send.dmaend, card->base + NJ_DMA_READ_END);
  318. card->recv.start = card->dma_p + (NJ_DMA_SIZE / 2);
  319. card->recv.dmastart = (u32)card->dma + (NJ_DMA_SIZE / 2);
  320. card->recv.dmaend = card->recv.dmastart +
  321. (4 * (NJ_DMA_RXSIZE - 1));
  322. card->recv.dmairq = card->recv.dmastart +
  323. (4 * ((NJ_DMA_RXSIZE / 2) - 1));
  324. card->recv.size = NJ_DMA_RXSIZE;
  325. if (debug & DEBUG_HW)
  326. pr_notice("%s: recv buffer phy %#x - %#x - %#x virt %p"
  327. " size %zu u32\n", card->name,
  328. card->recv.dmastart, card->recv.dmairq,
  329. card->recv.dmaend, card->recv.start, card->recv.size);
  330. outl(card->recv.dmastart, card->base + NJ_DMA_WRITE_START);
  331. outl(card->recv.dmairq, card->base + NJ_DMA_WRITE_IRQ);
  332. outl(card->recv.dmaend, card->base + NJ_DMA_WRITE_END);
  333. return 0;
  334. }
  335. static void
  336. read_dma(struct tiger_ch *bc, u32 idx, int cnt)
  337. {
  338. struct tiger_hw *card = bc->bch.hw;
  339. int i, stat;
  340. u32 val;
  341. u8 *p, *pn;
  342. if (bc->lastrx == idx) {
  343. bc->rxstate |= RX_OVERRUN;
  344. pr_info("%s: B%1d overrun at idx %d\n", card->name,
  345. bc->bch.nr, idx);
  346. }
  347. bc->lastrx = idx;
  348. stat = bchannel_get_rxbuf(&bc->bch, cnt);
  349. /* only transparent use the count here, HDLC overun is detected later */
  350. if (stat == ENOMEM) {
  351. pr_warning("%s.B%d: No memory for %d bytes\n",
  352. card->name, bc->bch.nr, cnt);
  353. return;
  354. }
  355. if (test_bit(FLG_TRANSPARENT, &bc->bch.Flags))
  356. p = skb_put(bc->bch.rx_skb, cnt);
  357. else
  358. p = bc->hrbuf;
  359. for (i = 0; i < cnt; i++) {
  360. val = card->recv.start[idx++];
  361. if (bc->bch.nr & 2)
  362. val >>= 8;
  363. if (idx >= card->recv.size)
  364. idx = 0;
  365. p[i] = val & 0xff;
  366. }
  367. if (test_bit(FLG_TRANSPARENT, &bc->bch.Flags)) {
  368. recv_Bchannel(&bc->bch, 0, false);
  369. return;
  370. }
  371. pn = bc->hrbuf;
  372. while (cnt > 0) {
  373. stat = isdnhdlc_decode(&bc->hrecv, pn, cnt, &i,
  374. bc->bch.rx_skb->data, bc->bch.maxlen);
  375. if (stat > 0) { /* valid frame received */
  376. p = skb_put(bc->bch.rx_skb, stat);
  377. if (debug & DEBUG_HW_BFIFO) {
  378. snprintf(card->log, LOG_SIZE,
  379. "B%1d-recv %s %d ", bc->bch.nr,
  380. card->name, stat);
  381. print_hex_dump_bytes(card->log,
  382. DUMP_PREFIX_OFFSET, p,
  383. stat);
  384. }
  385. recv_Bchannel(&bc->bch, 0, false);
  386. stat = bchannel_get_rxbuf(&bc->bch, bc->bch.maxlen);
  387. if (stat < 0) {
  388. pr_warning("%s.B%d: No memory for %d bytes\n",
  389. card->name, bc->bch.nr, cnt);
  390. return;
  391. }
  392. } else if (stat == -HDLC_CRC_ERROR) {
  393. pr_info("%s: B%1d receive frame CRC error\n",
  394. card->name, bc->bch.nr);
  395. } else if (stat == -HDLC_FRAMING_ERROR) {
  396. pr_info("%s: B%1d receive framing error\n",
  397. card->name, bc->bch.nr);
  398. } else if (stat == -HDLC_LENGTH_ERROR) {
  399. pr_info("%s: B%1d receive frame too long (> %d)\n",
  400. card->name, bc->bch.nr, bc->bch.maxlen);
  401. }
  402. pn += i;
  403. cnt -= i;
  404. }
  405. }
  406. static void
  407. recv_tiger(struct tiger_hw *card, u8 irq_stat)
  408. {
  409. u32 idx;
  410. int cnt = card->recv.size / 2;
  411. /* Note receive is via the WRITE DMA channel */
  412. card->last_is0 &= ~NJ_IRQM0_WR_MASK;
  413. card->last_is0 |= (irq_stat & NJ_IRQM0_WR_MASK);
  414. if (irq_stat & NJ_IRQM0_WR_END)
  415. idx = cnt - 1;
  416. else
  417. idx = card->recv.size - 1;
  418. if (test_bit(FLG_ACTIVE, &card->bc[0].bch.Flags))
  419. read_dma(&card->bc[0], idx, cnt);
  420. if (test_bit(FLG_ACTIVE, &card->bc[1].bch.Flags))
  421. read_dma(&card->bc[1], idx, cnt);
  422. }
  423. /* sync with current DMA address at start or after exception */
  424. static void
  425. resync(struct tiger_ch *bc, struct tiger_hw *card)
  426. {
  427. card->send.dmacur = inl(card->base | NJ_DMA_READ_ADR);
  428. card->send.idx = (card->send.dmacur - card->send.dmastart) >> 2;
  429. if (bc->free > card->send.size / 2)
  430. bc->free = card->send.size / 2;
  431. /* currently we simple sync to the next complete free area
  432. * this hast the advantage that we have always maximum time to
  433. * handle TX irq
  434. */
  435. if (card->send.idx < ((card->send.size / 2) - 1))
  436. bc->idx = (card->recv.size / 2) - 1;
  437. else
  438. bc->idx = card->recv.size - 1;
  439. bc->txstate = TX_RUN;
  440. pr_debug("%s: %s B%1d free %d idx %d/%d\n", card->name,
  441. __func__, bc->bch.nr, bc->free, bc->idx, card->send.idx);
  442. }
  443. static int bc_next_frame(struct tiger_ch *);
  444. static void
  445. fill_hdlc_flag(struct tiger_ch *bc)
  446. {
  447. struct tiger_hw *card = bc->bch.hw;
  448. int count, i;
  449. u32 m, v;
  450. u8 *p;
  451. if (bc->free == 0)
  452. return;
  453. pr_debug("%s: %s B%1d %d state %x idx %d/%d\n", card->name,
  454. __func__, bc->bch.nr, bc->free, bc->txstate,
  455. bc->idx, card->send.idx);
  456. if (bc->txstate & (TX_IDLE | TX_INIT | TX_UNDERRUN))
  457. resync(bc, card);
  458. count = isdnhdlc_encode(&bc->hsend, NULL, 0, &i,
  459. bc->hsbuf, bc->free);
  460. pr_debug("%s: B%1d hdlc encoded %d flags\n", card->name,
  461. bc->bch.nr, count);
  462. bc->free -= count;
  463. p = bc->hsbuf;
  464. m = (bc->bch.nr & 1) ? 0xffffff00 : 0xffff00ff;
  465. for (i = 0; i < count; i++) {
  466. if (bc->idx >= card->send.size)
  467. bc->idx = 0;
  468. v = card->send.start[bc->idx];
  469. v &= m;
  470. v |= (bc->bch.nr & 1) ? (u32)(p[i]) : ((u32)(p[i])) << 8;
  471. card->send.start[bc->idx++] = v;
  472. }
  473. if (debug & DEBUG_HW_BFIFO) {
  474. snprintf(card->log, LOG_SIZE, "B%1d-send %s %d ",
  475. bc->bch.nr, card->name, count);
  476. print_hex_dump_bytes(card->log, DUMP_PREFIX_OFFSET, p, count);
  477. }
  478. }
  479. static void
  480. fill_dma(struct tiger_ch *bc)
  481. {
  482. struct tiger_hw *card = bc->bch.hw;
  483. int count, i, fillempty = 0;
  484. u32 m, v, n = 0;
  485. u8 *p;
  486. if (bc->free == 0)
  487. return;
  488. if (!bc->bch.tx_skb) {
  489. if (!test_bit(FLG_TX_EMPTY, &bc->bch.Flags))
  490. return;
  491. fillempty = 1;
  492. count = card->send.size >> 1;
  493. p = bc->bch.fill;
  494. } else {
  495. count = bc->bch.tx_skb->len - bc->bch.tx_idx;
  496. if (count <= 0)
  497. return;
  498. pr_debug("%s: %s B%1d %d/%d/%d/%d state %x idx %d/%d\n",
  499. card->name, __func__, bc->bch.nr, count, bc->free,
  500. bc->bch.tx_idx, bc->bch.tx_skb->len, bc->txstate,
  501. bc->idx, card->send.idx);
  502. p = bc->bch.tx_skb->data + bc->bch.tx_idx;
  503. }
  504. if (bc->txstate & (TX_IDLE | TX_INIT | TX_UNDERRUN))
  505. resync(bc, card);
  506. if (test_bit(FLG_HDLC, &bc->bch.Flags) && !fillempty) {
  507. count = isdnhdlc_encode(&bc->hsend, p, count, &i,
  508. bc->hsbuf, bc->free);
  509. pr_debug("%s: B%1d hdlc encoded %d in %d\n", card->name,
  510. bc->bch.nr, i, count);
  511. bc->bch.tx_idx += i;
  512. bc->free -= count;
  513. p = bc->hsbuf;
  514. } else {
  515. if (count > bc->free)
  516. count = bc->free;
  517. if (!fillempty)
  518. bc->bch.tx_idx += count;
  519. bc->free -= count;
  520. }
  521. m = (bc->bch.nr & 1) ? 0xffffff00 : 0xffff00ff;
  522. if (fillempty) {
  523. n = p[0];
  524. if (!(bc->bch.nr & 1))
  525. n <<= 8;
  526. for (i = 0; i < count; i++) {
  527. if (bc->idx >= card->send.size)
  528. bc->idx = 0;
  529. v = card->send.start[bc->idx];
  530. v &= m;
  531. v |= n;
  532. card->send.start[bc->idx++] = v;
  533. }
  534. } else {
  535. for (i = 0; i < count; i++) {
  536. if (bc->idx >= card->send.size)
  537. bc->idx = 0;
  538. v = card->send.start[bc->idx];
  539. v &= m;
  540. n = p[i];
  541. v |= (bc->bch.nr & 1) ? n : n << 8;
  542. card->send.start[bc->idx++] = v;
  543. }
  544. }
  545. if (debug & DEBUG_HW_BFIFO) {
  546. snprintf(card->log, LOG_SIZE, "B%1d-send %s %d ",
  547. bc->bch.nr, card->name, count);
  548. print_hex_dump_bytes(card->log, DUMP_PREFIX_OFFSET, p, count);
  549. }
  550. if (bc->free)
  551. bc_next_frame(bc);
  552. }
  553. static int
  554. bc_next_frame(struct tiger_ch *bc)
  555. {
  556. int ret = 1;
  557. if (bc->bch.tx_skb && bc->bch.tx_idx < bc->bch.tx_skb->len) {
  558. fill_dma(bc);
  559. } else {
  560. if (bc->bch.tx_skb)
  561. dev_kfree_skb(bc->bch.tx_skb);
  562. if (get_next_bframe(&bc->bch)) {
  563. fill_dma(bc);
  564. test_and_clear_bit(FLG_TX_EMPTY, &bc->bch.Flags);
  565. } else if (test_bit(FLG_TX_EMPTY, &bc->bch.Flags)) {
  566. fill_dma(bc);
  567. } else if (test_bit(FLG_FILLEMPTY, &bc->bch.Flags)) {
  568. test_and_set_bit(FLG_TX_EMPTY, &bc->bch.Flags);
  569. ret = 0;
  570. } else {
  571. ret = 0;
  572. }
  573. }
  574. return ret;
  575. }
  576. static void
  577. send_tiger_bc(struct tiger_hw *card, struct tiger_ch *bc)
  578. {
  579. int ret;
  580. bc->free += card->send.size / 2;
  581. if (bc->free >= card->send.size) {
  582. if (!(bc->txstate & (TX_UNDERRUN | TX_INIT))) {
  583. pr_info("%s: B%1d TX underrun state %x\n", card->name,
  584. bc->bch.nr, bc->txstate);
  585. bc->txstate |= TX_UNDERRUN;
  586. }
  587. bc->free = card->send.size;
  588. }
  589. ret = bc_next_frame(bc);
  590. if (!ret) {
  591. if (test_bit(FLG_HDLC, &bc->bch.Flags)) {
  592. fill_hdlc_flag(bc);
  593. return;
  594. }
  595. pr_debug("%s: B%1d TX no data free %d idx %d/%d\n", card->name,
  596. bc->bch.nr, bc->free, bc->idx, card->send.idx);
  597. if (!(bc->txstate & (TX_IDLE | TX_INIT))) {
  598. fill_mem(bc, bc->idx, bc->free, 0xff);
  599. if (bc->free == card->send.size)
  600. bc->txstate |= TX_IDLE;
  601. }
  602. }
  603. }
  604. static void
  605. send_tiger(struct tiger_hw *card, u8 irq_stat)
  606. {
  607. int i;
  608. /* Note send is via the READ DMA channel */
  609. if ((irq_stat & card->last_is0) & NJ_IRQM0_RD_MASK) {
  610. pr_info("%s: tiger warn write double dma %x/%x\n",
  611. card->name, irq_stat, card->last_is0);
  612. return;
  613. } else {
  614. card->last_is0 &= ~NJ_IRQM0_RD_MASK;
  615. card->last_is0 |= (irq_stat & NJ_IRQM0_RD_MASK);
  616. }
  617. for (i = 0; i < 2; i++) {
  618. if (test_bit(FLG_ACTIVE, &card->bc[i].bch.Flags))
  619. send_tiger_bc(card, &card->bc[i]);
  620. }
  621. }
  622. static irqreturn_t
  623. nj_irq(int intno, void *dev_id)
  624. {
  625. struct tiger_hw *card = dev_id;
  626. u8 val, s1val, s0val;
  627. spin_lock(&card->lock);
  628. s0val = inb(card->base | NJ_IRQSTAT0);
  629. s1val = inb(card->base | NJ_IRQSTAT1);
  630. if ((s1val & NJ_ISACIRQ) && (s0val == 0)) {
  631. /* shared IRQ */
  632. spin_unlock(&card->lock);
  633. return IRQ_NONE;
  634. }
  635. pr_debug("%s: IRQSTAT0 %02x IRQSTAT1 %02x\n", card->name, s0val, s1val);
  636. card->irqcnt++;
  637. if (!(s1val & NJ_ISACIRQ)) {
  638. val = ReadISAC_nj(card, ISAC_ISTA);
  639. if (val)
  640. mISDNisac_irq(&card->isac, val);
  641. }
  642. if (s0val)
  643. /* write to clear */
  644. outb(s0val, card->base | NJ_IRQSTAT0);
  645. else
  646. goto end;
  647. s1val = s0val;
  648. /* set bits in sval to indicate which page is free */
  649. card->recv.dmacur = inl(card->base | NJ_DMA_WRITE_ADR);
  650. card->recv.idx = (card->recv.dmacur - card->recv.dmastart) >> 2;
  651. if (card->recv.dmacur < card->recv.dmairq)
  652. s0val = 0x08; /* the 2nd write area is free */
  653. else
  654. s0val = 0x04; /* the 1st write area is free */
  655. card->send.dmacur = inl(card->base | NJ_DMA_READ_ADR);
  656. card->send.idx = (card->send.dmacur - card->send.dmastart) >> 2;
  657. if (card->send.dmacur < card->send.dmairq)
  658. s0val |= 0x02; /* the 2nd read area is free */
  659. else
  660. s0val |= 0x01; /* the 1st read area is free */
  661. pr_debug("%s: DMA Status %02x/%02x/%02x %d/%d\n", card->name,
  662. s1val, s0val, card->last_is0,
  663. card->recv.idx, card->send.idx);
  664. /* test if we have a DMA interrupt */
  665. if (s0val != card->last_is0) {
  666. if ((s0val & NJ_IRQM0_RD_MASK) !=
  667. (card->last_is0 & NJ_IRQM0_RD_MASK))
  668. /* got a write dma int */
  669. send_tiger(card, s0val);
  670. if ((s0val & NJ_IRQM0_WR_MASK) !=
  671. (card->last_is0 & NJ_IRQM0_WR_MASK))
  672. /* got a read dma int */
  673. recv_tiger(card, s0val);
  674. }
  675. end:
  676. spin_unlock(&card->lock);
  677. return IRQ_HANDLED;
  678. }
  679. static int
  680. nj_l2l1B(struct mISDNchannel *ch, struct sk_buff *skb)
  681. {
  682. int ret = -EINVAL;
  683. struct bchannel *bch = container_of(ch, struct bchannel, ch);
  684. struct tiger_ch *bc = container_of(bch, struct tiger_ch, bch);
  685. struct tiger_hw *card = bch->hw;
  686. struct mISDNhead *hh = mISDN_HEAD_P(skb);
  687. unsigned long flags;
  688. switch (hh->prim) {
  689. case PH_DATA_REQ:
  690. spin_lock_irqsave(&card->lock, flags);
  691. ret = bchannel_senddata(bch, skb);
  692. if (ret > 0) { /* direct TX */
  693. fill_dma(bc);
  694. ret = 0;
  695. }
  696. spin_unlock_irqrestore(&card->lock, flags);
  697. return ret;
  698. case PH_ACTIVATE_REQ:
  699. spin_lock_irqsave(&card->lock, flags);
  700. if (!test_and_set_bit(FLG_ACTIVE, &bch->Flags))
  701. ret = mode_tiger(bc, ch->protocol);
  702. else
  703. ret = 0;
  704. spin_unlock_irqrestore(&card->lock, flags);
  705. if (!ret)
  706. _queue_data(ch, PH_ACTIVATE_IND, MISDN_ID_ANY, 0,
  707. NULL, GFP_KERNEL);
  708. break;
  709. case PH_DEACTIVATE_REQ:
  710. spin_lock_irqsave(&card->lock, flags);
  711. mISDN_clear_bchannel(bch);
  712. mode_tiger(bc, ISDN_P_NONE);
  713. spin_unlock_irqrestore(&card->lock, flags);
  714. _queue_data(ch, PH_DEACTIVATE_IND, MISDN_ID_ANY, 0,
  715. NULL, GFP_KERNEL);
  716. ret = 0;
  717. break;
  718. }
  719. if (!ret)
  720. dev_kfree_skb(skb);
  721. return ret;
  722. }
  723. static int
  724. channel_bctrl(struct tiger_ch *bc, struct mISDN_ctrl_req *cq)
  725. {
  726. return mISDN_ctrl_bchannel(&bc->bch, cq);
  727. }
  728. static int
  729. nj_bctrl(struct mISDNchannel *ch, u32 cmd, void *arg)
  730. {
  731. struct bchannel *bch = container_of(ch, struct bchannel, ch);
  732. struct tiger_ch *bc = container_of(bch, struct tiger_ch, bch);
  733. struct tiger_hw *card = bch->hw;
  734. int ret = -EINVAL;
  735. u_long flags;
  736. pr_debug("%s: %s cmd:%x %p\n", card->name, __func__, cmd, arg);
  737. switch (cmd) {
  738. case CLOSE_CHANNEL:
  739. test_and_clear_bit(FLG_OPEN, &bch->Flags);
  740. spin_lock_irqsave(&card->lock, flags);
  741. mISDN_freebchannel(bch);
  742. mode_tiger(bc, ISDN_P_NONE);
  743. spin_unlock_irqrestore(&card->lock, flags);
  744. ch->protocol = ISDN_P_NONE;
  745. ch->peer = NULL;
  746. module_put(THIS_MODULE);
  747. ret = 0;
  748. break;
  749. case CONTROL_CHANNEL:
  750. ret = channel_bctrl(bc, arg);
  751. break;
  752. default:
  753. pr_info("%s: %s unknown prim(%x)\n", card->name, __func__, cmd);
  754. }
  755. return ret;
  756. }
  757. static int
  758. channel_ctrl(struct tiger_hw *card, struct mISDN_ctrl_req *cq)
  759. {
  760. int ret = 0;
  761. switch (cq->op) {
  762. case MISDN_CTRL_GETOP:
  763. cq->op = MISDN_CTRL_LOOP | MISDN_CTRL_L1_TIMER3;
  764. break;
  765. case MISDN_CTRL_LOOP:
  766. /* cq->channel: 0 disable, 1 B1 loop 2 B2 loop, 3 both */
  767. if (cq->channel < 0 || cq->channel > 3) {
  768. ret = -EINVAL;
  769. break;
  770. }
  771. ret = card->isac.ctrl(&card->isac, HW_TESTLOOP, cq->channel);
  772. break;
  773. case MISDN_CTRL_L1_TIMER3:
  774. ret = card->isac.ctrl(&card->isac, HW_TIMER3_VALUE, cq->p1);
  775. break;
  776. default:
  777. pr_info("%s: %s unknown Op %x\n", card->name, __func__, cq->op);
  778. ret = -EINVAL;
  779. break;
  780. }
  781. return ret;
  782. }
  783. static int
  784. open_bchannel(struct tiger_hw *card, struct channel_req *rq)
  785. {
  786. struct bchannel *bch;
  787. if (rq->adr.channel == 0 || rq->adr.channel > 2)
  788. return -EINVAL;
  789. if (rq->protocol == ISDN_P_NONE)
  790. return -EINVAL;
  791. bch = &card->bc[rq->adr.channel - 1].bch;
  792. if (test_and_set_bit(FLG_OPEN, &bch->Flags))
  793. return -EBUSY; /* b-channel can be only open once */
  794. test_and_clear_bit(FLG_FILLEMPTY, &bch->Flags);
  795. bch->ch.protocol = rq->protocol;
  796. rq->ch = &bch->ch;
  797. return 0;
  798. }
  799. /*
  800. * device control function
  801. */
  802. static int
  803. nj_dctrl(struct mISDNchannel *ch, u32 cmd, void *arg)
  804. {
  805. struct mISDNdevice *dev = container_of(ch, struct mISDNdevice, D);
  806. struct dchannel *dch = container_of(dev, struct dchannel, dev);
  807. struct tiger_hw *card = dch->hw;
  808. struct channel_req *rq;
  809. int err = 0;
  810. pr_debug("%s: %s cmd:%x %p\n", card->name, __func__, cmd, arg);
  811. switch (cmd) {
  812. case OPEN_CHANNEL:
  813. rq = arg;
  814. if (rq->protocol == ISDN_P_TE_S0)
  815. err = card->isac.open(&card->isac, rq);
  816. else
  817. err = open_bchannel(card, rq);
  818. if (err)
  819. break;
  820. if (!try_module_get(THIS_MODULE))
  821. pr_info("%s: cannot get module\n", card->name);
  822. break;
  823. case CLOSE_CHANNEL:
  824. pr_debug("%s: dev(%d) close from %p\n", card->name, dch->dev.id,
  825. __builtin_return_address(0));
  826. module_put(THIS_MODULE);
  827. break;
  828. case CONTROL_CHANNEL:
  829. err = channel_ctrl(card, arg);
  830. break;
  831. default:
  832. pr_debug("%s: %s unknown command %x\n",
  833. card->name, __func__, cmd);
  834. return -EINVAL;
  835. }
  836. return err;
  837. }
  838. static int
  839. nj_init_card(struct tiger_hw *card)
  840. {
  841. u_long flags;
  842. int ret;
  843. spin_lock_irqsave(&card->lock, flags);
  844. nj_disable_hwirq(card);
  845. spin_unlock_irqrestore(&card->lock, flags);
  846. card->irq = card->pdev->irq;
  847. if (request_irq(card->irq, nj_irq, IRQF_SHARED, card->name, card)) {
  848. pr_info("%s: couldn't get interrupt %d\n",
  849. card->name, card->irq);
  850. card->irq = -1;
  851. return -EIO;
  852. }
  853. spin_lock_irqsave(&card->lock, flags);
  854. nj_reset(card);
  855. ret = card->isac.init(&card->isac);
  856. if (ret)
  857. goto error;
  858. ret = inittiger(card);
  859. if (ret)
  860. goto error;
  861. mode_tiger(&card->bc[0], ISDN_P_NONE);
  862. mode_tiger(&card->bc[1], ISDN_P_NONE);
  863. error:
  864. spin_unlock_irqrestore(&card->lock, flags);
  865. return ret;
  866. }
  867. static void
  868. nj_release(struct tiger_hw *card)
  869. {
  870. u_long flags;
  871. int i;
  872. if (card->base_s) {
  873. spin_lock_irqsave(&card->lock, flags);
  874. nj_disable_hwirq(card);
  875. mode_tiger(&card->bc[0], ISDN_P_NONE);
  876. mode_tiger(&card->bc[1], ISDN_P_NONE);
  877. card->isac.release(&card->isac);
  878. spin_unlock_irqrestore(&card->lock, flags);
  879. release_region(card->base, card->base_s);
  880. card->base_s = 0;
  881. }
  882. if (card->irq > 0)
  883. free_irq(card->irq, card);
  884. if (card->isac.dch.dev.dev.class)
  885. mISDN_unregister_device(&card->isac.dch.dev);
  886. for (i = 0; i < 2; i++) {
  887. mISDN_freebchannel(&card->bc[i].bch);
  888. kfree(card->bc[i].hsbuf);
  889. kfree(card->bc[i].hrbuf);
  890. }
  891. if (card->dma_p)
  892. pci_free_consistent(card->pdev, NJ_DMA_SIZE,
  893. card->dma_p, card->dma);
  894. write_lock_irqsave(&card_lock, flags);
  895. list_del(&card->list);
  896. write_unlock_irqrestore(&card_lock, flags);
  897. pci_clear_master(card->pdev);
  898. pci_disable_device(card->pdev);
  899. pci_set_drvdata(card->pdev, NULL);
  900. kfree(card);
  901. }
  902. static int
  903. nj_setup(struct tiger_hw *card)
  904. {
  905. card->base = pci_resource_start(card->pdev, 0);
  906. card->base_s = pci_resource_len(card->pdev, 0);
  907. if (!request_region(card->base, card->base_s, card->name)) {
  908. pr_info("%s: NETjet config port %#x-%#x already in use\n",
  909. card->name, card->base,
  910. (u32)(card->base + card->base_s - 1));
  911. card->base_s = 0;
  912. return -EIO;
  913. }
  914. ASSIGN_FUNC(nj, ISAC, card->isac);
  915. return 0;
  916. }
  917. static int __devinit
  918. setup_instance(struct tiger_hw *card)
  919. {
  920. int i, err;
  921. u_long flags;
  922. snprintf(card->name, MISDN_MAX_IDLEN - 1, "netjet.%d", nj_cnt + 1);
  923. write_lock_irqsave(&card_lock, flags);
  924. list_add_tail(&card->list, &Cards);
  925. write_unlock_irqrestore(&card_lock, flags);
  926. _set_debug(card);
  927. card->isac.name = card->name;
  928. spin_lock_init(&card->lock);
  929. card->isac.hwlock = &card->lock;
  930. mISDNisac_init(&card->isac, card);
  931. card->isac.dch.dev.Bprotocols = (1 << (ISDN_P_B_RAW & ISDN_P_B_MASK)) |
  932. (1 << (ISDN_P_B_HDLC & ISDN_P_B_MASK));
  933. card->isac.dch.dev.D.ctrl = nj_dctrl;
  934. for (i = 0; i < 2; i++) {
  935. card->bc[i].bch.nr = i + 1;
  936. set_channelmap(i + 1, card->isac.dch.dev.channelmap);
  937. mISDN_initbchannel(&card->bc[i].bch, MAX_DATA_MEM,
  938. NJ_DMA_RXSIZE >> 1);
  939. card->bc[i].bch.hw = card;
  940. card->bc[i].bch.ch.send = nj_l2l1B;
  941. card->bc[i].bch.ch.ctrl = nj_bctrl;
  942. card->bc[i].bch.ch.nr = i + 1;
  943. list_add(&card->bc[i].bch.ch.list,
  944. &card->isac.dch.dev.bchannels);
  945. card->bc[i].bch.hw = card;
  946. }
  947. err = nj_setup(card);
  948. if (err)
  949. goto error;
  950. err = mISDN_register_device(&card->isac.dch.dev, &card->pdev->dev,
  951. card->name);
  952. if (err)
  953. goto error;
  954. err = nj_init_card(card);
  955. if (!err) {
  956. nj_cnt++;
  957. pr_notice("Netjet %d cards installed\n", nj_cnt);
  958. return 0;
  959. }
  960. error:
  961. nj_release(card);
  962. return err;
  963. }
  964. static int __devinit
  965. nj_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  966. {
  967. int err = -ENOMEM;
  968. int cfg;
  969. struct tiger_hw *card;
  970. if (pdev->subsystem_vendor == 0x8086 &&
  971. pdev->subsystem_device == 0x0003) {
  972. pr_notice("Netjet: Digium X100P/X101P not handled\n");
  973. return -ENODEV;
  974. }
  975. if (pdev->subsystem_vendor == 0x55 &&
  976. pdev->subsystem_device == 0x02) {
  977. pr_notice("Netjet: Enter!Now not handled yet\n");
  978. return -ENODEV;
  979. }
  980. if (pdev->subsystem_vendor == 0xb100 &&
  981. pdev->subsystem_device == 0x0003) {
  982. pr_notice("Netjet: Digium TDM400P not handled yet\n");
  983. return -ENODEV;
  984. }
  985. card = kzalloc(sizeof(struct tiger_hw), GFP_ATOMIC);
  986. if (!card) {
  987. pr_info("No kmem for Netjet\n");
  988. return err;
  989. }
  990. card->pdev = pdev;
  991. err = pci_enable_device(pdev);
  992. if (err) {
  993. kfree(card);
  994. return err;
  995. }
  996. printk(KERN_INFO "nj_probe(mISDN): found adapter at %s\n",
  997. pci_name(pdev));
  998. pci_set_master(pdev);
  999. /* the TJ300 and TJ320 must be detected, the IRQ handling is different
  1000. * unfortunately the chips use the same device ID, but the TJ320 has
  1001. * the bit20 in status PCI cfg register set
  1002. */
  1003. pci_read_config_dword(pdev, 0x04, &cfg);
  1004. if (cfg & 0x00100000)
  1005. card->typ = NETJET_S_TJ320;
  1006. else
  1007. card->typ = NETJET_S_TJ300;
  1008. card->base = pci_resource_start(pdev, 0);
  1009. card->irq = pdev->irq;
  1010. pci_set_drvdata(pdev, card);
  1011. err = setup_instance(card);
  1012. if (err)
  1013. pci_set_drvdata(pdev, NULL);
  1014. return err;
  1015. }
  1016. static void __devexit nj_remove(struct pci_dev *pdev)
  1017. {
  1018. struct tiger_hw *card = pci_get_drvdata(pdev);
  1019. if (card)
  1020. nj_release(card);
  1021. else
  1022. pr_info("%s drvdata already removed\n", __func__);
  1023. }
  1024. /* We cannot select cards with PCI_SUB... IDs, since here are cards with
  1025. * SUB IDs set to PCI_ANY_ID, so we need to match all and reject
  1026. * known other cards which not work with this driver - see probe function */
  1027. static struct pci_device_id nj_pci_ids[] __devinitdata = {
  1028. { PCI_VENDOR_ID_TIGERJET, PCI_DEVICE_ID_TIGERJET_300,
  1029. PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
  1030. { }
  1031. };
  1032. MODULE_DEVICE_TABLE(pci, nj_pci_ids);
  1033. static struct pci_driver nj_driver = {
  1034. .name = "netjet",
  1035. .probe = nj_probe,
  1036. .remove = __devexit_p(nj_remove),
  1037. .id_table = nj_pci_ids,
  1038. };
  1039. static int __init nj_init(void)
  1040. {
  1041. int err;
  1042. pr_notice("Netjet PCI driver Rev. %s\n", NETJET_REV);
  1043. err = pci_register_driver(&nj_driver);
  1044. return err;
  1045. }
  1046. static void __exit nj_cleanup(void)
  1047. {
  1048. pci_unregister_driver(&nj_driver);
  1049. }
  1050. module_init(nj_init);
  1051. module_exit(nj_cleanup);