hd64570.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723
  1. /*
  2. * Hitachi SCA HD64570 driver for Linux
  3. *
  4. * Copyright (C) 1998-2003 Krzysztof Halasa <khc@pm.waw.pl>
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of version 2 of the GNU General Public License
  8. * as published by the Free Software Foundation.
  9. *
  10. * Source of information: Hitachi HD64570 SCA User's Manual
  11. *
  12. * We use the following SCA memory map:
  13. *
  14. * Packet buffer descriptor rings - starting from winbase or win0base:
  15. * rx_ring_buffers * sizeof(pkt_desc) = logical channel #0 RX ring
  16. * tx_ring_buffers * sizeof(pkt_desc) = logical channel #0 TX ring
  17. * rx_ring_buffers * sizeof(pkt_desc) = logical channel #1 RX ring (if used)
  18. * tx_ring_buffers * sizeof(pkt_desc) = logical channel #1 TX ring (if used)
  19. *
  20. * Packet data buffers - starting from winbase + buff_offset:
  21. * rx_ring_buffers * HDLC_MAX_MRU = logical channel #0 RX buffers
  22. * tx_ring_buffers * HDLC_MAX_MRU = logical channel #0 TX buffers
  23. * rx_ring_buffers * HDLC_MAX_MRU = logical channel #0 RX buffers (if used)
  24. * tx_ring_buffers * HDLC_MAX_MRU = logical channel #0 TX buffers (if used)
  25. */
  26. #include <linux/bitops.h>
  27. #include <linux/errno.h>
  28. #include <linux/fcntl.h>
  29. #include <linux/hdlc.h>
  30. #include <linux/in.h>
  31. #include <linux/init.h>
  32. #include <linux/interrupt.h>
  33. #include <linux/ioport.h>
  34. #include <linux/jiffies.h>
  35. #include <linux/kernel.h>
  36. #include <linux/module.h>
  37. #include <linux/netdevice.h>
  38. #include <linux/skbuff.h>
  39. #include <linux/string.h>
  40. #include <linux/types.h>
  41. #include <asm/io.h>
  42. #include <asm/system.h>
  43. #include <asm/uaccess.h>
  44. #include "hd64570.h"
  45. #define get_msci(port) (phy_node(port) ? MSCI1_OFFSET : MSCI0_OFFSET)
  46. #define get_dmac_rx(port) (phy_node(port) ? DMAC1RX_OFFSET : DMAC0RX_OFFSET)
  47. #define get_dmac_tx(port) (phy_node(port) ? DMAC1TX_OFFSET : DMAC0TX_OFFSET)
  48. #define SCA_INTR_MSCI(node) (node ? 0x10 : 0x01)
  49. #define SCA_INTR_DMAC_RX(node) (node ? 0x20 : 0x02)
  50. #define SCA_INTR_DMAC_TX(node) (node ? 0x40 : 0x04)
  51. static inline struct net_device *port_to_dev(port_t *port)
  52. {
  53. return port->dev;
  54. }
  55. static inline int sca_intr_status(card_t *card)
  56. {
  57. u8 result = 0;
  58. u8 isr0 = sca_in(ISR0, card);
  59. u8 isr1 = sca_in(ISR1, card);
  60. if (isr1 & 0x03) result |= SCA_INTR_DMAC_RX(0);
  61. if (isr1 & 0x0C) result |= SCA_INTR_DMAC_TX(0);
  62. if (isr1 & 0x30) result |= SCA_INTR_DMAC_RX(1);
  63. if (isr1 & 0xC0) result |= SCA_INTR_DMAC_TX(1);
  64. if (isr0 & 0x0F) result |= SCA_INTR_MSCI(0);
  65. if (isr0 & 0xF0) result |= SCA_INTR_MSCI(1);
  66. if (!(result & SCA_INTR_DMAC_TX(0)))
  67. if (sca_in(DSR_TX(0), card) & DSR_EOM)
  68. result |= SCA_INTR_DMAC_TX(0);
  69. if (!(result & SCA_INTR_DMAC_TX(1)))
  70. if (sca_in(DSR_TX(1), card) & DSR_EOM)
  71. result |= SCA_INTR_DMAC_TX(1);
  72. return result;
  73. }
  74. static inline port_t* dev_to_port(struct net_device *dev)
  75. {
  76. return dev_to_hdlc(dev)->priv;
  77. }
  78. static inline u16 next_desc(port_t *port, u16 desc, int transmit)
  79. {
  80. return (desc + 1) % (transmit ? port_to_card(port)->tx_ring_buffers
  81. : port_to_card(port)->rx_ring_buffers);
  82. }
  83. static inline u16 desc_abs_number(port_t *port, u16 desc, int transmit)
  84. {
  85. u16 rx_buffs = port_to_card(port)->rx_ring_buffers;
  86. u16 tx_buffs = port_to_card(port)->tx_ring_buffers;
  87. desc %= (transmit ? tx_buffs : rx_buffs); // called with "X + 1" etc.
  88. return log_node(port) * (rx_buffs + tx_buffs) +
  89. transmit * rx_buffs + desc;
  90. }
  91. static inline u16 desc_offset(port_t *port, u16 desc, int transmit)
  92. {
  93. /* Descriptor offset always fits in 16 bits */
  94. return desc_abs_number(port, desc, transmit) * sizeof(pkt_desc);
  95. }
  96. static inline pkt_desc __iomem *desc_address(port_t *port, u16 desc,
  97. int transmit)
  98. {
  99. #ifdef PAGE0_ALWAYS_MAPPED
  100. return (pkt_desc __iomem *)(win0base(port_to_card(port))
  101. + desc_offset(port, desc, transmit));
  102. #else
  103. return (pkt_desc __iomem *)(winbase(port_to_card(port))
  104. + desc_offset(port, desc, transmit));
  105. #endif
  106. }
  107. static inline u32 buffer_offset(port_t *port, u16 desc, int transmit)
  108. {
  109. return port_to_card(port)->buff_offset +
  110. desc_abs_number(port, desc, transmit) * (u32)HDLC_MAX_MRU;
  111. }
  112. static inline void sca_set_carrier(port_t *port)
  113. {
  114. if (!(sca_in(get_msci(port) + ST3, port_to_card(port)) & ST3_DCD)) {
  115. #ifdef DEBUG_LINK
  116. printk(KERN_DEBUG "%s: sca_set_carrier on\n",
  117. port_to_dev(port)->name);
  118. #endif
  119. netif_carrier_on(port_to_dev(port));
  120. } else {
  121. #ifdef DEBUG_LINK
  122. printk(KERN_DEBUG "%s: sca_set_carrier off\n",
  123. port_to_dev(port)->name);
  124. #endif
  125. netif_carrier_off(port_to_dev(port));
  126. }
  127. }
  128. static void sca_init_port(port_t *port)
  129. {
  130. card_t *card = port_to_card(port);
  131. int transmit, i;
  132. port->rxin = 0;
  133. port->txin = 0;
  134. port->txlast = 0;
  135. #ifndef PAGE0_ALWAYS_MAPPED
  136. openwin(card, 0);
  137. #endif
  138. for (transmit = 0; transmit < 2; transmit++) {
  139. u16 dmac = transmit ? get_dmac_tx(port) : get_dmac_rx(port);
  140. u16 buffs = transmit ? card->tx_ring_buffers
  141. : card->rx_ring_buffers;
  142. for (i = 0; i < buffs; i++) {
  143. pkt_desc __iomem *desc = desc_address(port, i, transmit);
  144. u16 chain_off = desc_offset(port, i + 1, transmit);
  145. u32 buff_off = buffer_offset(port, i, transmit);
  146. writew(chain_off, &desc->cp);
  147. writel(buff_off, &desc->bp);
  148. writew(0, &desc->len);
  149. writeb(0, &desc->stat);
  150. }
  151. /* DMA disable - to halt state */
  152. sca_out(0, transmit ? DSR_TX(phy_node(port)) :
  153. DSR_RX(phy_node(port)), card);
  154. /* software ABORT - to initial state */
  155. sca_out(DCR_ABORT, transmit ? DCR_TX(phy_node(port)) :
  156. DCR_RX(phy_node(port)), card);
  157. /* current desc addr */
  158. sca_out(0, dmac + CPB, card); /* pointer base */
  159. sca_outw(desc_offset(port, 0, transmit), dmac + CDAL, card);
  160. if (!transmit)
  161. sca_outw(desc_offset(port, buffs - 1, transmit),
  162. dmac + EDAL, card);
  163. else
  164. sca_outw(desc_offset(port, 0, transmit), dmac + EDAL,
  165. card);
  166. /* clear frame end interrupt counter */
  167. sca_out(DCR_CLEAR_EOF, transmit ? DCR_TX(phy_node(port)) :
  168. DCR_RX(phy_node(port)), card);
  169. if (!transmit) { /* Receive */
  170. /* set buffer length */
  171. sca_outw(HDLC_MAX_MRU, dmac + BFLL, card);
  172. /* Chain mode, Multi-frame */
  173. sca_out(0x14, DMR_RX(phy_node(port)), card);
  174. sca_out(DIR_EOME | DIR_BOFE, DIR_RX(phy_node(port)),
  175. card);
  176. /* DMA enable */
  177. sca_out(DSR_DE, DSR_RX(phy_node(port)), card);
  178. } else { /* Transmit */
  179. /* Chain mode, Multi-frame */
  180. sca_out(0x14, DMR_TX(phy_node(port)), card);
  181. /* enable underflow interrupts */
  182. sca_out(DIR_BOFE, DIR_TX(phy_node(port)), card);
  183. }
  184. }
  185. sca_set_carrier(port);
  186. }
  187. #ifdef NEED_SCA_MSCI_INTR
  188. /* MSCI interrupt service */
  189. static inline void sca_msci_intr(port_t *port)
  190. {
  191. u16 msci = get_msci(port);
  192. card_t* card = port_to_card(port);
  193. u8 stat = sca_in(msci + ST1, card); /* read MSCI ST1 status */
  194. /* Reset MSCI TX underrun and CDCD status bit */
  195. sca_out(stat & (ST1_UDRN | ST1_CDCD), msci + ST1, card);
  196. if (stat & ST1_UDRN) {
  197. /* TX Underrun error detected */
  198. port_to_dev(port)->stats.tx_errors++;
  199. port_to_dev(port)->stats.tx_fifo_errors++;
  200. }
  201. if (stat & ST1_CDCD)
  202. sca_set_carrier(port);
  203. }
  204. #endif
  205. static inline void sca_rx(card_t *card, port_t *port, pkt_desc __iomem *desc,
  206. u16 rxin)
  207. {
  208. struct net_device *dev = port_to_dev(port);
  209. struct sk_buff *skb;
  210. u16 len;
  211. u32 buff;
  212. u32 maxlen;
  213. u8 page;
  214. len = readw(&desc->len);
  215. skb = dev_alloc_skb(len);
  216. if (!skb) {
  217. dev->stats.rx_dropped++;
  218. return;
  219. }
  220. buff = buffer_offset(port, rxin, 0);
  221. page = buff / winsize(card);
  222. buff = buff % winsize(card);
  223. maxlen = winsize(card) - buff;
  224. openwin(card, page);
  225. if (len > maxlen) {
  226. memcpy_fromio(skb->data, winbase(card) + buff, maxlen);
  227. openwin(card, page + 1);
  228. memcpy_fromio(skb->data + maxlen, winbase(card), len - maxlen);
  229. } else
  230. memcpy_fromio(skb->data, winbase(card) + buff, len);
  231. #ifndef PAGE0_ALWAYS_MAPPED
  232. openwin(card, 0); /* select pkt_desc table page back */
  233. #endif
  234. skb_put(skb, len);
  235. #ifdef DEBUG_PKT
  236. printk(KERN_DEBUG "%s RX(%i):", dev->name, skb->len);
  237. debug_frame(skb);
  238. #endif
  239. dev->stats.rx_packets++;
  240. dev->stats.rx_bytes += skb->len;
  241. skb->protocol = hdlc_type_trans(skb, dev);
  242. netif_rx(skb);
  243. }
  244. /* Receive DMA interrupt service */
  245. static inline void sca_rx_intr(port_t *port)
  246. {
  247. struct net_device *dev = port_to_dev(port);
  248. u16 dmac = get_dmac_rx(port);
  249. card_t *card = port_to_card(port);
  250. u8 stat = sca_in(DSR_RX(phy_node(port)), card); /* read DMA Status */
  251. /* Reset DSR status bits */
  252. sca_out((stat & (DSR_EOT | DSR_EOM | DSR_BOF | DSR_COF)) | DSR_DWE,
  253. DSR_RX(phy_node(port)), card);
  254. if (stat & DSR_BOF)
  255. /* Dropped one or more frames */
  256. dev->stats.rx_over_errors++;
  257. while (1) {
  258. u32 desc_off = desc_offset(port, port->rxin, 0);
  259. pkt_desc __iomem *desc;
  260. u32 cda = sca_inw(dmac + CDAL, card);
  261. if ((cda >= desc_off) && (cda < desc_off + sizeof(pkt_desc)))
  262. break; /* No frame received */
  263. desc = desc_address(port, port->rxin, 0);
  264. stat = readb(&desc->stat);
  265. if (!(stat & ST_RX_EOM))
  266. port->rxpart = 1; /* partial frame received */
  267. else if ((stat & ST_ERROR_MASK) || port->rxpart) {
  268. dev->stats.rx_errors++;
  269. if (stat & ST_RX_OVERRUN)
  270. dev->stats.rx_fifo_errors++;
  271. else if ((stat & (ST_RX_SHORT | ST_RX_ABORT |
  272. ST_RX_RESBIT)) || port->rxpart)
  273. dev->stats.rx_frame_errors++;
  274. else if (stat & ST_RX_CRC)
  275. dev->stats.rx_crc_errors++;
  276. if (stat & ST_RX_EOM)
  277. port->rxpart = 0; /* received last fragment */
  278. } else
  279. sca_rx(card, port, desc, port->rxin);
  280. /* Set new error descriptor address */
  281. sca_outw(desc_off, dmac + EDAL, card);
  282. port->rxin = next_desc(port, port->rxin, 0);
  283. }
  284. /* make sure RX DMA is enabled */
  285. sca_out(DSR_DE, DSR_RX(phy_node(port)), card);
  286. }
  287. /* Transmit DMA interrupt service */
  288. static inline void sca_tx_intr(port_t *port)
  289. {
  290. struct net_device *dev = port_to_dev(port);
  291. u16 dmac = get_dmac_tx(port);
  292. card_t* card = port_to_card(port);
  293. u8 stat;
  294. spin_lock(&port->lock);
  295. stat = sca_in(DSR_TX(phy_node(port)), card); /* read DMA Status */
  296. /* Reset DSR status bits */
  297. sca_out((stat & (DSR_EOT | DSR_EOM | DSR_BOF | DSR_COF)) | DSR_DWE,
  298. DSR_TX(phy_node(port)), card);
  299. while (1) {
  300. pkt_desc __iomem *desc;
  301. u32 desc_off = desc_offset(port, port->txlast, 1);
  302. u32 cda = sca_inw(dmac + CDAL, card);
  303. if ((cda >= desc_off) && (cda < desc_off + sizeof(pkt_desc)))
  304. break; /* Transmitter is/will_be sending this frame */
  305. desc = desc_address(port, port->txlast, 1);
  306. dev->stats.tx_packets++;
  307. dev->stats.tx_bytes += readw(&desc->len);
  308. writeb(0, &desc->stat); /* Free descriptor */
  309. port->txlast = next_desc(port, port->txlast, 1);
  310. }
  311. netif_wake_queue(dev);
  312. spin_unlock(&port->lock);
  313. }
  314. static irqreturn_t sca_intr(int irq, void* dev_id)
  315. {
  316. card_t *card = dev_id;
  317. int i;
  318. u8 stat;
  319. int handled = 0;
  320. u8 page = sca_get_page(card);
  321. while((stat = sca_intr_status(card)) != 0) {
  322. handled = 1;
  323. for (i = 0; i < 2; i++) {
  324. port_t *port = get_port(card, i);
  325. if (port) {
  326. if (stat & SCA_INTR_MSCI(i))
  327. sca_msci_intr(port);
  328. if (stat & SCA_INTR_DMAC_RX(i))
  329. sca_rx_intr(port);
  330. if (stat & SCA_INTR_DMAC_TX(i))
  331. sca_tx_intr(port);
  332. }
  333. }
  334. }
  335. openwin(card, page); /* Restore original page */
  336. return IRQ_RETVAL(handled);
  337. }
  338. static void sca_set_port(port_t *port)
  339. {
  340. card_t* card = port_to_card(port);
  341. u16 msci = get_msci(port);
  342. u8 md2 = sca_in(msci + MD2, card);
  343. unsigned int tmc, br = 10, brv = 1024;
  344. if (port->settings.clock_rate > 0) {
  345. /* Try lower br for better accuracy*/
  346. do {
  347. br--;
  348. brv >>= 1; /* brv = 2^9 = 512 max in specs */
  349. /* Baud Rate = CLOCK_BASE / TMC / 2^BR */
  350. tmc = CLOCK_BASE / brv / port->settings.clock_rate;
  351. }while (br > 1 && tmc <= 128);
  352. if (tmc < 1) {
  353. tmc = 1;
  354. br = 0; /* For baud=CLOCK_BASE we use tmc=1 br=0 */
  355. brv = 1;
  356. } else if (tmc > 255)
  357. tmc = 256; /* tmc=0 means 256 - low baud rates */
  358. port->settings.clock_rate = CLOCK_BASE / brv / tmc;
  359. } else {
  360. br = 9; /* Minimum clock rate */
  361. tmc = 256; /* 8bit = 0 */
  362. port->settings.clock_rate = CLOCK_BASE / (256 * 512);
  363. }
  364. port->rxs = (port->rxs & ~CLK_BRG_MASK) | br;
  365. port->txs = (port->txs & ~CLK_BRG_MASK) | br;
  366. port->tmc = tmc;
  367. /* baud divisor - time constant*/
  368. sca_out(port->tmc, msci + TMC, card);
  369. /* Set BRG bits */
  370. sca_out(port->rxs, msci + RXS, card);
  371. sca_out(port->txs, msci + TXS, card);
  372. if (port->settings.loopback)
  373. md2 |= MD2_LOOPBACK;
  374. else
  375. md2 &= ~MD2_LOOPBACK;
  376. sca_out(md2, msci + MD2, card);
  377. }
  378. static void sca_open(struct net_device *dev)
  379. {
  380. port_t *port = dev_to_port(dev);
  381. card_t* card = port_to_card(port);
  382. u16 msci = get_msci(port);
  383. u8 md0, md2;
  384. switch(port->encoding) {
  385. case ENCODING_NRZ: md2 = MD2_NRZ; break;
  386. case ENCODING_NRZI: md2 = MD2_NRZI; break;
  387. case ENCODING_FM_MARK: md2 = MD2_FM_MARK; break;
  388. case ENCODING_FM_SPACE: md2 = MD2_FM_SPACE; break;
  389. default: md2 = MD2_MANCHESTER;
  390. }
  391. if (port->settings.loopback)
  392. md2 |= MD2_LOOPBACK;
  393. switch(port->parity) {
  394. case PARITY_CRC16_PR0: md0 = MD0_HDLC | MD0_CRC_16_0; break;
  395. case PARITY_CRC16_PR1: md0 = MD0_HDLC | MD0_CRC_16; break;
  396. case PARITY_CRC16_PR0_CCITT: md0 = MD0_HDLC | MD0_CRC_ITU_0; break;
  397. case PARITY_CRC16_PR1_CCITT: md0 = MD0_HDLC | MD0_CRC_ITU; break;
  398. default: md0 = MD0_HDLC | MD0_CRC_NONE;
  399. }
  400. sca_out(CMD_RESET, msci + CMD, card);
  401. sca_out(md0, msci + MD0, card);
  402. sca_out(0x00, msci + MD1, card); /* no address field check */
  403. sca_out(md2, msci + MD2, card);
  404. sca_out(0x7E, msci + IDL, card); /* flag character 0x7E */
  405. sca_out(CTL_IDLE, msci + CTL, card);
  406. /* Allow at least 8 bytes before requesting RX DMA operation */
  407. /* TX with higher priority and possibly with shorter transfers */
  408. sca_out(0x07, msci + RRC, card); /* +1=RXRDY/DMA activation condition*/
  409. sca_out(0x10, msci + TRC0, card); /* = TXRDY/DMA activation condition*/
  410. sca_out(0x14, msci + TRC1, card); /* +1=TXRDY/DMA deactiv condition */
  411. /* We're using the following interrupts:
  412. - TXINT (DMAC completed all transmisions, underrun or DCD change)
  413. - all DMA interrupts
  414. */
  415. sca_set_carrier(port);
  416. /* MSCI TX INT and RX INT A IRQ enable */
  417. sca_out(IE0_TXINT | IE0_RXINTA, msci + IE0, card);
  418. sca_out(IE1_UDRN | IE1_CDCD, msci + IE1, card);
  419. sca_out(sca_in(IER0, card) | (phy_node(port) ? 0xC0 : 0x0C),
  420. IER0, card); /* TXINT and RXINT */
  421. /* enable DMA IRQ */
  422. sca_out(sca_in(IER1, card) | (phy_node(port) ? 0xF0 : 0x0F),
  423. IER1, card);
  424. sca_out(port->tmc, msci + TMC, card); /* Restore registers */
  425. sca_out(port->rxs, msci + RXS, card);
  426. sca_out(port->txs, msci + TXS, card);
  427. sca_out(CMD_TX_ENABLE, msci + CMD, card);
  428. sca_out(CMD_RX_ENABLE, msci + CMD, card);
  429. netif_start_queue(dev);
  430. }
  431. static void sca_close(struct net_device *dev)
  432. {
  433. port_t *port = dev_to_port(dev);
  434. card_t* card = port_to_card(port);
  435. /* reset channel */
  436. sca_out(CMD_RESET, get_msci(port) + CMD, port_to_card(port));
  437. /* disable MSCI interrupts */
  438. sca_out(sca_in(IER0, card) & (phy_node(port) ? 0x0F : 0xF0),
  439. IER0, card);
  440. /* disable DMA interrupts */
  441. sca_out(sca_in(IER1, card) & (phy_node(port) ? 0x0F : 0xF0),
  442. IER1, card);
  443. netif_stop_queue(dev);
  444. }
  445. static int sca_attach(struct net_device *dev, unsigned short encoding,
  446. unsigned short parity)
  447. {
  448. if (encoding != ENCODING_NRZ &&
  449. encoding != ENCODING_NRZI &&
  450. encoding != ENCODING_FM_MARK &&
  451. encoding != ENCODING_FM_SPACE &&
  452. encoding != ENCODING_MANCHESTER)
  453. return -EINVAL;
  454. if (parity != PARITY_NONE &&
  455. parity != PARITY_CRC16_PR0 &&
  456. parity != PARITY_CRC16_PR1 &&
  457. parity != PARITY_CRC16_PR0_CCITT &&
  458. parity != PARITY_CRC16_PR1_CCITT)
  459. return -EINVAL;
  460. dev_to_port(dev)->encoding = encoding;
  461. dev_to_port(dev)->parity = parity;
  462. return 0;
  463. }
  464. #ifdef DEBUG_RINGS
  465. static void sca_dump_rings(struct net_device *dev)
  466. {
  467. port_t *port = dev_to_port(dev);
  468. card_t *card = port_to_card(port);
  469. u16 cnt;
  470. #ifndef PAGE0_ALWAYS_MAPPED
  471. u8 page = sca_get_page(card);
  472. openwin(card, 0);
  473. #endif
  474. printk(KERN_DEBUG "RX ring: CDA=%u EDA=%u DSR=%02X in=%u %sactive",
  475. sca_inw(get_dmac_rx(port) + CDAL, card),
  476. sca_inw(get_dmac_rx(port) + EDAL, card),
  477. sca_in(DSR_RX(phy_node(port)), card), port->rxin,
  478. sca_in(DSR_RX(phy_node(port)), card) & DSR_DE ? "" : "in");
  479. for (cnt = 0; cnt < port_to_card(port)->rx_ring_buffers; cnt++)
  480. printk(" %02X", readb(&(desc_address(port, cnt, 0)->stat)));
  481. printk(KERN_CONT "\n");
  482. printk(KERN_DEBUG "TX ring: CDA=%u EDA=%u DSR=%02X in=%u "
  483. "last=%u %sactive",
  484. sca_inw(get_dmac_tx(port) + CDAL, card),
  485. sca_inw(get_dmac_tx(port) + EDAL, card),
  486. sca_in(DSR_TX(phy_node(port)), card), port->txin, port->txlast,
  487. sca_in(DSR_TX(phy_node(port)), card) & DSR_DE ? "" : "in");
  488. for (cnt = 0; cnt < port_to_card(port)->tx_ring_buffers; cnt++)
  489. printk(" %02X", readb(&(desc_address(port, cnt, 1)->stat)));
  490. printk("\n");
  491. printk(KERN_DEBUG "MSCI: MD: %02x %02x %02x, ST: %02x %02x %02x %02x,"
  492. " FST: %02x CST: %02x %02x\n",
  493. sca_in(get_msci(port) + MD0, card),
  494. sca_in(get_msci(port) + MD1, card),
  495. sca_in(get_msci(port) + MD2, card),
  496. sca_in(get_msci(port) + ST0, card),
  497. sca_in(get_msci(port) + ST1, card),
  498. sca_in(get_msci(port) + ST2, card),
  499. sca_in(get_msci(port) + ST3, card),
  500. sca_in(get_msci(port) + FST, card),
  501. sca_in(get_msci(port) + CST0, card),
  502. sca_in(get_msci(port) + CST1, card));
  503. printk(KERN_DEBUG "ISR: %02x %02x %02x\n", sca_in(ISR0, card),
  504. sca_in(ISR1, card), sca_in(ISR2, card));
  505. #ifndef PAGE0_ALWAYS_MAPPED
  506. openwin(card, page); /* Restore original page */
  507. #endif
  508. }
  509. #endif /* DEBUG_RINGS */
  510. static netdev_tx_t sca_xmit(struct sk_buff *skb, struct net_device *dev)
  511. {
  512. port_t *port = dev_to_port(dev);
  513. card_t *card = port_to_card(port);
  514. pkt_desc __iomem *desc;
  515. u32 buff, len;
  516. u8 page;
  517. u32 maxlen;
  518. spin_lock_irq(&port->lock);
  519. desc = desc_address(port, port->txin + 1, 1);
  520. BUG_ON(readb(&desc->stat)); /* previous xmit should stop queue */
  521. #ifdef DEBUG_PKT
  522. printk(KERN_DEBUG "%s TX(%i):", dev->name, skb->len);
  523. debug_frame(skb);
  524. #endif
  525. desc = desc_address(port, port->txin, 1);
  526. buff = buffer_offset(port, port->txin, 1);
  527. len = skb->len;
  528. page = buff / winsize(card);
  529. buff = buff % winsize(card);
  530. maxlen = winsize(card) - buff;
  531. openwin(card, page);
  532. if (len > maxlen) {
  533. memcpy_toio(winbase(card) + buff, skb->data, maxlen);
  534. openwin(card, page + 1);
  535. memcpy_toio(winbase(card), skb->data + maxlen, len - maxlen);
  536. } else
  537. memcpy_toio(winbase(card) + buff, skb->data, len);
  538. #ifndef PAGE0_ALWAYS_MAPPED
  539. openwin(card, 0); /* select pkt_desc table page back */
  540. #endif
  541. writew(len, &desc->len);
  542. writeb(ST_TX_EOM, &desc->stat);
  543. port->txin = next_desc(port, port->txin, 1);
  544. sca_outw(desc_offset(port, port->txin, 1),
  545. get_dmac_tx(port) + EDAL, card);
  546. sca_out(DSR_DE, DSR_TX(phy_node(port)), card); /* Enable TX DMA */
  547. desc = desc_address(port, port->txin + 1, 1);
  548. if (readb(&desc->stat)) /* allow 1 packet gap */
  549. netif_stop_queue(dev);
  550. spin_unlock_irq(&port->lock);
  551. dev_kfree_skb(skb);
  552. return NETDEV_TX_OK;
  553. }
  554. #ifdef NEED_DETECT_RAM
  555. static u32 __devinit sca_detect_ram(card_t *card, u8 __iomem *rambase,
  556. u32 ramsize)
  557. {
  558. /* Round RAM size to 32 bits, fill from end to start */
  559. u32 i = ramsize &= ~3;
  560. u32 size = winsize(card);
  561. openwin(card, (i - 4) / size); /* select last window */
  562. do {
  563. i -= 4;
  564. if ((i + 4) % size == 0)
  565. openwin(card, i / size);
  566. writel(i ^ 0x12345678, rambase + i % size);
  567. } while (i > 0);
  568. for (i = 0; i < ramsize ; i += 4) {
  569. if (i % size == 0)
  570. openwin(card, i / size);
  571. if (readl(rambase + i % size) != (i ^ 0x12345678))
  572. break;
  573. }
  574. return i;
  575. }
  576. #endif /* NEED_DETECT_RAM */
  577. static void __devinit sca_init(card_t *card, int wait_states)
  578. {
  579. sca_out(wait_states, WCRL, card); /* Wait Control */
  580. sca_out(wait_states, WCRM, card);
  581. sca_out(wait_states, WCRH, card);
  582. sca_out(0, DMER, card); /* DMA Master disable */
  583. sca_out(0x03, PCR, card); /* DMA priority */
  584. sca_out(0, DSR_RX(0), card); /* DMA disable - to halt state */
  585. sca_out(0, DSR_TX(0), card);
  586. sca_out(0, DSR_RX(1), card);
  587. sca_out(0, DSR_TX(1), card);
  588. sca_out(DMER_DME, DMER, card); /* DMA Master enable */
  589. }