serial_txx9.c 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223
  1. /*
  2. * drivers/serial/serial_txx9.c
  3. *
  4. * Derived from many drivers using generic_serial interface,
  5. * especially serial_tx3912.c by Steven J. Hill and r39xx_serial.c
  6. * (was in Linux/VR tree) by Jim Pick.
  7. *
  8. * Copyright (C) 1999 Harald Koerfgen
  9. * Copyright (C) 2000 Jim Pick <jim@jimpick.com>
  10. * Copyright (C) 2001 Steven J. Hill (sjhill@realitydiluted.com)
  11. * Copyright (C) 2000-2002 Toshiba Corporation
  12. *
  13. * This program is free software; you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License version 2 as
  15. * published by the Free Software Foundation.
  16. *
  17. * Serial driver for TX3927/TX4927/TX4925/TX4938 internal SIO controller
  18. *
  19. * Revision History:
  20. * 0.30 Initial revision. (Renamed from serial_txx927.c)
  21. * 0.31 Use save_flags instead of local_irq_save.
  22. * 0.32 Support SCLK.
  23. * 0.33 Switch TXX9_TTY_NAME by CONFIG_SERIAL_TXX9_STDSERIAL.
  24. * Support TIOCSERGETLSR.
  25. * 0.34 Support slow baudrate.
  26. * 0.40 Merge codes from mainstream kernel (2.4.22).
  27. * 0.41 Fix console checking in rs_shutdown_port().
  28. * Disable flow-control in serial_console_write().
  29. * 0.42 Fix minor compiler warning.
  30. * 1.00 Kernel 2.6. Converted to new serial core (based on 8250.c).
  31. * 1.01 Set fifosize to make tx_empry called properly.
  32. * Use standard uart_get_divisor.
  33. * 1.02 Cleanup. (import 8250.c changes)
  34. * 1.03 Fix low-latency mode. (import 8250.c changes)
  35. * 1.04 Remove usage of deprecated functions, cleanup.
  36. */
  37. #include <linux/config.h>
  38. #if defined(CONFIG_SERIAL_TXX9_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
  39. #define SUPPORT_SYSRQ
  40. #endif
  41. #include <linux/module.h>
  42. #include <linux/ioport.h>
  43. #include <linux/init.h>
  44. #include <linux/console.h>
  45. #include <linux/sysrq.h>
  46. #include <linux/delay.h>
  47. #include <linux/device.h>
  48. #include <linux/pci.h>
  49. #include <linux/tty.h>
  50. #include <linux/tty_flip.h>
  51. #include <linux/serial_core.h>
  52. #include <linux/serial.h>
  53. #include <asm/io.h>
  54. #include <asm/irq.h>
  55. static char *serial_version = "1.04";
  56. static char *serial_name = "TX39/49 Serial driver";
  57. #define PASS_LIMIT 256
  58. #if !defined(CONFIG_SERIAL_TXX9_STDSERIAL)
  59. /* "ttyS" is used for standard serial driver */
  60. #define TXX9_TTY_NAME "ttyTX"
  61. #define TXX9_TTY_DEVFS_NAME "tttx/"
  62. #define TXX9_TTY_MINOR_START (64 + 64) /* ttyTX0(128), ttyTX1(129) */
  63. #else
  64. /* acts like standard serial driver */
  65. #define TXX9_TTY_NAME "ttyS"
  66. #define TXX9_TTY_DEVFS_NAME "tts/"
  67. #define TXX9_TTY_MINOR_START 64
  68. #endif
  69. #define TXX9_TTY_MAJOR TTY_MAJOR
  70. /* flag aliases */
  71. #define UPF_TXX9_HAVE_CTS_LINE UPF_BUGGY_UART
  72. #define UPF_TXX9_USE_SCLK UPF_MAGIC_MULTIPLIER
  73. #ifdef CONFIG_PCI
  74. /* support for Toshiba TC86C001 SIO */
  75. #define ENABLE_SERIAL_TXX9_PCI
  76. #endif
  77. /*
  78. * Number of serial ports
  79. */
  80. #ifdef ENABLE_SERIAL_TXX9_PCI
  81. #define NR_PCI_BOARDS 4
  82. #define UART_NR (4 + NR_PCI_BOARDS)
  83. #else
  84. #define UART_NR 4
  85. #endif
  86. struct uart_txx9_port {
  87. struct uart_port port;
  88. /*
  89. * We provide a per-port pm hook.
  90. */
  91. void (*pm)(struct uart_port *port,
  92. unsigned int state, unsigned int old);
  93. };
  94. #define TXX9_REGION_SIZE 0x24
  95. /* TXX9 Serial Registers */
  96. #define TXX9_SILCR 0x00
  97. #define TXX9_SIDICR 0x04
  98. #define TXX9_SIDISR 0x08
  99. #define TXX9_SICISR 0x0c
  100. #define TXX9_SIFCR 0x10
  101. #define TXX9_SIFLCR 0x14
  102. #define TXX9_SIBGR 0x18
  103. #define TXX9_SITFIFO 0x1c
  104. #define TXX9_SIRFIFO 0x20
  105. /* SILCR : Line Control */
  106. #define TXX9_SILCR_SCS_MASK 0x00000060
  107. #define TXX9_SILCR_SCS_IMCLK 0x00000000
  108. #define TXX9_SILCR_SCS_IMCLK_BG 0x00000020
  109. #define TXX9_SILCR_SCS_SCLK 0x00000040
  110. #define TXX9_SILCR_SCS_SCLK_BG 0x00000060
  111. #define TXX9_SILCR_UEPS 0x00000010
  112. #define TXX9_SILCR_UPEN 0x00000008
  113. #define TXX9_SILCR_USBL_MASK 0x00000004
  114. #define TXX9_SILCR_USBL_1BIT 0x00000000
  115. #define TXX9_SILCR_USBL_2BIT 0x00000004
  116. #define TXX9_SILCR_UMODE_MASK 0x00000003
  117. #define TXX9_SILCR_UMODE_8BIT 0x00000000
  118. #define TXX9_SILCR_UMODE_7BIT 0x00000001
  119. /* SIDICR : DMA/Int. Control */
  120. #define TXX9_SIDICR_TDE 0x00008000
  121. #define TXX9_SIDICR_RDE 0x00004000
  122. #define TXX9_SIDICR_TIE 0x00002000
  123. #define TXX9_SIDICR_RIE 0x00001000
  124. #define TXX9_SIDICR_SPIE 0x00000800
  125. #define TXX9_SIDICR_CTSAC 0x00000600
  126. #define TXX9_SIDICR_STIE_MASK 0x0000003f
  127. #define TXX9_SIDICR_STIE_OERS 0x00000020
  128. #define TXX9_SIDICR_STIE_CTSS 0x00000010
  129. #define TXX9_SIDICR_STIE_RBRKD 0x00000008
  130. #define TXX9_SIDICR_STIE_TRDY 0x00000004
  131. #define TXX9_SIDICR_STIE_TXALS 0x00000002
  132. #define TXX9_SIDICR_STIE_UBRKD 0x00000001
  133. /* SIDISR : DMA/Int. Status */
  134. #define TXX9_SIDISR_UBRK 0x00008000
  135. #define TXX9_SIDISR_UVALID 0x00004000
  136. #define TXX9_SIDISR_UFER 0x00002000
  137. #define TXX9_SIDISR_UPER 0x00001000
  138. #define TXX9_SIDISR_UOER 0x00000800
  139. #define TXX9_SIDISR_ERI 0x00000400
  140. #define TXX9_SIDISR_TOUT 0x00000200
  141. #define TXX9_SIDISR_TDIS 0x00000100
  142. #define TXX9_SIDISR_RDIS 0x00000080
  143. #define TXX9_SIDISR_STIS 0x00000040
  144. #define TXX9_SIDISR_RFDN_MASK 0x0000001f
  145. /* SICISR : Change Int. Status */
  146. #define TXX9_SICISR_OERS 0x00000020
  147. #define TXX9_SICISR_CTSS 0x00000010
  148. #define TXX9_SICISR_RBRKD 0x00000008
  149. #define TXX9_SICISR_TRDY 0x00000004
  150. #define TXX9_SICISR_TXALS 0x00000002
  151. #define TXX9_SICISR_UBRKD 0x00000001
  152. /* SIFCR : FIFO Control */
  153. #define TXX9_SIFCR_SWRST 0x00008000
  154. #define TXX9_SIFCR_RDIL_MASK 0x00000180
  155. #define TXX9_SIFCR_RDIL_1 0x00000000
  156. #define TXX9_SIFCR_RDIL_4 0x00000080
  157. #define TXX9_SIFCR_RDIL_8 0x00000100
  158. #define TXX9_SIFCR_RDIL_12 0x00000180
  159. #define TXX9_SIFCR_RDIL_MAX 0x00000180
  160. #define TXX9_SIFCR_TDIL_MASK 0x00000018
  161. #define TXX9_SIFCR_TDIL_MASK 0x00000018
  162. #define TXX9_SIFCR_TDIL_1 0x00000000
  163. #define TXX9_SIFCR_TDIL_4 0x00000001
  164. #define TXX9_SIFCR_TDIL_8 0x00000010
  165. #define TXX9_SIFCR_TDIL_MAX 0x00000010
  166. #define TXX9_SIFCR_TFRST 0x00000004
  167. #define TXX9_SIFCR_RFRST 0x00000002
  168. #define TXX9_SIFCR_FRSTE 0x00000001
  169. #define TXX9_SIO_TX_FIFO 8
  170. #define TXX9_SIO_RX_FIFO 16
  171. /* SIFLCR : Flow Control */
  172. #define TXX9_SIFLCR_RCS 0x00001000
  173. #define TXX9_SIFLCR_TES 0x00000800
  174. #define TXX9_SIFLCR_RTSSC 0x00000200
  175. #define TXX9_SIFLCR_RSDE 0x00000100
  176. #define TXX9_SIFLCR_TSDE 0x00000080
  177. #define TXX9_SIFLCR_RTSTL_MASK 0x0000001e
  178. #define TXX9_SIFLCR_RTSTL_MAX 0x0000001e
  179. #define TXX9_SIFLCR_TBRK 0x00000001
  180. /* SIBGR : Baudrate Control */
  181. #define TXX9_SIBGR_BCLK_MASK 0x00000300
  182. #define TXX9_SIBGR_BCLK_T0 0x00000000
  183. #define TXX9_SIBGR_BCLK_T2 0x00000100
  184. #define TXX9_SIBGR_BCLK_T4 0x00000200
  185. #define TXX9_SIBGR_BCLK_T6 0x00000300
  186. #define TXX9_SIBGR_BRD_MASK 0x000000ff
  187. static inline unsigned int sio_in(struct uart_txx9_port *up, int offset)
  188. {
  189. switch (up->port.iotype) {
  190. default:
  191. return *(volatile u32 *)(up->port.membase + offset);
  192. case UPIO_PORT:
  193. return inl(up->port.iobase + offset);
  194. }
  195. }
  196. static inline void
  197. sio_out(struct uart_txx9_port *up, int offset, int value)
  198. {
  199. switch (up->port.iotype) {
  200. default:
  201. *(volatile u32 *)(up->port.membase + offset) = value;
  202. break;
  203. case UPIO_PORT:
  204. outl(value, up->port.iobase + offset);
  205. break;
  206. }
  207. }
  208. static inline void
  209. sio_mask(struct uart_txx9_port *up, int offset, unsigned int value)
  210. {
  211. sio_out(up, offset, sio_in(up, offset) & ~value);
  212. }
  213. static inline void
  214. sio_set(struct uart_txx9_port *up, int offset, unsigned int value)
  215. {
  216. sio_out(up, offset, sio_in(up, offset) | value);
  217. }
  218. static inline void
  219. sio_quot_set(struct uart_txx9_port *up, int quot)
  220. {
  221. quot >>= 1;
  222. if (quot < 256)
  223. sio_out(up, TXX9_SIBGR, quot | TXX9_SIBGR_BCLK_T0);
  224. else if (quot < (256 << 2))
  225. sio_out(up, TXX9_SIBGR, (quot >> 2) | TXX9_SIBGR_BCLK_T2);
  226. else if (quot < (256 << 4))
  227. sio_out(up, TXX9_SIBGR, (quot >> 4) | TXX9_SIBGR_BCLK_T4);
  228. else if (quot < (256 << 6))
  229. sio_out(up, TXX9_SIBGR, (quot >> 6) | TXX9_SIBGR_BCLK_T6);
  230. else
  231. sio_out(up, TXX9_SIBGR, 0xff | TXX9_SIBGR_BCLK_T6);
  232. }
  233. static void serial_txx9_stop_tx(struct uart_port *port)
  234. {
  235. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  236. unsigned long flags;
  237. spin_lock_irqsave(&up->port.lock, flags);
  238. sio_mask(up, TXX9_SIDICR, TXX9_SIDICR_TIE);
  239. spin_unlock_irqrestore(&up->port.lock, flags);
  240. }
  241. static void serial_txx9_start_tx(struct uart_port *port)
  242. {
  243. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  244. unsigned long flags;
  245. spin_lock_irqsave(&up->port.lock, flags);
  246. sio_set(up, TXX9_SIDICR, TXX9_SIDICR_TIE);
  247. spin_unlock_irqrestore(&up->port.lock, flags);
  248. }
  249. static void serial_txx9_stop_rx(struct uart_port *port)
  250. {
  251. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  252. unsigned long flags;
  253. spin_lock_irqsave(&up->port.lock, flags);
  254. up->port.read_status_mask &= ~TXX9_SIDISR_RDIS;
  255. #if 0
  256. sio_mask(up, TXX9_SIDICR, TXX9_SIDICR_RIE);
  257. #endif
  258. spin_unlock_irqrestore(&up->port.lock, flags);
  259. }
  260. static void serial_txx9_enable_ms(struct uart_port *port)
  261. {
  262. /* TXX9-SIO can not control DTR... */
  263. }
  264. static inline void
  265. receive_chars(struct uart_txx9_port *up, unsigned int *status, struct pt_regs *regs)
  266. {
  267. struct tty_struct *tty = up->port.info->tty;
  268. unsigned char ch;
  269. unsigned int disr = *status;
  270. int max_count = 256;
  271. char flag;
  272. do {
  273. /* The following is not allowed by the tty layer and
  274. unsafe. It should be fixed ASAP */
  275. if (unlikely(tty->flip.count >= TTY_FLIPBUF_SIZE)) {
  276. if (tty->low_latency) {
  277. spin_unlock(&up->port.lock);
  278. tty_flip_buffer_push(tty);
  279. spin_lock(&up->port.lock);
  280. }
  281. /* If this failed then we will throw away the
  282. bytes but must do so to clear interrupts */
  283. }
  284. ch = sio_in(up, TXX9_SIRFIFO);
  285. flag = TTY_NORMAL;
  286. up->port.icount.rx++;
  287. if (unlikely(disr & (TXX9_SIDISR_UBRK | TXX9_SIDISR_UPER |
  288. TXX9_SIDISR_UFER | TXX9_SIDISR_UOER))) {
  289. /*
  290. * For statistics only
  291. */
  292. if (disr & TXX9_SIDISR_UBRK) {
  293. disr &= ~(TXX9_SIDISR_UFER | TXX9_SIDISR_UPER);
  294. up->port.icount.brk++;
  295. /*
  296. * We do the SysRQ and SAK checking
  297. * here because otherwise the break
  298. * may get masked by ignore_status_mask
  299. * or read_status_mask.
  300. */
  301. if (uart_handle_break(&up->port))
  302. goto ignore_char;
  303. } else if (disr & TXX9_SIDISR_UPER)
  304. up->port.icount.parity++;
  305. else if (disr & TXX9_SIDISR_UFER)
  306. up->port.icount.frame++;
  307. if (disr & TXX9_SIDISR_UOER)
  308. up->port.icount.overrun++;
  309. /*
  310. * Mask off conditions which should be ingored.
  311. */
  312. disr &= up->port.read_status_mask;
  313. if (disr & TXX9_SIDISR_UBRK) {
  314. flag = TTY_BREAK;
  315. } else if (disr & TXX9_SIDISR_UPER)
  316. flag = TTY_PARITY;
  317. else if (disr & TXX9_SIDISR_UFER)
  318. flag = TTY_FRAME;
  319. }
  320. if (uart_handle_sysrq_char(&up->port, ch, regs))
  321. goto ignore_char;
  322. uart_insert_char(&up->port, disr, TXX9_SIDISR_UOER, ch, flag);
  323. ignore_char:
  324. disr = sio_in(up, TXX9_SIDISR);
  325. } while (!(disr & TXX9_SIDISR_UVALID) && (max_count-- > 0));
  326. spin_unlock(&up->port.lock);
  327. tty_flip_buffer_push(tty);
  328. spin_lock(&up->port.lock);
  329. *status = disr;
  330. }
  331. static inline void transmit_chars(struct uart_txx9_port *up)
  332. {
  333. struct circ_buf *xmit = &up->port.info->xmit;
  334. int count;
  335. if (up->port.x_char) {
  336. sio_out(up, TXX9_SITFIFO, up->port.x_char);
  337. up->port.icount.tx++;
  338. up->port.x_char = 0;
  339. return;
  340. }
  341. if (uart_circ_empty(xmit) || uart_tx_stopped(&up->port)) {
  342. serial_txx9_stop_tx(&up->port);
  343. return;
  344. }
  345. count = TXX9_SIO_TX_FIFO;
  346. do {
  347. sio_out(up, TXX9_SITFIFO, xmit->buf[xmit->tail]);
  348. xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
  349. up->port.icount.tx++;
  350. if (uart_circ_empty(xmit))
  351. break;
  352. } while (--count > 0);
  353. if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
  354. uart_write_wakeup(&up->port);
  355. if (uart_circ_empty(xmit))
  356. serial_txx9_stop_tx(&up->port);
  357. }
  358. static irqreturn_t serial_txx9_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  359. {
  360. int pass_counter = 0;
  361. struct uart_txx9_port *up = dev_id;
  362. unsigned int status;
  363. while (1) {
  364. spin_lock(&up->port.lock);
  365. status = sio_in(up, TXX9_SIDISR);
  366. if (!(sio_in(up, TXX9_SIDICR) & TXX9_SIDICR_TIE))
  367. status &= ~TXX9_SIDISR_TDIS;
  368. if (!(status & (TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS |
  369. TXX9_SIDISR_TOUT))) {
  370. spin_unlock(&up->port.lock);
  371. break;
  372. }
  373. if (status & TXX9_SIDISR_RDIS)
  374. receive_chars(up, &status, regs);
  375. if (status & TXX9_SIDISR_TDIS)
  376. transmit_chars(up);
  377. /* Clear TX/RX Int. Status */
  378. sio_mask(up, TXX9_SIDISR,
  379. TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS |
  380. TXX9_SIDISR_TOUT);
  381. spin_unlock(&up->port.lock);
  382. if (pass_counter++ > PASS_LIMIT)
  383. break;
  384. }
  385. return pass_counter ? IRQ_HANDLED : IRQ_NONE;
  386. }
  387. static unsigned int serial_txx9_tx_empty(struct uart_port *port)
  388. {
  389. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  390. unsigned long flags;
  391. unsigned int ret;
  392. spin_lock_irqsave(&up->port.lock, flags);
  393. ret = (sio_in(up, TXX9_SICISR) & TXX9_SICISR_TXALS) ? TIOCSER_TEMT : 0;
  394. spin_unlock_irqrestore(&up->port.lock, flags);
  395. return ret;
  396. }
  397. static unsigned int serial_txx9_get_mctrl(struct uart_port *port)
  398. {
  399. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  400. unsigned int ret;
  401. ret = ((sio_in(up, TXX9_SIFLCR) & TXX9_SIFLCR_RTSSC) ? 0 : TIOCM_RTS)
  402. | ((sio_in(up, TXX9_SICISR) & TXX9_SICISR_CTSS) ? 0 : TIOCM_CTS);
  403. return ret;
  404. }
  405. static void serial_txx9_set_mctrl(struct uart_port *port, unsigned int mctrl)
  406. {
  407. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  408. unsigned long flags;
  409. spin_lock_irqsave(&up->port.lock, flags);
  410. if (mctrl & TIOCM_RTS)
  411. sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSSC);
  412. else
  413. sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSSC);
  414. spin_unlock_irqrestore(&up->port.lock, flags);
  415. }
  416. static void serial_txx9_break_ctl(struct uart_port *port, int break_state)
  417. {
  418. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  419. unsigned long flags;
  420. spin_lock_irqsave(&up->port.lock, flags);
  421. if (break_state == -1)
  422. sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
  423. else
  424. sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
  425. spin_unlock_irqrestore(&up->port.lock, flags);
  426. }
  427. static int serial_txx9_startup(struct uart_port *port)
  428. {
  429. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  430. unsigned long flags;
  431. int retval;
  432. /*
  433. * Clear the FIFO buffers and disable them.
  434. * (they will be reeanbled in set_termios())
  435. */
  436. sio_set(up, TXX9_SIFCR,
  437. TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
  438. /* clear reset */
  439. sio_mask(up, TXX9_SIFCR,
  440. TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
  441. sio_out(up, TXX9_SIDICR, 0);
  442. /*
  443. * Clear the interrupt registers.
  444. */
  445. sio_out(up, TXX9_SIDISR, 0);
  446. retval = request_irq(up->port.irq, serial_txx9_interrupt,
  447. SA_SHIRQ, "serial_txx9", up);
  448. if (retval)
  449. return retval;
  450. /*
  451. * Now, initialize the UART
  452. */
  453. spin_lock_irqsave(&up->port.lock, flags);
  454. serial_txx9_set_mctrl(&up->port, up->port.mctrl);
  455. spin_unlock_irqrestore(&up->port.lock, flags);
  456. /* Enable RX/TX */
  457. sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_RSDE | TXX9_SIFLCR_TSDE);
  458. /*
  459. * Finally, enable interrupts.
  460. */
  461. sio_set(up, TXX9_SIDICR, TXX9_SIDICR_RIE);
  462. return 0;
  463. }
  464. static void serial_txx9_shutdown(struct uart_port *port)
  465. {
  466. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  467. unsigned long flags;
  468. /*
  469. * Disable interrupts from this port
  470. */
  471. sio_out(up, TXX9_SIDICR, 0); /* disable all intrs */
  472. spin_lock_irqsave(&up->port.lock, flags);
  473. serial_txx9_set_mctrl(&up->port, up->port.mctrl);
  474. spin_unlock_irqrestore(&up->port.lock, flags);
  475. /*
  476. * Disable break condition
  477. */
  478. sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
  479. #ifdef CONFIG_SERIAL_TXX9_CONSOLE
  480. if (up->port.cons && up->port.line == up->port.cons->index) {
  481. free_irq(up->port.irq, up);
  482. return;
  483. }
  484. #endif
  485. /* reset FIFOs */
  486. sio_set(up, TXX9_SIFCR,
  487. TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
  488. /* clear reset */
  489. sio_mask(up, TXX9_SIFCR,
  490. TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
  491. /* Disable RX/TX */
  492. sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_RSDE | TXX9_SIFLCR_TSDE);
  493. free_irq(up->port.irq, up);
  494. }
  495. static void
  496. serial_txx9_set_termios(struct uart_port *port, struct termios *termios,
  497. struct termios *old)
  498. {
  499. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  500. unsigned int cval, fcr = 0;
  501. unsigned long flags;
  502. unsigned int baud, quot;
  503. cval = sio_in(up, TXX9_SILCR);
  504. /* byte size and parity */
  505. cval &= ~TXX9_SILCR_UMODE_MASK;
  506. switch (termios->c_cflag & CSIZE) {
  507. case CS7:
  508. cval |= TXX9_SILCR_UMODE_7BIT;
  509. break;
  510. default:
  511. case CS5: /* not supported */
  512. case CS6: /* not supported */
  513. case CS8:
  514. cval |= TXX9_SILCR_UMODE_8BIT;
  515. break;
  516. }
  517. cval &= ~TXX9_SILCR_USBL_MASK;
  518. if (termios->c_cflag & CSTOPB)
  519. cval |= TXX9_SILCR_USBL_2BIT;
  520. else
  521. cval |= TXX9_SILCR_USBL_1BIT;
  522. cval &= ~(TXX9_SILCR_UPEN | TXX9_SILCR_UEPS);
  523. if (termios->c_cflag & PARENB)
  524. cval |= TXX9_SILCR_UPEN;
  525. if (!(termios->c_cflag & PARODD))
  526. cval |= TXX9_SILCR_UEPS;
  527. /*
  528. * Ask the core to calculate the divisor for us.
  529. */
  530. baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16/2);
  531. quot = uart_get_divisor(port, baud);
  532. /* Set up FIFOs */
  533. /* TX Int by FIFO Empty, RX Int by Receiving 1 char. */
  534. fcr = TXX9_SIFCR_TDIL_MAX | TXX9_SIFCR_RDIL_1;
  535. /*
  536. * Ok, we're now changing the port state. Do it with
  537. * interrupts disabled.
  538. */
  539. spin_lock_irqsave(&up->port.lock, flags);
  540. /*
  541. * Update the per-port timeout.
  542. */
  543. uart_update_timeout(port, termios->c_cflag, baud);
  544. up->port.read_status_mask = TXX9_SIDISR_UOER |
  545. TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS;
  546. if (termios->c_iflag & INPCK)
  547. up->port.read_status_mask |= TXX9_SIDISR_UFER | TXX9_SIDISR_UPER;
  548. if (termios->c_iflag & (BRKINT | PARMRK))
  549. up->port.read_status_mask |= TXX9_SIDISR_UBRK;
  550. /*
  551. * Characteres to ignore
  552. */
  553. up->port.ignore_status_mask = 0;
  554. if (termios->c_iflag & IGNPAR)
  555. up->port.ignore_status_mask |= TXX9_SIDISR_UPER | TXX9_SIDISR_UFER;
  556. if (termios->c_iflag & IGNBRK) {
  557. up->port.ignore_status_mask |= TXX9_SIDISR_UBRK;
  558. /*
  559. * If we're ignoring parity and break indicators,
  560. * ignore overruns too (for real raw support).
  561. */
  562. if (termios->c_iflag & IGNPAR)
  563. up->port.ignore_status_mask |= TXX9_SIDISR_UOER;
  564. }
  565. /*
  566. * ignore all characters if CREAD is not set
  567. */
  568. if ((termios->c_cflag & CREAD) == 0)
  569. up->port.ignore_status_mask |= TXX9_SIDISR_RDIS;
  570. /* CTS flow control flag */
  571. if ((termios->c_cflag & CRTSCTS) &&
  572. (up->port.flags & UPF_TXX9_HAVE_CTS_LINE)) {
  573. sio_set(up, TXX9_SIFLCR,
  574. TXX9_SIFLCR_RCS | TXX9_SIFLCR_TES);
  575. } else {
  576. sio_mask(up, TXX9_SIFLCR,
  577. TXX9_SIFLCR_RCS | TXX9_SIFLCR_TES);
  578. }
  579. sio_out(up, TXX9_SILCR, cval);
  580. sio_quot_set(up, quot);
  581. sio_out(up, TXX9_SIFCR, fcr);
  582. serial_txx9_set_mctrl(&up->port, up->port.mctrl);
  583. spin_unlock_irqrestore(&up->port.lock, flags);
  584. }
  585. static void
  586. serial_txx9_pm(struct uart_port *port, unsigned int state,
  587. unsigned int oldstate)
  588. {
  589. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  590. if (up->pm)
  591. up->pm(port, state, oldstate);
  592. }
  593. static int serial_txx9_request_resource(struct uart_txx9_port *up)
  594. {
  595. unsigned int size = TXX9_REGION_SIZE;
  596. int ret = 0;
  597. switch (up->port.iotype) {
  598. default:
  599. if (!up->port.mapbase)
  600. break;
  601. if (!request_mem_region(up->port.mapbase, size, "serial_txx9")) {
  602. ret = -EBUSY;
  603. break;
  604. }
  605. if (up->port.flags & UPF_IOREMAP) {
  606. up->port.membase = ioremap(up->port.mapbase, size);
  607. if (!up->port.membase) {
  608. release_mem_region(up->port.mapbase, size);
  609. ret = -ENOMEM;
  610. }
  611. }
  612. break;
  613. case UPIO_PORT:
  614. if (!request_region(up->port.iobase, size, "serial_txx9"))
  615. ret = -EBUSY;
  616. break;
  617. }
  618. return ret;
  619. }
  620. static void serial_txx9_release_resource(struct uart_txx9_port *up)
  621. {
  622. unsigned int size = TXX9_REGION_SIZE;
  623. switch (up->port.iotype) {
  624. default:
  625. if (!up->port.mapbase)
  626. break;
  627. if (up->port.flags & UPF_IOREMAP) {
  628. iounmap(up->port.membase);
  629. up->port.membase = NULL;
  630. }
  631. release_mem_region(up->port.mapbase, size);
  632. break;
  633. case UPIO_PORT:
  634. release_region(up->port.iobase, size);
  635. break;
  636. }
  637. }
  638. static void serial_txx9_release_port(struct uart_port *port)
  639. {
  640. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  641. serial_txx9_release_resource(up);
  642. }
  643. static int serial_txx9_request_port(struct uart_port *port)
  644. {
  645. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  646. return serial_txx9_request_resource(up);
  647. }
  648. static void serial_txx9_config_port(struct uart_port *port, int uflags)
  649. {
  650. struct uart_txx9_port *up = (struct uart_txx9_port *)port;
  651. unsigned long flags;
  652. int ret;
  653. /*
  654. * Find the region that we can probe for. This in turn
  655. * tells us whether we can probe for the type of port.
  656. */
  657. ret = serial_txx9_request_resource(up);
  658. if (ret < 0)
  659. return;
  660. port->type = PORT_TXX9;
  661. up->port.fifosize = TXX9_SIO_TX_FIFO;
  662. #ifdef CONFIG_SERIAL_TXX9_CONSOLE
  663. if (up->port.line == up->port.cons->index)
  664. return;
  665. #endif
  666. spin_lock_irqsave(&up->port.lock, flags);
  667. /*
  668. * Reset the UART.
  669. */
  670. sio_out(up, TXX9_SIFCR, TXX9_SIFCR_SWRST);
  671. #ifdef CONFIG_CPU_TX49XX
  672. /* TX4925 BUG WORKAROUND. Accessing SIOC register
  673. * immediately after soft reset causes bus error. */
  674. iob();
  675. udelay(1);
  676. #endif
  677. while (sio_in(up, TXX9_SIFCR) & TXX9_SIFCR_SWRST)
  678. ;
  679. /* TX Int by FIFO Empty, RX Int by Receiving 1 char. */
  680. sio_set(up, TXX9_SIFCR,
  681. TXX9_SIFCR_TDIL_MAX | TXX9_SIFCR_RDIL_1);
  682. /* initial settings */
  683. sio_out(up, TXX9_SILCR,
  684. TXX9_SILCR_UMODE_8BIT | TXX9_SILCR_USBL_1BIT |
  685. ((up->port.flags & UPF_TXX9_USE_SCLK) ?
  686. TXX9_SILCR_SCS_SCLK_BG : TXX9_SILCR_SCS_IMCLK_BG));
  687. sio_quot_set(up, uart_get_divisor(port, 9600));
  688. sio_out(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSTL_MAX /* 15 */);
  689. spin_unlock_irqrestore(&up->port.lock, flags);
  690. }
  691. static int
  692. serial_txx9_verify_port(struct uart_port *port, struct serial_struct *ser)
  693. {
  694. if (ser->irq < 0 ||
  695. ser->baud_base < 9600 || ser->type != PORT_TXX9)
  696. return -EINVAL;
  697. return 0;
  698. }
  699. static const char *
  700. serial_txx9_type(struct uart_port *port)
  701. {
  702. return "txx9";
  703. }
  704. static struct uart_ops serial_txx9_pops = {
  705. .tx_empty = serial_txx9_tx_empty,
  706. .set_mctrl = serial_txx9_set_mctrl,
  707. .get_mctrl = serial_txx9_get_mctrl,
  708. .stop_tx = serial_txx9_stop_tx,
  709. .start_tx = serial_txx9_start_tx,
  710. .stop_rx = serial_txx9_stop_rx,
  711. .enable_ms = serial_txx9_enable_ms,
  712. .break_ctl = serial_txx9_break_ctl,
  713. .startup = serial_txx9_startup,
  714. .shutdown = serial_txx9_shutdown,
  715. .set_termios = serial_txx9_set_termios,
  716. .pm = serial_txx9_pm,
  717. .type = serial_txx9_type,
  718. .release_port = serial_txx9_release_port,
  719. .request_port = serial_txx9_request_port,
  720. .config_port = serial_txx9_config_port,
  721. .verify_port = serial_txx9_verify_port,
  722. };
  723. static struct uart_txx9_port serial_txx9_ports[UART_NR];
  724. static void __init serial_txx9_register_ports(struct uart_driver *drv)
  725. {
  726. int i;
  727. for (i = 0; i < UART_NR; i++) {
  728. struct uart_txx9_port *up = &serial_txx9_ports[i];
  729. up->port.line = i;
  730. up->port.ops = &serial_txx9_pops;
  731. uart_add_one_port(drv, &up->port);
  732. }
  733. }
  734. #ifdef CONFIG_SERIAL_TXX9_CONSOLE
  735. /*
  736. * Wait for transmitter & holding register to empty
  737. */
  738. static inline void wait_for_xmitr(struct uart_txx9_port *up)
  739. {
  740. unsigned int tmout = 10000;
  741. /* Wait up to 10ms for the character(s) to be sent. */
  742. while (--tmout &&
  743. !(sio_in(up, TXX9_SICISR) & TXX9_SICISR_TXALS))
  744. udelay(1);
  745. /* Wait up to 1s for flow control if necessary */
  746. if (up->port.flags & UPF_CONS_FLOW) {
  747. tmout = 1000000;
  748. while (--tmout &&
  749. (sio_in(up, TXX9_SICISR) & TXX9_SICISR_CTSS))
  750. udelay(1);
  751. }
  752. }
  753. /*
  754. * Print a string to the serial port trying not to disturb
  755. * any possible real use of the port...
  756. *
  757. * The console_lock must be held when we get here.
  758. */
  759. static void
  760. serial_txx9_console_write(struct console *co, const char *s, unsigned int count)
  761. {
  762. struct uart_txx9_port *up = &serial_txx9_ports[co->index];
  763. unsigned int ier, flcr;
  764. int i;
  765. /*
  766. * First save the UER then disable the interrupts
  767. */
  768. ier = sio_in(up, TXX9_SIDICR);
  769. sio_out(up, TXX9_SIDICR, 0);
  770. /*
  771. * Disable flow-control if enabled (and unnecessary)
  772. */
  773. flcr = sio_in(up, TXX9_SIFLCR);
  774. if (!(up->port.flags & UPF_CONS_FLOW) && (flcr & TXX9_SIFLCR_TES))
  775. sio_out(up, TXX9_SIFLCR, flcr & ~TXX9_SIFLCR_TES);
  776. /*
  777. * Now, do each character
  778. */
  779. for (i = 0; i < count; i++, s++) {
  780. wait_for_xmitr(up);
  781. /*
  782. * Send the character out.
  783. * If a LF, also do CR...
  784. */
  785. sio_out(up, TXX9_SITFIFO, *s);
  786. if (*s == 10) {
  787. wait_for_xmitr(up);
  788. sio_out(up, TXX9_SITFIFO, 13);
  789. }
  790. }
  791. /*
  792. * Finally, wait for transmitter to become empty
  793. * and restore the IER
  794. */
  795. wait_for_xmitr(up);
  796. sio_out(up, TXX9_SIFLCR, flcr);
  797. sio_out(up, TXX9_SIDICR, ier);
  798. }
  799. static int serial_txx9_console_setup(struct console *co, char *options)
  800. {
  801. struct uart_port *port;
  802. struct uart_txx9_port *up;
  803. int baud = 9600;
  804. int bits = 8;
  805. int parity = 'n';
  806. int flow = 'n';
  807. /*
  808. * Check whether an invalid uart number has been specified, and
  809. * if so, search for the first available port that does have
  810. * console support.
  811. */
  812. if (co->index >= UART_NR)
  813. co->index = 0;
  814. up = &serial_txx9_ports[co->index];
  815. port = &up->port;
  816. if (!port->ops)
  817. return -ENODEV;
  818. /*
  819. * Temporary fix.
  820. */
  821. spin_lock_init(&port->lock);
  822. /*
  823. * Disable UART interrupts, set DTR and RTS high
  824. * and set speed.
  825. */
  826. sio_out(up, TXX9_SIDICR, 0);
  827. /* initial settings */
  828. sio_out(up, TXX9_SILCR,
  829. TXX9_SILCR_UMODE_8BIT | TXX9_SILCR_USBL_1BIT |
  830. ((port->flags & UPF_TXX9_USE_SCLK) ?
  831. TXX9_SILCR_SCS_SCLK_BG : TXX9_SILCR_SCS_IMCLK_BG));
  832. sio_out(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSTL_MAX /* 15 */);
  833. if (options)
  834. uart_parse_options(options, &baud, &parity, &bits, &flow);
  835. return uart_set_options(port, co, baud, parity, bits, flow);
  836. }
  837. static struct uart_driver serial_txx9_reg;
  838. static struct console serial_txx9_console = {
  839. .name = TXX9_TTY_NAME,
  840. .write = serial_txx9_console_write,
  841. .device = uart_console_device,
  842. .setup = serial_txx9_console_setup,
  843. .flags = CON_PRINTBUFFER,
  844. .index = -1,
  845. .data = &serial_txx9_reg,
  846. };
  847. static int __init serial_txx9_console_init(void)
  848. {
  849. register_console(&serial_txx9_console);
  850. return 0;
  851. }
  852. console_initcall(serial_txx9_console_init);
  853. #define SERIAL_TXX9_CONSOLE &serial_txx9_console
  854. #else
  855. #define SERIAL_TXX9_CONSOLE NULL
  856. #endif
  857. static struct uart_driver serial_txx9_reg = {
  858. .owner = THIS_MODULE,
  859. .driver_name = "serial_txx9",
  860. .devfs_name = TXX9_TTY_DEVFS_NAME,
  861. .dev_name = TXX9_TTY_NAME,
  862. .major = TXX9_TTY_MAJOR,
  863. .minor = TXX9_TTY_MINOR_START,
  864. .nr = UART_NR,
  865. .cons = SERIAL_TXX9_CONSOLE,
  866. };
  867. int __init early_serial_txx9_setup(struct uart_port *port)
  868. {
  869. if (port->line >= ARRAY_SIZE(serial_txx9_ports))
  870. return -ENODEV;
  871. serial_txx9_ports[port->line].port = *port;
  872. serial_txx9_ports[port->line].port.ops = &serial_txx9_pops;
  873. serial_txx9_ports[port->line].port.flags |= UPF_BOOT_AUTOCONF;
  874. return 0;
  875. }
  876. #ifdef ENABLE_SERIAL_TXX9_PCI
  877. /**
  878. * serial_txx9_suspend_port - suspend one serial port
  879. * @line: serial line number
  880. * @level: the level of port suspension, as per uart_suspend_port
  881. *
  882. * Suspend one serial port.
  883. */
  884. static void serial_txx9_suspend_port(int line)
  885. {
  886. uart_suspend_port(&serial_txx9_reg, &serial_txx9_ports[line].port);
  887. }
  888. /**
  889. * serial_txx9_resume_port - resume one serial port
  890. * @line: serial line number
  891. * @level: the level of port resumption, as per uart_resume_port
  892. *
  893. * Resume one serial port.
  894. */
  895. static void serial_txx9_resume_port(int line)
  896. {
  897. uart_resume_port(&serial_txx9_reg, &serial_txx9_ports[line].port);
  898. }
  899. static DECLARE_MUTEX(serial_txx9_sem);
  900. /**
  901. * serial_txx9_register_port - register a serial port
  902. * @port: serial port template
  903. *
  904. * Configure the serial port specified by the request.
  905. *
  906. * The port is then probed and if necessary the IRQ is autodetected
  907. * If this fails an error is returned.
  908. *
  909. * On success the port is ready to use and the line number is returned.
  910. */
  911. static int __devinit serial_txx9_register_port(struct uart_port *port)
  912. {
  913. int i;
  914. struct uart_txx9_port *uart;
  915. int ret = -ENOSPC;
  916. down(&serial_txx9_sem);
  917. for (i = 0; i < UART_NR; i++) {
  918. uart = &serial_txx9_ports[i];
  919. if (uart->port.type == PORT_UNKNOWN)
  920. break;
  921. }
  922. if (i < UART_NR) {
  923. uart_remove_one_port(&serial_txx9_reg, &uart->port);
  924. uart->port.iobase = port->iobase;
  925. uart->port.membase = port->membase;
  926. uart->port.irq = port->irq;
  927. uart->port.uartclk = port->uartclk;
  928. uart->port.iotype = port->iotype;
  929. uart->port.flags = port->flags | UPF_BOOT_AUTOCONF;
  930. uart->port.mapbase = port->mapbase;
  931. if (port->dev)
  932. uart->port.dev = port->dev;
  933. ret = uart_add_one_port(&serial_txx9_reg, &uart->port);
  934. if (ret == 0)
  935. ret = uart->port.line;
  936. }
  937. up(&serial_txx9_sem);
  938. return ret;
  939. }
  940. /**
  941. * serial_txx9_unregister_port - remove a txx9 serial port at runtime
  942. * @line: serial line number
  943. *
  944. * Remove one serial port. This may not be called from interrupt
  945. * context. We hand the port back to the our control.
  946. */
  947. static void __devexit serial_txx9_unregister_port(int line)
  948. {
  949. struct uart_txx9_port *uart = &serial_txx9_ports[line];
  950. down(&serial_txx9_sem);
  951. uart_remove_one_port(&serial_txx9_reg, &uart->port);
  952. uart->port.flags = 0;
  953. uart->port.type = PORT_UNKNOWN;
  954. uart->port.iobase = 0;
  955. uart->port.mapbase = 0;
  956. uart->port.membase = 0;
  957. uart->port.dev = NULL;
  958. uart_add_one_port(&serial_txx9_reg, &uart->port);
  959. up(&serial_txx9_sem);
  960. }
  961. /*
  962. * Probe one serial board. Unfortunately, there is no rhyme nor reason
  963. * to the arrangement of serial ports on a PCI card.
  964. */
  965. static int __devinit
  966. pciserial_txx9_init_one(struct pci_dev *dev, const struct pci_device_id *ent)
  967. {
  968. struct uart_port port;
  969. int line;
  970. int rc;
  971. rc = pci_enable_device(dev);
  972. if (rc)
  973. return rc;
  974. memset(&port, 0, sizeof(port));
  975. port.ops = &serial_txx9_pops;
  976. port.flags |= UPF_TXX9_HAVE_CTS_LINE;
  977. port.uartclk = 66670000;
  978. port.irq = dev->irq;
  979. port.iotype = UPIO_PORT;
  980. port.iobase = pci_resource_start(dev, 1);
  981. port.dev = &dev->dev;
  982. line = serial_txx9_register_port(&port);
  983. if (line < 0) {
  984. printk(KERN_WARNING "Couldn't register serial port %s: %d\n", pci_name(dev), line);
  985. }
  986. pci_set_drvdata(dev, (void *)(long)line);
  987. return 0;
  988. }
  989. static void __devexit pciserial_txx9_remove_one(struct pci_dev *dev)
  990. {
  991. int line = (int)(long)pci_get_drvdata(dev);
  992. pci_set_drvdata(dev, NULL);
  993. if (line) {
  994. serial_txx9_unregister_port(line);
  995. pci_disable_device(dev);
  996. }
  997. }
  998. static int pciserial_txx9_suspend_one(struct pci_dev *dev, pm_message_t state)
  999. {
  1000. int line = (int)(long)pci_get_drvdata(dev);
  1001. if (line)
  1002. serial_txx9_suspend_port(line);
  1003. pci_save_state(dev);
  1004. pci_set_power_state(dev, pci_choose_state(dev, state));
  1005. return 0;
  1006. }
  1007. static int pciserial_txx9_resume_one(struct pci_dev *dev)
  1008. {
  1009. int line = (int)(long)pci_get_drvdata(dev);
  1010. pci_set_power_state(dev, PCI_D0);
  1011. pci_restore_state(dev);
  1012. if (line) {
  1013. pci_enable_device(dev);
  1014. serial_txx9_resume_port(line);
  1015. }
  1016. return 0;
  1017. }
  1018. static struct pci_device_id serial_txx9_pci_tbl[] = {
  1019. { PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC86C001_MISC,
  1020. PCI_ANY_ID, PCI_ANY_ID,
  1021. 0, 0, 0 },
  1022. { 0, }
  1023. };
  1024. static struct pci_driver serial_txx9_pci_driver = {
  1025. .name = "serial_txx9",
  1026. .probe = pciserial_txx9_init_one,
  1027. .remove = __devexit_p(pciserial_txx9_remove_one),
  1028. .suspend = pciserial_txx9_suspend_one,
  1029. .resume = pciserial_txx9_resume_one,
  1030. .id_table = serial_txx9_pci_tbl,
  1031. };
  1032. MODULE_DEVICE_TABLE(pci, serial_txx9_pci_tbl);
  1033. #endif /* ENABLE_SERIAL_TXX9_PCI */
  1034. static int __init serial_txx9_init(void)
  1035. {
  1036. int ret;
  1037. printk(KERN_INFO "%s version %s\n", serial_name, serial_version);
  1038. ret = uart_register_driver(&serial_txx9_reg);
  1039. if (ret >= 0) {
  1040. serial_txx9_register_ports(&serial_txx9_reg);
  1041. #ifdef ENABLE_SERIAL_TXX9_PCI
  1042. ret = pci_module_init(&serial_txx9_pci_driver);
  1043. #endif
  1044. }
  1045. return ret;
  1046. }
  1047. static void __exit serial_txx9_exit(void)
  1048. {
  1049. int i;
  1050. #ifdef ENABLE_SERIAL_TXX9_PCI
  1051. pci_unregister_driver(&serial_txx9_pci_driver);
  1052. #endif
  1053. for (i = 0; i < UART_NR; i++)
  1054. uart_remove_one_port(&serial_txx9_reg, &serial_txx9_ports[i].port);
  1055. uart_unregister_driver(&serial_txx9_reg);
  1056. }
  1057. module_init(serial_txx9_init);
  1058. module_exit(serial_txx9_exit);
  1059. MODULE_LICENSE("GPL");
  1060. MODULE_DESCRIPTION("TX39/49 serial driver");
  1061. MODULE_ALIAS_CHARDEV_MAJOR(TXX9_TTY_MAJOR);