8250.c 66 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687
  1. /*
  2. * linux/drivers/char/8250.c
  3. *
  4. * Driver for 8250/16550-type serial ports
  5. *
  6. * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
  7. *
  8. * Copyright (C) 2001 Russell King.
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License as published by
  12. * the Free Software Foundation; either version 2 of the License, or
  13. * (at your option) any later version.
  14. *
  15. * $Id: 8250.c,v 1.90 2002/07/28 10:03:27 rmk Exp $
  16. *
  17. * A note about mapbase / membase
  18. *
  19. * mapbase is the physical address of the IO port.
  20. * membase is an 'ioremapped' cookie.
  21. */
  22. #include <linux/config.h>
  23. #if defined(CONFIG_SERIAL_8250_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
  24. #define SUPPORT_SYSRQ
  25. #endif
  26. #include <linux/module.h>
  27. #include <linux/moduleparam.h>
  28. #include <linux/ioport.h>
  29. #include <linux/init.h>
  30. #include <linux/console.h>
  31. #include <linux/sysrq.h>
  32. #include <linux/delay.h>
  33. #include <linux/platform_device.h>
  34. #include <linux/tty.h>
  35. #include <linux/tty_flip.h>
  36. #include <linux/serial_reg.h>
  37. #include <linux/serial_core.h>
  38. #include <linux/serial.h>
  39. #include <linux/serial_8250.h>
  40. #include <linux/nmi.h>
  41. #include <linux/mutex.h>
  42. #include <asm/io.h>
  43. #include <asm/irq.h>
  44. #include "8250.h"
  45. /*
  46. * Configuration:
  47. * share_irqs - whether we pass SA_SHIRQ to request_irq(). This option
  48. * is unsafe when used on edge-triggered interrupts.
  49. */
  50. static unsigned int share_irqs = SERIAL8250_SHARE_IRQS;
  51. static unsigned int nr_uarts = CONFIG_SERIAL_8250_RUNTIME_UARTS;
  52. /*
  53. * Debugging.
  54. */
  55. #if 0
  56. #define DEBUG_AUTOCONF(fmt...) printk(fmt)
  57. #else
  58. #define DEBUG_AUTOCONF(fmt...) do { } while (0)
  59. #endif
  60. #if 0
  61. #define DEBUG_INTR(fmt...) printk(fmt)
  62. #else
  63. #define DEBUG_INTR(fmt...) do { } while (0)
  64. #endif
  65. #define PASS_LIMIT 256
  66. /*
  67. * We default to IRQ0 for the "no irq" hack. Some
  68. * machine types want others as well - they're free
  69. * to redefine this in their header file.
  70. */
  71. #define is_real_interrupt(irq) ((irq) != 0)
  72. #ifdef CONFIG_SERIAL_8250_DETECT_IRQ
  73. #define CONFIG_SERIAL_DETECT_IRQ 1
  74. #endif
  75. #ifdef CONFIG_SERIAL_8250_MANY_PORTS
  76. #define CONFIG_SERIAL_MANY_PORTS 1
  77. #endif
  78. /*
  79. * HUB6 is always on. This will be removed once the header
  80. * files have been cleaned.
  81. */
  82. #define CONFIG_HUB6 1
  83. #include <asm/serial.h>
  84. /*
  85. * SERIAL_PORT_DFNS tells us about built-in ports that have no
  86. * standard enumeration mechanism. Platforms that can find all
  87. * serial ports via mechanisms like ACPI or PCI need not supply it.
  88. */
  89. #ifndef SERIAL_PORT_DFNS
  90. #define SERIAL_PORT_DFNS
  91. #endif
  92. static const struct old_serial_port old_serial_port[] = {
  93. SERIAL_PORT_DFNS /* defined in asm/serial.h */
  94. };
  95. #define UART_NR CONFIG_SERIAL_8250_NR_UARTS
  96. #ifdef CONFIG_SERIAL_8250_RSA
  97. #define PORT_RSA_MAX 4
  98. static unsigned long probe_rsa[PORT_RSA_MAX];
  99. static unsigned int probe_rsa_count;
  100. #endif /* CONFIG_SERIAL_8250_RSA */
  101. struct uart_8250_port {
  102. struct uart_port port;
  103. struct timer_list timer; /* "no irq" timer */
  104. struct list_head list; /* ports on this IRQ */
  105. unsigned short capabilities; /* port capabilities */
  106. unsigned short bugs; /* port bugs */
  107. unsigned int tx_loadsz; /* transmit fifo load size */
  108. unsigned char acr;
  109. unsigned char ier;
  110. unsigned char lcr;
  111. unsigned char mcr;
  112. unsigned char mcr_mask; /* mask of user bits */
  113. unsigned char mcr_force; /* mask of forced bits */
  114. unsigned char lsr_break_flag;
  115. /*
  116. * We provide a per-port pm hook.
  117. */
  118. void (*pm)(struct uart_port *port,
  119. unsigned int state, unsigned int old);
  120. };
  121. struct irq_info {
  122. spinlock_t lock;
  123. struct list_head *head;
  124. };
  125. static struct irq_info irq_lists[NR_IRQS];
  126. /*
  127. * Here we define the default xmit fifo size used for each type of UART.
  128. */
  129. static const struct serial8250_config uart_config[] = {
  130. [PORT_UNKNOWN] = {
  131. .name = "unknown",
  132. .fifo_size = 1,
  133. .tx_loadsz = 1,
  134. },
  135. [PORT_8250] = {
  136. .name = "8250",
  137. .fifo_size = 1,
  138. .tx_loadsz = 1,
  139. },
  140. [PORT_16450] = {
  141. .name = "16450",
  142. .fifo_size = 1,
  143. .tx_loadsz = 1,
  144. },
  145. [PORT_16550] = {
  146. .name = "16550",
  147. .fifo_size = 1,
  148. .tx_loadsz = 1,
  149. },
  150. [PORT_16550A] = {
  151. .name = "16550A",
  152. .fifo_size = 16,
  153. .tx_loadsz = 16,
  154. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
  155. .flags = UART_CAP_FIFO,
  156. },
  157. [PORT_CIRRUS] = {
  158. .name = "Cirrus",
  159. .fifo_size = 1,
  160. .tx_loadsz = 1,
  161. },
  162. [PORT_16650] = {
  163. .name = "ST16650",
  164. .fifo_size = 1,
  165. .tx_loadsz = 1,
  166. .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
  167. },
  168. [PORT_16650V2] = {
  169. .name = "ST16650V2",
  170. .fifo_size = 32,
  171. .tx_loadsz = 16,
  172. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
  173. UART_FCR_T_TRIG_00,
  174. .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
  175. },
  176. [PORT_16750] = {
  177. .name = "TI16750",
  178. .fifo_size = 64,
  179. .tx_loadsz = 64,
  180. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10 |
  181. UART_FCR7_64BYTE,
  182. .flags = UART_CAP_FIFO | UART_CAP_SLEEP | UART_CAP_AFE,
  183. },
  184. [PORT_STARTECH] = {
  185. .name = "Startech",
  186. .fifo_size = 1,
  187. .tx_loadsz = 1,
  188. },
  189. [PORT_16C950] = {
  190. .name = "16C950/954",
  191. .fifo_size = 128,
  192. .tx_loadsz = 128,
  193. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
  194. .flags = UART_CAP_FIFO,
  195. },
  196. [PORT_16654] = {
  197. .name = "ST16654",
  198. .fifo_size = 64,
  199. .tx_loadsz = 32,
  200. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
  201. UART_FCR_T_TRIG_10,
  202. .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
  203. },
  204. [PORT_16850] = {
  205. .name = "XR16850",
  206. .fifo_size = 128,
  207. .tx_loadsz = 128,
  208. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
  209. .flags = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
  210. },
  211. [PORT_RSA] = {
  212. .name = "RSA",
  213. .fifo_size = 2048,
  214. .tx_loadsz = 2048,
  215. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_11,
  216. .flags = UART_CAP_FIFO,
  217. },
  218. [PORT_NS16550A] = {
  219. .name = "NS16550A",
  220. .fifo_size = 16,
  221. .tx_loadsz = 16,
  222. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
  223. .flags = UART_CAP_FIFO | UART_NATSEMI,
  224. },
  225. [PORT_XSCALE] = {
  226. .name = "XScale",
  227. .fifo_size = 32,
  228. .tx_loadsz = 32,
  229. .fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
  230. .flags = UART_CAP_FIFO | UART_CAP_UUE,
  231. },
  232. };
  233. #ifdef CONFIG_SERIAL_8250_AU1X00
  234. /* Au1x00 UART hardware has a weird register layout */
  235. static const u8 au_io_in_map[] = {
  236. [UART_RX] = 0,
  237. [UART_IER] = 2,
  238. [UART_IIR] = 3,
  239. [UART_LCR] = 5,
  240. [UART_MCR] = 6,
  241. [UART_LSR] = 7,
  242. [UART_MSR] = 8,
  243. };
  244. static const u8 au_io_out_map[] = {
  245. [UART_TX] = 1,
  246. [UART_IER] = 2,
  247. [UART_FCR] = 4,
  248. [UART_LCR] = 5,
  249. [UART_MCR] = 6,
  250. };
  251. /* sane hardware needs no mapping */
  252. static inline int map_8250_in_reg(struct uart_8250_port *up, int offset)
  253. {
  254. if (up->port.iotype != UPIO_AU)
  255. return offset;
  256. return au_io_in_map[offset];
  257. }
  258. static inline int map_8250_out_reg(struct uart_8250_port *up, int offset)
  259. {
  260. if (up->port.iotype != UPIO_AU)
  261. return offset;
  262. return au_io_out_map[offset];
  263. }
  264. #else
  265. /* sane hardware needs no mapping */
  266. #define map_8250_in_reg(up, offset) (offset)
  267. #define map_8250_out_reg(up, offset) (offset)
  268. #endif
  269. static unsigned int serial_in(struct uart_8250_port *up, int offset)
  270. {
  271. offset = map_8250_in_reg(up, offset) << up->port.regshift;
  272. switch (up->port.iotype) {
  273. case UPIO_HUB6:
  274. outb(up->port.hub6 - 1 + offset, up->port.iobase);
  275. return inb(up->port.iobase + 1);
  276. case UPIO_MEM:
  277. return readb(up->port.membase + offset);
  278. case UPIO_MEM32:
  279. return readl(up->port.membase + offset);
  280. #ifdef CONFIG_SERIAL_8250_AU1X00
  281. case UPIO_AU:
  282. return __raw_readl(up->port.membase + offset);
  283. #endif
  284. default:
  285. return inb(up->port.iobase + offset);
  286. }
  287. }
  288. static void
  289. serial_out(struct uart_8250_port *up, int offset, int value)
  290. {
  291. offset = map_8250_out_reg(up, offset) << up->port.regshift;
  292. switch (up->port.iotype) {
  293. case UPIO_HUB6:
  294. outb(up->port.hub6 - 1 + offset, up->port.iobase);
  295. outb(value, up->port.iobase + 1);
  296. break;
  297. case UPIO_MEM:
  298. writeb(value, up->port.membase + offset);
  299. break;
  300. case UPIO_MEM32:
  301. writel(value, up->port.membase + offset);
  302. break;
  303. #ifdef CONFIG_SERIAL_8250_AU1X00
  304. case UPIO_AU:
  305. __raw_writel(value, up->port.membase + offset);
  306. break;
  307. #endif
  308. default:
  309. outb(value, up->port.iobase + offset);
  310. }
  311. }
  312. /*
  313. * We used to support using pause I/O for certain machines. We
  314. * haven't supported this for a while, but just in case it's badly
  315. * needed for certain old 386 machines, I've left these #define's
  316. * in....
  317. */
  318. #define serial_inp(up, offset) serial_in(up, offset)
  319. #define serial_outp(up, offset, value) serial_out(up, offset, value)
  320. /* Uart divisor latch read */
  321. static inline int _serial_dl_read(struct uart_8250_port *up)
  322. {
  323. return serial_inp(up, UART_DLL) | serial_inp(up, UART_DLM) << 8;
  324. }
  325. /* Uart divisor latch write */
  326. static inline void _serial_dl_write(struct uart_8250_port *up, int value)
  327. {
  328. serial_outp(up, UART_DLL, value & 0xff);
  329. serial_outp(up, UART_DLM, value >> 8 & 0xff);
  330. }
  331. #ifdef CONFIG_SERIAL_8250_AU1X00
  332. /* Au1x00 haven't got a standard divisor latch */
  333. static int serial_dl_read(struct uart_8250_port *up)
  334. {
  335. if (up->port.iotype == UPIO_AU)
  336. return __raw_readl(up->port.membase + 0x28);
  337. else
  338. return _serial_dl_read(up);
  339. }
  340. static void serial_dl_write(struct uart_8250_port *up, int value)
  341. {
  342. if (up->port.iotype == UPIO_AU)
  343. __raw_writel(value, up->port.membase + 0x28);
  344. else
  345. _serial_dl_write(up, value);
  346. }
  347. #else
  348. #define serial_dl_read(up) _serial_dl_read(up)
  349. #define serial_dl_write(up, value) _serial_dl_write(up, value)
  350. #endif
  351. /*
  352. * For the 16C950
  353. */
  354. static void serial_icr_write(struct uart_8250_port *up, int offset, int value)
  355. {
  356. serial_out(up, UART_SCR, offset);
  357. serial_out(up, UART_ICR, value);
  358. }
  359. static unsigned int serial_icr_read(struct uart_8250_port *up, int offset)
  360. {
  361. unsigned int value;
  362. serial_icr_write(up, UART_ACR, up->acr | UART_ACR_ICRRD);
  363. serial_out(up, UART_SCR, offset);
  364. value = serial_in(up, UART_ICR);
  365. serial_icr_write(up, UART_ACR, up->acr);
  366. return value;
  367. }
  368. /*
  369. * FIFO support.
  370. */
  371. static inline void serial8250_clear_fifos(struct uart_8250_port *p)
  372. {
  373. if (p->capabilities & UART_CAP_FIFO) {
  374. serial_outp(p, UART_FCR, UART_FCR_ENABLE_FIFO);
  375. serial_outp(p, UART_FCR, UART_FCR_ENABLE_FIFO |
  376. UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
  377. serial_outp(p, UART_FCR, 0);
  378. }
  379. }
  380. /*
  381. * IER sleep support. UARTs which have EFRs need the "extended
  382. * capability" bit enabled. Note that on XR16C850s, we need to
  383. * reset LCR to write to IER.
  384. */
  385. static inline void serial8250_set_sleep(struct uart_8250_port *p, int sleep)
  386. {
  387. if (p->capabilities & UART_CAP_SLEEP) {
  388. if (p->capabilities & UART_CAP_EFR) {
  389. serial_outp(p, UART_LCR, 0xBF);
  390. serial_outp(p, UART_EFR, UART_EFR_ECB);
  391. serial_outp(p, UART_LCR, 0);
  392. }
  393. serial_outp(p, UART_IER, sleep ? UART_IERX_SLEEP : 0);
  394. if (p->capabilities & UART_CAP_EFR) {
  395. serial_outp(p, UART_LCR, 0xBF);
  396. serial_outp(p, UART_EFR, 0);
  397. serial_outp(p, UART_LCR, 0);
  398. }
  399. }
  400. }
  401. #ifdef CONFIG_SERIAL_8250_RSA
  402. /*
  403. * Attempts to turn on the RSA FIFO. Returns zero on failure.
  404. * We set the port uart clock rate if we succeed.
  405. */
  406. static int __enable_rsa(struct uart_8250_port *up)
  407. {
  408. unsigned char mode;
  409. int result;
  410. mode = serial_inp(up, UART_RSA_MSR);
  411. result = mode & UART_RSA_MSR_FIFO;
  412. if (!result) {
  413. serial_outp(up, UART_RSA_MSR, mode | UART_RSA_MSR_FIFO);
  414. mode = serial_inp(up, UART_RSA_MSR);
  415. result = mode & UART_RSA_MSR_FIFO;
  416. }
  417. if (result)
  418. up->port.uartclk = SERIAL_RSA_BAUD_BASE * 16;
  419. return result;
  420. }
  421. static void enable_rsa(struct uart_8250_port *up)
  422. {
  423. if (up->port.type == PORT_RSA) {
  424. if (up->port.uartclk != SERIAL_RSA_BAUD_BASE * 16) {
  425. spin_lock_irq(&up->port.lock);
  426. __enable_rsa(up);
  427. spin_unlock_irq(&up->port.lock);
  428. }
  429. if (up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16)
  430. serial_outp(up, UART_RSA_FRR, 0);
  431. }
  432. }
  433. /*
  434. * Attempts to turn off the RSA FIFO. Returns zero on failure.
  435. * It is unknown why interrupts were disabled in here. However,
  436. * the caller is expected to preserve this behaviour by grabbing
  437. * the spinlock before calling this function.
  438. */
  439. static void disable_rsa(struct uart_8250_port *up)
  440. {
  441. unsigned char mode;
  442. int result;
  443. if (up->port.type == PORT_RSA &&
  444. up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16) {
  445. spin_lock_irq(&up->port.lock);
  446. mode = serial_inp(up, UART_RSA_MSR);
  447. result = !(mode & UART_RSA_MSR_FIFO);
  448. if (!result) {
  449. serial_outp(up, UART_RSA_MSR, mode & ~UART_RSA_MSR_FIFO);
  450. mode = serial_inp(up, UART_RSA_MSR);
  451. result = !(mode & UART_RSA_MSR_FIFO);
  452. }
  453. if (result)
  454. up->port.uartclk = SERIAL_RSA_BAUD_BASE_LO * 16;
  455. spin_unlock_irq(&up->port.lock);
  456. }
  457. }
  458. #endif /* CONFIG_SERIAL_8250_RSA */
  459. /*
  460. * This is a quickie test to see how big the FIFO is.
  461. * It doesn't work at all the time, more's the pity.
  462. */
  463. static int size_fifo(struct uart_8250_port *up)
  464. {
  465. unsigned char old_fcr, old_mcr, old_lcr;
  466. unsigned short old_dl;
  467. int count;
  468. old_lcr = serial_inp(up, UART_LCR);
  469. serial_outp(up, UART_LCR, 0);
  470. old_fcr = serial_inp(up, UART_FCR);
  471. old_mcr = serial_inp(up, UART_MCR);
  472. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO |
  473. UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
  474. serial_outp(up, UART_MCR, UART_MCR_LOOP);
  475. serial_outp(up, UART_LCR, UART_LCR_DLAB);
  476. old_dl = serial_dl_read(up);
  477. serial_dl_write(up, 0x0001);
  478. serial_outp(up, UART_LCR, 0x03);
  479. for (count = 0; count < 256; count++)
  480. serial_outp(up, UART_TX, count);
  481. mdelay(20);/* FIXME - schedule_timeout */
  482. for (count = 0; (serial_inp(up, UART_LSR) & UART_LSR_DR) &&
  483. (count < 256); count++)
  484. serial_inp(up, UART_RX);
  485. serial_outp(up, UART_FCR, old_fcr);
  486. serial_outp(up, UART_MCR, old_mcr);
  487. serial_outp(up, UART_LCR, UART_LCR_DLAB);
  488. serial_dl_write(up, old_dl);
  489. serial_outp(up, UART_LCR, old_lcr);
  490. return count;
  491. }
  492. /*
  493. * Read UART ID using the divisor method - set DLL and DLM to zero
  494. * and the revision will be in DLL and device type in DLM. We
  495. * preserve the device state across this.
  496. */
  497. static unsigned int autoconfig_read_divisor_id(struct uart_8250_port *p)
  498. {
  499. unsigned char old_dll, old_dlm, old_lcr;
  500. unsigned int id;
  501. old_lcr = serial_inp(p, UART_LCR);
  502. serial_outp(p, UART_LCR, UART_LCR_DLAB);
  503. old_dll = serial_inp(p, UART_DLL);
  504. old_dlm = serial_inp(p, UART_DLM);
  505. serial_outp(p, UART_DLL, 0);
  506. serial_outp(p, UART_DLM, 0);
  507. id = serial_inp(p, UART_DLL) | serial_inp(p, UART_DLM) << 8;
  508. serial_outp(p, UART_DLL, old_dll);
  509. serial_outp(p, UART_DLM, old_dlm);
  510. serial_outp(p, UART_LCR, old_lcr);
  511. return id;
  512. }
  513. /*
  514. * This is a helper routine to autodetect StarTech/Exar/Oxsemi UART's.
  515. * When this function is called we know it is at least a StarTech
  516. * 16650 V2, but it might be one of several StarTech UARTs, or one of
  517. * its clones. (We treat the broken original StarTech 16650 V1 as a
  518. * 16550, and why not? Startech doesn't seem to even acknowledge its
  519. * existence.)
  520. *
  521. * What evil have men's minds wrought...
  522. */
  523. static void autoconfig_has_efr(struct uart_8250_port *up)
  524. {
  525. unsigned int id1, id2, id3, rev;
  526. /*
  527. * Everything with an EFR has SLEEP
  528. */
  529. up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
  530. /*
  531. * First we check to see if it's an Oxford Semiconductor UART.
  532. *
  533. * If we have to do this here because some non-National
  534. * Semiconductor clone chips lock up if you try writing to the
  535. * LSR register (which serial_icr_read does)
  536. */
  537. /*
  538. * Check for Oxford Semiconductor 16C950.
  539. *
  540. * EFR [4] must be set else this test fails.
  541. *
  542. * This shouldn't be necessary, but Mike Hudson (Exoray@isys.ca)
  543. * claims that it's needed for 952 dual UART's (which are not
  544. * recommended for new designs).
  545. */
  546. up->acr = 0;
  547. serial_out(up, UART_LCR, 0xBF);
  548. serial_out(up, UART_EFR, UART_EFR_ECB);
  549. serial_out(up, UART_LCR, 0x00);
  550. id1 = serial_icr_read(up, UART_ID1);
  551. id2 = serial_icr_read(up, UART_ID2);
  552. id3 = serial_icr_read(up, UART_ID3);
  553. rev = serial_icr_read(up, UART_REV);
  554. DEBUG_AUTOCONF("950id=%02x:%02x:%02x:%02x ", id1, id2, id3, rev);
  555. if (id1 == 0x16 && id2 == 0xC9 &&
  556. (id3 == 0x50 || id3 == 0x52 || id3 == 0x54)) {
  557. up->port.type = PORT_16C950;
  558. /*
  559. * Enable work around for the Oxford Semiconductor 952 rev B
  560. * chip which causes it to seriously miscalculate baud rates
  561. * when DLL is 0.
  562. */
  563. if (id3 == 0x52 && rev == 0x01)
  564. up->bugs |= UART_BUG_QUOT;
  565. return;
  566. }
  567. /*
  568. * We check for a XR16C850 by setting DLL and DLM to 0, and then
  569. * reading back DLL and DLM. The chip type depends on the DLM
  570. * value read back:
  571. * 0x10 - XR16C850 and the DLL contains the chip revision.
  572. * 0x12 - XR16C2850.
  573. * 0x14 - XR16C854.
  574. */
  575. id1 = autoconfig_read_divisor_id(up);
  576. DEBUG_AUTOCONF("850id=%04x ", id1);
  577. id2 = id1 >> 8;
  578. if (id2 == 0x10 || id2 == 0x12 || id2 == 0x14) {
  579. up->port.type = PORT_16850;
  580. return;
  581. }
  582. /*
  583. * It wasn't an XR16C850.
  584. *
  585. * We distinguish between the '654 and the '650 by counting
  586. * how many bytes are in the FIFO. I'm using this for now,
  587. * since that's the technique that was sent to me in the
  588. * serial driver update, but I'm not convinced this works.
  589. * I've had problems doing this in the past. -TYT
  590. */
  591. if (size_fifo(up) == 64)
  592. up->port.type = PORT_16654;
  593. else
  594. up->port.type = PORT_16650V2;
  595. }
  596. /*
  597. * We detected a chip without a FIFO. Only two fall into
  598. * this category - the original 8250 and the 16450. The
  599. * 16450 has a scratch register (accessible with LCR=0)
  600. */
  601. static void autoconfig_8250(struct uart_8250_port *up)
  602. {
  603. unsigned char scratch, status1, status2;
  604. up->port.type = PORT_8250;
  605. scratch = serial_in(up, UART_SCR);
  606. serial_outp(up, UART_SCR, 0xa5);
  607. status1 = serial_in(up, UART_SCR);
  608. serial_outp(up, UART_SCR, 0x5a);
  609. status2 = serial_in(up, UART_SCR);
  610. serial_outp(up, UART_SCR, scratch);
  611. if (status1 == 0xa5 && status2 == 0x5a)
  612. up->port.type = PORT_16450;
  613. }
  614. static int broken_efr(struct uart_8250_port *up)
  615. {
  616. /*
  617. * Exar ST16C2550 "A2" devices incorrectly detect as
  618. * having an EFR, and report an ID of 0x0201. See
  619. * http://www.exar.com/info.php?pdf=dan180_oct2004.pdf
  620. */
  621. if (autoconfig_read_divisor_id(up) == 0x0201 && size_fifo(up) == 16)
  622. return 1;
  623. return 0;
  624. }
  625. /*
  626. * We know that the chip has FIFOs. Does it have an EFR? The
  627. * EFR is located in the same register position as the IIR and
  628. * we know the top two bits of the IIR are currently set. The
  629. * EFR should contain zero. Try to read the EFR.
  630. */
  631. static void autoconfig_16550a(struct uart_8250_port *up)
  632. {
  633. unsigned char status1, status2;
  634. unsigned int iersave;
  635. up->port.type = PORT_16550A;
  636. up->capabilities |= UART_CAP_FIFO;
  637. /*
  638. * Check for presence of the EFR when DLAB is set.
  639. * Only ST16C650V1 UARTs pass this test.
  640. */
  641. serial_outp(up, UART_LCR, UART_LCR_DLAB);
  642. if (serial_in(up, UART_EFR) == 0) {
  643. serial_outp(up, UART_EFR, 0xA8);
  644. if (serial_in(up, UART_EFR) != 0) {
  645. DEBUG_AUTOCONF("EFRv1 ");
  646. up->port.type = PORT_16650;
  647. up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
  648. } else {
  649. DEBUG_AUTOCONF("Motorola 8xxx DUART ");
  650. }
  651. serial_outp(up, UART_EFR, 0);
  652. return;
  653. }
  654. /*
  655. * Maybe it requires 0xbf to be written to the LCR.
  656. * (other ST16C650V2 UARTs, TI16C752A, etc)
  657. */
  658. serial_outp(up, UART_LCR, 0xBF);
  659. if (serial_in(up, UART_EFR) == 0 && !broken_efr(up)) {
  660. DEBUG_AUTOCONF("EFRv2 ");
  661. autoconfig_has_efr(up);
  662. return;
  663. }
  664. /*
  665. * Check for a National Semiconductor SuperIO chip.
  666. * Attempt to switch to bank 2, read the value of the LOOP bit
  667. * from EXCR1. Switch back to bank 0, change it in MCR. Then
  668. * switch back to bank 2, read it from EXCR1 again and check
  669. * it's changed. If so, set baud_base in EXCR2 to 921600. -- dwmw2
  670. */
  671. serial_outp(up, UART_LCR, 0);
  672. status1 = serial_in(up, UART_MCR);
  673. serial_outp(up, UART_LCR, 0xE0);
  674. status2 = serial_in(up, 0x02); /* EXCR1 */
  675. if (!((status2 ^ status1) & UART_MCR_LOOP)) {
  676. serial_outp(up, UART_LCR, 0);
  677. serial_outp(up, UART_MCR, status1 ^ UART_MCR_LOOP);
  678. serial_outp(up, UART_LCR, 0xE0);
  679. status2 = serial_in(up, 0x02); /* EXCR1 */
  680. serial_outp(up, UART_LCR, 0);
  681. serial_outp(up, UART_MCR, status1);
  682. if ((status2 ^ status1) & UART_MCR_LOOP) {
  683. unsigned short quot;
  684. serial_outp(up, UART_LCR, 0xE0);
  685. quot = serial_dl_read(up);
  686. quot <<= 3;
  687. status1 = serial_in(up, 0x04); /* EXCR1 */
  688. status1 &= ~0xB0; /* Disable LOCK, mask out PRESL[01] */
  689. status1 |= 0x10; /* 1.625 divisor for baud_base --> 921600 */
  690. serial_outp(up, 0x04, status1);
  691. serial_dl_write(up, quot);
  692. serial_outp(up, UART_LCR, 0);
  693. up->port.uartclk = 921600*16;
  694. up->port.type = PORT_NS16550A;
  695. up->capabilities |= UART_NATSEMI;
  696. return;
  697. }
  698. }
  699. /*
  700. * No EFR. Try to detect a TI16750, which only sets bit 5 of
  701. * the IIR when 64 byte FIFO mode is enabled when DLAB is set.
  702. * Try setting it with and without DLAB set. Cheap clones
  703. * set bit 5 without DLAB set.
  704. */
  705. serial_outp(up, UART_LCR, 0);
  706. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
  707. status1 = serial_in(up, UART_IIR) >> 5;
  708. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
  709. serial_outp(up, UART_LCR, UART_LCR_DLAB);
  710. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
  711. status2 = serial_in(up, UART_IIR) >> 5;
  712. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
  713. serial_outp(up, UART_LCR, 0);
  714. DEBUG_AUTOCONF("iir1=%d iir2=%d ", status1, status2);
  715. if (status1 == 6 && status2 == 7) {
  716. up->port.type = PORT_16750;
  717. up->capabilities |= UART_CAP_AFE | UART_CAP_SLEEP;
  718. return;
  719. }
  720. /*
  721. * Try writing and reading the UART_IER_UUE bit (b6).
  722. * If it works, this is probably one of the Xscale platform's
  723. * internal UARTs.
  724. * We're going to explicitly set the UUE bit to 0 before
  725. * trying to write and read a 1 just to make sure it's not
  726. * already a 1 and maybe locked there before we even start start.
  727. */
  728. iersave = serial_in(up, UART_IER);
  729. serial_outp(up, UART_IER, iersave & ~UART_IER_UUE);
  730. if (!(serial_in(up, UART_IER) & UART_IER_UUE)) {
  731. /*
  732. * OK it's in a known zero state, try writing and reading
  733. * without disturbing the current state of the other bits.
  734. */
  735. serial_outp(up, UART_IER, iersave | UART_IER_UUE);
  736. if (serial_in(up, UART_IER) & UART_IER_UUE) {
  737. /*
  738. * It's an Xscale.
  739. * We'll leave the UART_IER_UUE bit set to 1 (enabled).
  740. */
  741. DEBUG_AUTOCONF("Xscale ");
  742. up->port.type = PORT_XSCALE;
  743. up->capabilities |= UART_CAP_UUE;
  744. return;
  745. }
  746. } else {
  747. /*
  748. * If we got here we couldn't force the IER_UUE bit to 0.
  749. * Log it and continue.
  750. */
  751. DEBUG_AUTOCONF("Couldn't force IER_UUE to 0 ");
  752. }
  753. serial_outp(up, UART_IER, iersave);
  754. }
  755. /*
  756. * This routine is called by rs_init() to initialize a specific serial
  757. * port. It determines what type of UART chip this serial port is
  758. * using: 8250, 16450, 16550, 16550A. The important question is
  759. * whether or not this UART is a 16550A or not, since this will
  760. * determine whether or not we can use its FIFO features or not.
  761. */
  762. static void autoconfig(struct uart_8250_port *up, unsigned int probeflags)
  763. {
  764. unsigned char status1, scratch, scratch2, scratch3;
  765. unsigned char save_lcr, save_mcr;
  766. unsigned long flags;
  767. if (!up->port.iobase && !up->port.mapbase && !up->port.membase)
  768. return;
  769. DEBUG_AUTOCONF("ttyS%d: autoconf (0x%04x, 0x%p): ",
  770. up->port.line, up->port.iobase, up->port.membase);
  771. /*
  772. * We really do need global IRQs disabled here - we're going to
  773. * be frobbing the chips IRQ enable register to see if it exists.
  774. */
  775. spin_lock_irqsave(&up->port.lock, flags);
  776. // save_flags(flags); cli();
  777. up->capabilities = 0;
  778. up->bugs = 0;
  779. if (!(up->port.flags & UPF_BUGGY_UART)) {
  780. /*
  781. * Do a simple existence test first; if we fail this,
  782. * there's no point trying anything else.
  783. *
  784. * 0x80 is used as a nonsense port to prevent against
  785. * false positives due to ISA bus float. The
  786. * assumption is that 0x80 is a non-existent port;
  787. * which should be safe since include/asm/io.h also
  788. * makes this assumption.
  789. *
  790. * Note: this is safe as long as MCR bit 4 is clear
  791. * and the device is in "PC" mode.
  792. */
  793. scratch = serial_inp(up, UART_IER);
  794. serial_outp(up, UART_IER, 0);
  795. #ifdef __i386__
  796. outb(0xff, 0x080);
  797. #endif
  798. scratch2 = serial_inp(up, UART_IER);
  799. serial_outp(up, UART_IER, 0x0F);
  800. #ifdef __i386__
  801. outb(0, 0x080);
  802. #endif
  803. scratch3 = serial_inp(up, UART_IER);
  804. serial_outp(up, UART_IER, scratch);
  805. if (scratch2 != 0 || scratch3 != 0x0F) {
  806. /*
  807. * We failed; there's nothing here
  808. */
  809. DEBUG_AUTOCONF("IER test failed (%02x, %02x) ",
  810. scratch2, scratch3);
  811. goto out;
  812. }
  813. }
  814. save_mcr = serial_in(up, UART_MCR);
  815. save_lcr = serial_in(up, UART_LCR);
  816. /*
  817. * Check to see if a UART is really there. Certain broken
  818. * internal modems based on the Rockwell chipset fail this
  819. * test, because they apparently don't implement the loopback
  820. * test mode. So this test is skipped on the COM 1 through
  821. * COM 4 ports. This *should* be safe, since no board
  822. * manufacturer would be stupid enough to design a board
  823. * that conflicts with COM 1-4 --- we hope!
  824. */
  825. if (!(up->port.flags & UPF_SKIP_TEST)) {
  826. serial_outp(up, UART_MCR, UART_MCR_LOOP | 0x0A);
  827. status1 = serial_inp(up, UART_MSR) & 0xF0;
  828. serial_outp(up, UART_MCR, save_mcr);
  829. if (status1 != 0x90) {
  830. DEBUG_AUTOCONF("LOOP test failed (%02x) ",
  831. status1);
  832. goto out;
  833. }
  834. }
  835. /*
  836. * We're pretty sure there's a port here. Lets find out what
  837. * type of port it is. The IIR top two bits allows us to find
  838. * out if it's 8250 or 16450, 16550, 16550A or later. This
  839. * determines what we test for next.
  840. *
  841. * We also initialise the EFR (if any) to zero for later. The
  842. * EFR occupies the same register location as the FCR and IIR.
  843. */
  844. serial_outp(up, UART_LCR, 0xBF);
  845. serial_outp(up, UART_EFR, 0);
  846. serial_outp(up, UART_LCR, 0);
  847. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
  848. scratch = serial_in(up, UART_IIR) >> 6;
  849. DEBUG_AUTOCONF("iir=%d ", scratch);
  850. switch (scratch) {
  851. case 0:
  852. autoconfig_8250(up);
  853. break;
  854. case 1:
  855. up->port.type = PORT_UNKNOWN;
  856. break;
  857. case 2:
  858. up->port.type = PORT_16550;
  859. break;
  860. case 3:
  861. autoconfig_16550a(up);
  862. break;
  863. }
  864. #ifdef CONFIG_SERIAL_8250_RSA
  865. /*
  866. * Only probe for RSA ports if we got the region.
  867. */
  868. if (up->port.type == PORT_16550A && probeflags & PROBE_RSA) {
  869. int i;
  870. for (i = 0 ; i < probe_rsa_count; ++i) {
  871. if (probe_rsa[i] == up->port.iobase &&
  872. __enable_rsa(up)) {
  873. up->port.type = PORT_RSA;
  874. break;
  875. }
  876. }
  877. }
  878. #endif
  879. #ifdef CONFIG_SERIAL_8250_AU1X00
  880. /* if access method is AU, it is a 16550 with a quirk */
  881. if (up->port.type == PORT_16550A && up->port.iotype == UPIO_AU)
  882. up->bugs |= UART_BUG_NOMSR;
  883. #endif
  884. serial_outp(up, UART_LCR, save_lcr);
  885. if (up->capabilities != uart_config[up->port.type].flags) {
  886. printk(KERN_WARNING
  887. "ttyS%d: detected caps %08x should be %08x\n",
  888. up->port.line, up->capabilities,
  889. uart_config[up->port.type].flags);
  890. }
  891. up->port.fifosize = uart_config[up->port.type].fifo_size;
  892. up->capabilities = uart_config[up->port.type].flags;
  893. up->tx_loadsz = uart_config[up->port.type].tx_loadsz;
  894. if (up->port.type == PORT_UNKNOWN)
  895. goto out;
  896. /*
  897. * Reset the UART.
  898. */
  899. #ifdef CONFIG_SERIAL_8250_RSA
  900. if (up->port.type == PORT_RSA)
  901. serial_outp(up, UART_RSA_FRR, 0);
  902. #endif
  903. serial_outp(up, UART_MCR, save_mcr);
  904. serial8250_clear_fifos(up);
  905. (void)serial_in(up, UART_RX);
  906. if (up->capabilities & UART_CAP_UUE)
  907. serial_outp(up, UART_IER, UART_IER_UUE);
  908. else
  909. serial_outp(up, UART_IER, 0);
  910. out:
  911. spin_unlock_irqrestore(&up->port.lock, flags);
  912. // restore_flags(flags);
  913. DEBUG_AUTOCONF("type=%s\n", uart_config[up->port.type].name);
  914. }
  915. static void autoconfig_irq(struct uart_8250_port *up)
  916. {
  917. unsigned char save_mcr, save_ier;
  918. unsigned char save_ICP = 0;
  919. unsigned int ICP = 0;
  920. unsigned long irqs;
  921. int irq;
  922. if (up->port.flags & UPF_FOURPORT) {
  923. ICP = (up->port.iobase & 0xfe0) | 0x1f;
  924. save_ICP = inb_p(ICP);
  925. outb_p(0x80, ICP);
  926. (void) inb_p(ICP);
  927. }
  928. /* forget possible initially masked and pending IRQ */
  929. probe_irq_off(probe_irq_on());
  930. save_mcr = serial_inp(up, UART_MCR);
  931. save_ier = serial_inp(up, UART_IER);
  932. serial_outp(up, UART_MCR, UART_MCR_OUT1 | UART_MCR_OUT2);
  933. irqs = probe_irq_on();
  934. serial_outp(up, UART_MCR, 0);
  935. udelay (10);
  936. if (up->port.flags & UPF_FOURPORT) {
  937. serial_outp(up, UART_MCR,
  938. UART_MCR_DTR | UART_MCR_RTS);
  939. } else {
  940. serial_outp(up, UART_MCR,
  941. UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2);
  942. }
  943. serial_outp(up, UART_IER, 0x0f); /* enable all intrs */
  944. (void)serial_inp(up, UART_LSR);
  945. (void)serial_inp(up, UART_RX);
  946. (void)serial_inp(up, UART_IIR);
  947. (void)serial_inp(up, UART_MSR);
  948. serial_outp(up, UART_TX, 0xFF);
  949. udelay (20);
  950. irq = probe_irq_off(irqs);
  951. serial_outp(up, UART_MCR, save_mcr);
  952. serial_outp(up, UART_IER, save_ier);
  953. if (up->port.flags & UPF_FOURPORT)
  954. outb_p(save_ICP, ICP);
  955. up->port.irq = (irq > 0) ? irq : 0;
  956. }
  957. static inline void __stop_tx(struct uart_8250_port *p)
  958. {
  959. if (p->ier & UART_IER_THRI) {
  960. p->ier &= ~UART_IER_THRI;
  961. serial_out(p, UART_IER, p->ier);
  962. }
  963. }
  964. static void serial8250_stop_tx(struct uart_port *port)
  965. {
  966. struct uart_8250_port *up = (struct uart_8250_port *)port;
  967. __stop_tx(up);
  968. /*
  969. * We really want to stop the transmitter from sending.
  970. */
  971. if (up->port.type == PORT_16C950) {
  972. up->acr |= UART_ACR_TXDIS;
  973. serial_icr_write(up, UART_ACR, up->acr);
  974. }
  975. }
  976. static void transmit_chars(struct uart_8250_port *up);
  977. static void serial8250_start_tx(struct uart_port *port)
  978. {
  979. struct uart_8250_port *up = (struct uart_8250_port *)port;
  980. if (!(up->ier & UART_IER_THRI)) {
  981. up->ier |= UART_IER_THRI;
  982. serial_out(up, UART_IER, up->ier);
  983. if (up->bugs & UART_BUG_TXEN) {
  984. unsigned char lsr, iir;
  985. lsr = serial_in(up, UART_LSR);
  986. iir = serial_in(up, UART_IIR);
  987. if (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT)
  988. transmit_chars(up);
  989. }
  990. }
  991. /*
  992. * Re-enable the transmitter if we disabled it.
  993. */
  994. if (up->port.type == PORT_16C950 && up->acr & UART_ACR_TXDIS) {
  995. up->acr &= ~UART_ACR_TXDIS;
  996. serial_icr_write(up, UART_ACR, up->acr);
  997. }
  998. }
  999. static void serial8250_stop_rx(struct uart_port *port)
  1000. {
  1001. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1002. up->ier &= ~UART_IER_RLSI;
  1003. up->port.read_status_mask &= ~UART_LSR_DR;
  1004. serial_out(up, UART_IER, up->ier);
  1005. }
  1006. static void serial8250_enable_ms(struct uart_port *port)
  1007. {
  1008. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1009. /* no MSR capabilities */
  1010. if (up->bugs & UART_BUG_NOMSR)
  1011. return;
  1012. up->ier |= UART_IER_MSI;
  1013. serial_out(up, UART_IER, up->ier);
  1014. }
  1015. static void
  1016. receive_chars(struct uart_8250_port *up, int *status, struct pt_regs *regs)
  1017. {
  1018. struct tty_struct *tty = up->port.info->tty;
  1019. unsigned char ch, lsr = *status;
  1020. int max_count = 256;
  1021. char flag;
  1022. do {
  1023. ch = serial_inp(up, UART_RX);
  1024. flag = TTY_NORMAL;
  1025. up->port.icount.rx++;
  1026. #ifdef CONFIG_SERIAL_8250_CONSOLE
  1027. /*
  1028. * Recover the break flag from console xmit
  1029. */
  1030. if (up->port.line == up->port.cons->index) {
  1031. lsr |= up->lsr_break_flag;
  1032. up->lsr_break_flag = 0;
  1033. }
  1034. #endif
  1035. if (unlikely(lsr & (UART_LSR_BI | UART_LSR_PE |
  1036. UART_LSR_FE | UART_LSR_OE))) {
  1037. /*
  1038. * For statistics only
  1039. */
  1040. if (lsr & UART_LSR_BI) {
  1041. lsr &= ~(UART_LSR_FE | UART_LSR_PE);
  1042. up->port.icount.brk++;
  1043. /*
  1044. * We do the SysRQ and SAK checking
  1045. * here because otherwise the break
  1046. * may get masked by ignore_status_mask
  1047. * or read_status_mask.
  1048. */
  1049. if (uart_handle_break(&up->port))
  1050. goto ignore_char;
  1051. } else if (lsr & UART_LSR_PE)
  1052. up->port.icount.parity++;
  1053. else if (lsr & UART_LSR_FE)
  1054. up->port.icount.frame++;
  1055. if (lsr & UART_LSR_OE)
  1056. up->port.icount.overrun++;
  1057. /*
  1058. * Mask off conditions which should be ignored.
  1059. */
  1060. lsr &= up->port.read_status_mask;
  1061. if (lsr & UART_LSR_BI) {
  1062. DEBUG_INTR("handling break....");
  1063. flag = TTY_BREAK;
  1064. } else if (lsr & UART_LSR_PE)
  1065. flag = TTY_PARITY;
  1066. else if (lsr & UART_LSR_FE)
  1067. flag = TTY_FRAME;
  1068. }
  1069. if (uart_handle_sysrq_char(&up->port, ch, regs))
  1070. goto ignore_char;
  1071. uart_insert_char(&up->port, lsr, UART_LSR_OE, ch, flag);
  1072. ignore_char:
  1073. lsr = serial_inp(up, UART_LSR);
  1074. } while ((lsr & UART_LSR_DR) && (max_count-- > 0));
  1075. spin_unlock(&up->port.lock);
  1076. tty_flip_buffer_push(tty);
  1077. spin_lock(&up->port.lock);
  1078. *status = lsr;
  1079. }
  1080. static void transmit_chars(struct uart_8250_port *up)
  1081. {
  1082. struct circ_buf *xmit = &up->port.info->xmit;
  1083. int count;
  1084. if (up->port.x_char) {
  1085. serial_outp(up, UART_TX, up->port.x_char);
  1086. up->port.icount.tx++;
  1087. up->port.x_char = 0;
  1088. return;
  1089. }
  1090. if (uart_tx_stopped(&up->port)) {
  1091. serial8250_stop_tx(&up->port);
  1092. return;
  1093. }
  1094. if (uart_circ_empty(xmit)) {
  1095. __stop_tx(up);
  1096. return;
  1097. }
  1098. count = up->tx_loadsz;
  1099. do {
  1100. serial_out(up, UART_TX, xmit->buf[xmit->tail]);
  1101. xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
  1102. up->port.icount.tx++;
  1103. if (uart_circ_empty(xmit))
  1104. break;
  1105. } while (--count > 0);
  1106. if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
  1107. uart_write_wakeup(&up->port);
  1108. DEBUG_INTR("THRE...");
  1109. if (uart_circ_empty(xmit))
  1110. __stop_tx(up);
  1111. }
  1112. static unsigned int check_modem_status(struct uart_8250_port *up)
  1113. {
  1114. unsigned int status = serial_in(up, UART_MSR);
  1115. if (status & UART_MSR_ANY_DELTA && up->ier & UART_IER_MSI) {
  1116. if (status & UART_MSR_TERI)
  1117. up->port.icount.rng++;
  1118. if (status & UART_MSR_DDSR)
  1119. up->port.icount.dsr++;
  1120. if (status & UART_MSR_DDCD)
  1121. uart_handle_dcd_change(&up->port, status & UART_MSR_DCD);
  1122. if (status & UART_MSR_DCTS)
  1123. uart_handle_cts_change(&up->port, status & UART_MSR_CTS);
  1124. wake_up_interruptible(&up->port.info->delta_msr_wait);
  1125. }
  1126. return status;
  1127. }
  1128. /*
  1129. * This handles the interrupt from one port.
  1130. */
  1131. static inline void
  1132. serial8250_handle_port(struct uart_8250_port *up, struct pt_regs *regs)
  1133. {
  1134. unsigned int status;
  1135. spin_lock(&up->port.lock);
  1136. status = serial_inp(up, UART_LSR);
  1137. DEBUG_INTR("status = %x...", status);
  1138. if (status & UART_LSR_DR)
  1139. receive_chars(up, &status, regs);
  1140. check_modem_status(up);
  1141. if (status & UART_LSR_THRE)
  1142. transmit_chars(up);
  1143. spin_unlock(&up->port.lock);
  1144. }
  1145. /*
  1146. * This is the serial driver's interrupt routine.
  1147. *
  1148. * Arjan thinks the old way was overly complex, so it got simplified.
  1149. * Alan disagrees, saying that need the complexity to handle the weird
  1150. * nature of ISA shared interrupts. (This is a special exception.)
  1151. *
  1152. * In order to handle ISA shared interrupts properly, we need to check
  1153. * that all ports have been serviced, and therefore the ISA interrupt
  1154. * line has been de-asserted.
  1155. *
  1156. * This means we need to loop through all ports. checking that they
  1157. * don't have an interrupt pending.
  1158. */
  1159. static irqreturn_t serial8250_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  1160. {
  1161. struct irq_info *i = dev_id;
  1162. struct list_head *l, *end = NULL;
  1163. int pass_counter = 0, handled = 0;
  1164. DEBUG_INTR("serial8250_interrupt(%d)...", irq);
  1165. spin_lock(&i->lock);
  1166. l = i->head;
  1167. do {
  1168. struct uart_8250_port *up;
  1169. unsigned int iir;
  1170. up = list_entry(l, struct uart_8250_port, list);
  1171. iir = serial_in(up, UART_IIR);
  1172. if (!(iir & UART_IIR_NO_INT)) {
  1173. serial8250_handle_port(up, regs);
  1174. handled = 1;
  1175. end = NULL;
  1176. } else if (end == NULL)
  1177. end = l;
  1178. l = l->next;
  1179. if (l == i->head && pass_counter++ > PASS_LIMIT) {
  1180. /* If we hit this, we're dead. */
  1181. printk(KERN_ERR "serial8250: too much work for "
  1182. "irq%d\n", irq);
  1183. break;
  1184. }
  1185. } while (l != end);
  1186. spin_unlock(&i->lock);
  1187. DEBUG_INTR("end.\n");
  1188. return IRQ_RETVAL(handled);
  1189. }
  1190. /*
  1191. * To support ISA shared interrupts, we need to have one interrupt
  1192. * handler that ensures that the IRQ line has been deasserted
  1193. * before returning. Failing to do this will result in the IRQ
  1194. * line being stuck active, and, since ISA irqs are edge triggered,
  1195. * no more IRQs will be seen.
  1196. */
  1197. static void serial_do_unlink(struct irq_info *i, struct uart_8250_port *up)
  1198. {
  1199. spin_lock_irq(&i->lock);
  1200. if (!list_empty(i->head)) {
  1201. if (i->head == &up->list)
  1202. i->head = i->head->next;
  1203. list_del(&up->list);
  1204. } else {
  1205. BUG_ON(i->head != &up->list);
  1206. i->head = NULL;
  1207. }
  1208. spin_unlock_irq(&i->lock);
  1209. }
  1210. static int serial_link_irq_chain(struct uart_8250_port *up)
  1211. {
  1212. struct irq_info *i = irq_lists + up->port.irq;
  1213. int ret, irq_flags = up->port.flags & UPF_SHARE_IRQ ? SA_SHIRQ : 0;
  1214. spin_lock_irq(&i->lock);
  1215. if (i->head) {
  1216. list_add(&up->list, i->head);
  1217. spin_unlock_irq(&i->lock);
  1218. ret = 0;
  1219. } else {
  1220. INIT_LIST_HEAD(&up->list);
  1221. i->head = &up->list;
  1222. spin_unlock_irq(&i->lock);
  1223. ret = request_irq(up->port.irq, serial8250_interrupt,
  1224. irq_flags, "serial", i);
  1225. if (ret < 0)
  1226. serial_do_unlink(i, up);
  1227. }
  1228. return ret;
  1229. }
  1230. static void serial_unlink_irq_chain(struct uart_8250_port *up)
  1231. {
  1232. struct irq_info *i = irq_lists + up->port.irq;
  1233. BUG_ON(i->head == NULL);
  1234. if (list_empty(i->head))
  1235. free_irq(up->port.irq, i);
  1236. serial_do_unlink(i, up);
  1237. }
  1238. /*
  1239. * This function is used to handle ports that do not have an
  1240. * interrupt. This doesn't work very well for 16450's, but gives
  1241. * barely passable results for a 16550A. (Although at the expense
  1242. * of much CPU overhead).
  1243. */
  1244. static void serial8250_timeout(unsigned long data)
  1245. {
  1246. struct uart_8250_port *up = (struct uart_8250_port *)data;
  1247. unsigned int timeout;
  1248. unsigned int iir;
  1249. iir = serial_in(up, UART_IIR);
  1250. if (!(iir & UART_IIR_NO_INT))
  1251. serial8250_handle_port(up, NULL);
  1252. timeout = up->port.timeout;
  1253. timeout = timeout > 6 ? (timeout / 2 - 2) : 1;
  1254. mod_timer(&up->timer, jiffies + timeout);
  1255. }
  1256. static unsigned int serial8250_tx_empty(struct uart_port *port)
  1257. {
  1258. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1259. unsigned long flags;
  1260. unsigned int ret;
  1261. spin_lock_irqsave(&up->port.lock, flags);
  1262. ret = serial_in(up, UART_LSR) & UART_LSR_TEMT ? TIOCSER_TEMT : 0;
  1263. spin_unlock_irqrestore(&up->port.lock, flags);
  1264. return ret;
  1265. }
  1266. static unsigned int serial8250_get_mctrl(struct uart_port *port)
  1267. {
  1268. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1269. unsigned int status;
  1270. unsigned int ret;
  1271. status = check_modem_status(up);
  1272. ret = 0;
  1273. if (status & UART_MSR_DCD)
  1274. ret |= TIOCM_CAR;
  1275. if (status & UART_MSR_RI)
  1276. ret |= TIOCM_RNG;
  1277. if (status & UART_MSR_DSR)
  1278. ret |= TIOCM_DSR;
  1279. if (status & UART_MSR_CTS)
  1280. ret |= TIOCM_CTS;
  1281. return ret;
  1282. }
  1283. static void serial8250_set_mctrl(struct uart_port *port, unsigned int mctrl)
  1284. {
  1285. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1286. unsigned char mcr = 0;
  1287. if (mctrl & TIOCM_RTS)
  1288. mcr |= UART_MCR_RTS;
  1289. if (mctrl & TIOCM_DTR)
  1290. mcr |= UART_MCR_DTR;
  1291. if (mctrl & TIOCM_OUT1)
  1292. mcr |= UART_MCR_OUT1;
  1293. if (mctrl & TIOCM_OUT2)
  1294. mcr |= UART_MCR_OUT2;
  1295. if (mctrl & TIOCM_LOOP)
  1296. mcr |= UART_MCR_LOOP;
  1297. mcr = (mcr & up->mcr_mask) | up->mcr_force | up->mcr;
  1298. serial_out(up, UART_MCR, mcr);
  1299. }
  1300. static void serial8250_break_ctl(struct uart_port *port, int break_state)
  1301. {
  1302. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1303. unsigned long flags;
  1304. spin_lock_irqsave(&up->port.lock, flags);
  1305. if (break_state == -1)
  1306. up->lcr |= UART_LCR_SBC;
  1307. else
  1308. up->lcr &= ~UART_LCR_SBC;
  1309. serial_out(up, UART_LCR, up->lcr);
  1310. spin_unlock_irqrestore(&up->port.lock, flags);
  1311. }
  1312. static int serial8250_startup(struct uart_port *port)
  1313. {
  1314. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1315. unsigned long flags;
  1316. unsigned char lsr, iir;
  1317. int retval;
  1318. up->capabilities = uart_config[up->port.type].flags;
  1319. up->mcr = 0;
  1320. if (up->port.type == PORT_16C950) {
  1321. /* Wake up and initialize UART */
  1322. up->acr = 0;
  1323. serial_outp(up, UART_LCR, 0xBF);
  1324. serial_outp(up, UART_EFR, UART_EFR_ECB);
  1325. serial_outp(up, UART_IER, 0);
  1326. serial_outp(up, UART_LCR, 0);
  1327. serial_icr_write(up, UART_CSR, 0); /* Reset the UART */
  1328. serial_outp(up, UART_LCR, 0xBF);
  1329. serial_outp(up, UART_EFR, UART_EFR_ECB);
  1330. serial_outp(up, UART_LCR, 0);
  1331. }
  1332. #ifdef CONFIG_SERIAL_8250_RSA
  1333. /*
  1334. * If this is an RSA port, see if we can kick it up to the
  1335. * higher speed clock.
  1336. */
  1337. enable_rsa(up);
  1338. #endif
  1339. /*
  1340. * Clear the FIFO buffers and disable them.
  1341. * (they will be reenabled in set_termios())
  1342. */
  1343. serial8250_clear_fifos(up);
  1344. /*
  1345. * Clear the interrupt registers.
  1346. */
  1347. (void) serial_inp(up, UART_LSR);
  1348. (void) serial_inp(up, UART_RX);
  1349. (void) serial_inp(up, UART_IIR);
  1350. (void) serial_inp(up, UART_MSR);
  1351. /*
  1352. * At this point, there's no way the LSR could still be 0xff;
  1353. * if it is, then bail out, because there's likely no UART
  1354. * here.
  1355. */
  1356. if (!(up->port.flags & UPF_BUGGY_UART) &&
  1357. (serial_inp(up, UART_LSR) == 0xff)) {
  1358. printk("ttyS%d: LSR safety check engaged!\n", up->port.line);
  1359. return -ENODEV;
  1360. }
  1361. /*
  1362. * For a XR16C850, we need to set the trigger levels
  1363. */
  1364. if (up->port.type == PORT_16850) {
  1365. unsigned char fctr;
  1366. serial_outp(up, UART_LCR, 0xbf);
  1367. fctr = serial_inp(up, UART_FCTR) & ~(UART_FCTR_RX|UART_FCTR_TX);
  1368. serial_outp(up, UART_FCTR, fctr | UART_FCTR_TRGD | UART_FCTR_RX);
  1369. serial_outp(up, UART_TRG, UART_TRG_96);
  1370. serial_outp(up, UART_FCTR, fctr | UART_FCTR_TRGD | UART_FCTR_TX);
  1371. serial_outp(up, UART_TRG, UART_TRG_96);
  1372. serial_outp(up, UART_LCR, 0);
  1373. }
  1374. /*
  1375. * If the "interrupt" for this port doesn't correspond with any
  1376. * hardware interrupt, we use a timer-based system. The original
  1377. * driver used to do this with IRQ0.
  1378. */
  1379. if (!is_real_interrupt(up->port.irq)) {
  1380. unsigned int timeout = up->port.timeout;
  1381. timeout = timeout > 6 ? (timeout / 2 - 2) : 1;
  1382. up->timer.data = (unsigned long)up;
  1383. mod_timer(&up->timer, jiffies + timeout);
  1384. } else {
  1385. retval = serial_link_irq_chain(up);
  1386. if (retval)
  1387. return retval;
  1388. }
  1389. /*
  1390. * Now, initialize the UART
  1391. */
  1392. serial_outp(up, UART_LCR, UART_LCR_WLEN8);
  1393. spin_lock_irqsave(&up->port.lock, flags);
  1394. if (up->port.flags & UPF_FOURPORT) {
  1395. if (!is_real_interrupt(up->port.irq))
  1396. up->port.mctrl |= TIOCM_OUT1;
  1397. } else
  1398. /*
  1399. * Most PC uarts need OUT2 raised to enable interrupts.
  1400. */
  1401. if (is_real_interrupt(up->port.irq))
  1402. up->port.mctrl |= TIOCM_OUT2;
  1403. serial8250_set_mctrl(&up->port, up->port.mctrl);
  1404. /*
  1405. * Do a quick test to see if we receive an
  1406. * interrupt when we enable the TX irq.
  1407. */
  1408. serial_outp(up, UART_IER, UART_IER_THRI);
  1409. lsr = serial_in(up, UART_LSR);
  1410. iir = serial_in(up, UART_IIR);
  1411. serial_outp(up, UART_IER, 0);
  1412. if (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT) {
  1413. if (!(up->bugs & UART_BUG_TXEN)) {
  1414. up->bugs |= UART_BUG_TXEN;
  1415. pr_debug("ttyS%d - enabling bad tx status workarounds\n",
  1416. port->line);
  1417. }
  1418. } else {
  1419. up->bugs &= ~UART_BUG_TXEN;
  1420. }
  1421. spin_unlock_irqrestore(&up->port.lock, flags);
  1422. /*
  1423. * Finally, enable interrupts. Note: Modem status interrupts
  1424. * are set via set_termios(), which will be occurring imminently
  1425. * anyway, so we don't enable them here.
  1426. */
  1427. up->ier = UART_IER_RLSI | UART_IER_RDI;
  1428. serial_outp(up, UART_IER, up->ier);
  1429. if (up->port.flags & UPF_FOURPORT) {
  1430. unsigned int icp;
  1431. /*
  1432. * Enable interrupts on the AST Fourport board
  1433. */
  1434. icp = (up->port.iobase & 0xfe0) | 0x01f;
  1435. outb_p(0x80, icp);
  1436. (void) inb_p(icp);
  1437. }
  1438. /*
  1439. * And clear the interrupt registers again for luck.
  1440. */
  1441. (void) serial_inp(up, UART_LSR);
  1442. (void) serial_inp(up, UART_RX);
  1443. (void) serial_inp(up, UART_IIR);
  1444. (void) serial_inp(up, UART_MSR);
  1445. return 0;
  1446. }
  1447. static void serial8250_shutdown(struct uart_port *port)
  1448. {
  1449. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1450. unsigned long flags;
  1451. /*
  1452. * Disable interrupts from this port
  1453. */
  1454. up->ier = 0;
  1455. serial_outp(up, UART_IER, 0);
  1456. spin_lock_irqsave(&up->port.lock, flags);
  1457. if (up->port.flags & UPF_FOURPORT) {
  1458. /* reset interrupts on the AST Fourport board */
  1459. inb((up->port.iobase & 0xfe0) | 0x1f);
  1460. up->port.mctrl |= TIOCM_OUT1;
  1461. } else
  1462. up->port.mctrl &= ~TIOCM_OUT2;
  1463. serial8250_set_mctrl(&up->port, up->port.mctrl);
  1464. spin_unlock_irqrestore(&up->port.lock, flags);
  1465. /*
  1466. * Disable break condition and FIFOs
  1467. */
  1468. serial_out(up, UART_LCR, serial_inp(up, UART_LCR) & ~UART_LCR_SBC);
  1469. serial8250_clear_fifos(up);
  1470. #ifdef CONFIG_SERIAL_8250_RSA
  1471. /*
  1472. * Reset the RSA board back to 115kbps compat mode.
  1473. */
  1474. disable_rsa(up);
  1475. #endif
  1476. /*
  1477. * Read data port to reset things, and then unlink from
  1478. * the IRQ chain.
  1479. */
  1480. (void) serial_in(up, UART_RX);
  1481. if (!is_real_interrupt(up->port.irq))
  1482. del_timer_sync(&up->timer);
  1483. else
  1484. serial_unlink_irq_chain(up);
  1485. }
  1486. static unsigned int serial8250_get_divisor(struct uart_port *port, unsigned int baud)
  1487. {
  1488. unsigned int quot;
  1489. /*
  1490. * Handle magic divisors for baud rates above baud_base on
  1491. * SMSC SuperIO chips.
  1492. */
  1493. if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
  1494. baud == (port->uartclk/4))
  1495. quot = 0x8001;
  1496. else if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
  1497. baud == (port->uartclk/8))
  1498. quot = 0x8002;
  1499. else
  1500. quot = uart_get_divisor(port, baud);
  1501. return quot;
  1502. }
  1503. static void
  1504. serial8250_set_termios(struct uart_port *port, struct termios *termios,
  1505. struct termios *old)
  1506. {
  1507. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1508. unsigned char cval, fcr = 0;
  1509. unsigned long flags;
  1510. unsigned int baud, quot;
  1511. switch (termios->c_cflag & CSIZE) {
  1512. case CS5:
  1513. cval = UART_LCR_WLEN5;
  1514. break;
  1515. case CS6:
  1516. cval = UART_LCR_WLEN6;
  1517. break;
  1518. case CS7:
  1519. cval = UART_LCR_WLEN7;
  1520. break;
  1521. default:
  1522. case CS8:
  1523. cval = UART_LCR_WLEN8;
  1524. break;
  1525. }
  1526. if (termios->c_cflag & CSTOPB)
  1527. cval |= UART_LCR_STOP;
  1528. if (termios->c_cflag & PARENB)
  1529. cval |= UART_LCR_PARITY;
  1530. if (!(termios->c_cflag & PARODD))
  1531. cval |= UART_LCR_EPAR;
  1532. #ifdef CMSPAR
  1533. if (termios->c_cflag & CMSPAR)
  1534. cval |= UART_LCR_SPAR;
  1535. #endif
  1536. /*
  1537. * Ask the core to calculate the divisor for us.
  1538. */
  1539. baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
  1540. quot = serial8250_get_divisor(port, baud);
  1541. /*
  1542. * Oxford Semi 952 rev B workaround
  1543. */
  1544. if (up->bugs & UART_BUG_QUOT && (quot & 0xff) == 0)
  1545. quot ++;
  1546. if (up->capabilities & UART_CAP_FIFO && up->port.fifosize > 1) {
  1547. if (baud < 2400)
  1548. fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_1;
  1549. else
  1550. fcr = uart_config[up->port.type].fcr;
  1551. }
  1552. /*
  1553. * MCR-based auto flow control. When AFE is enabled, RTS will be
  1554. * deasserted when the receive FIFO contains more characters than
  1555. * the trigger, or the MCR RTS bit is cleared. In the case where
  1556. * the remote UART is not using CTS auto flow control, we must
  1557. * have sufficient FIFO entries for the latency of the remote
  1558. * UART to respond. IOW, at least 32 bytes of FIFO.
  1559. */
  1560. if (up->capabilities & UART_CAP_AFE && up->port.fifosize >= 32) {
  1561. up->mcr &= ~UART_MCR_AFE;
  1562. if (termios->c_cflag & CRTSCTS)
  1563. up->mcr |= UART_MCR_AFE;
  1564. }
  1565. /*
  1566. * Ok, we're now changing the port state. Do it with
  1567. * interrupts disabled.
  1568. */
  1569. spin_lock_irqsave(&up->port.lock, flags);
  1570. /*
  1571. * Update the per-port timeout.
  1572. */
  1573. uart_update_timeout(port, termios->c_cflag, baud);
  1574. up->port.read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
  1575. if (termios->c_iflag & INPCK)
  1576. up->port.read_status_mask |= UART_LSR_FE | UART_LSR_PE;
  1577. if (termios->c_iflag & (BRKINT | PARMRK))
  1578. up->port.read_status_mask |= UART_LSR_BI;
  1579. /*
  1580. * Characteres to ignore
  1581. */
  1582. up->port.ignore_status_mask = 0;
  1583. if (termios->c_iflag & IGNPAR)
  1584. up->port.ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
  1585. if (termios->c_iflag & IGNBRK) {
  1586. up->port.ignore_status_mask |= UART_LSR_BI;
  1587. /*
  1588. * If we're ignoring parity and break indicators,
  1589. * ignore overruns too (for real raw support).
  1590. */
  1591. if (termios->c_iflag & IGNPAR)
  1592. up->port.ignore_status_mask |= UART_LSR_OE;
  1593. }
  1594. /*
  1595. * ignore all characters if CREAD is not set
  1596. */
  1597. if ((termios->c_cflag & CREAD) == 0)
  1598. up->port.ignore_status_mask |= UART_LSR_DR;
  1599. /*
  1600. * CTS flow control flag and modem status interrupts
  1601. */
  1602. up->ier &= ~UART_IER_MSI;
  1603. if (!(up->bugs & UART_BUG_NOMSR) &&
  1604. UART_ENABLE_MS(&up->port, termios->c_cflag))
  1605. up->ier |= UART_IER_MSI;
  1606. if (up->capabilities & UART_CAP_UUE)
  1607. up->ier |= UART_IER_UUE | UART_IER_RTOIE;
  1608. serial_out(up, UART_IER, up->ier);
  1609. if (up->capabilities & UART_CAP_EFR) {
  1610. unsigned char efr = 0;
  1611. /*
  1612. * TI16C752/Startech hardware flow control. FIXME:
  1613. * - TI16C752 requires control thresholds to be set.
  1614. * - UART_MCR_RTS is ineffective if auto-RTS mode is enabled.
  1615. */
  1616. if (termios->c_cflag & CRTSCTS)
  1617. efr |= UART_EFR_CTS;
  1618. serial_outp(up, UART_LCR, 0xBF);
  1619. serial_outp(up, UART_EFR, efr);
  1620. }
  1621. if (up->capabilities & UART_NATSEMI) {
  1622. /* Switch to bank 2 not bank 1, to avoid resetting EXCR2 */
  1623. serial_outp(up, UART_LCR, 0xe0);
  1624. } else {
  1625. serial_outp(up, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */
  1626. }
  1627. serial_dl_write(up, quot);
  1628. /*
  1629. * LCR DLAB must be set to enable 64-byte FIFO mode. If the FCR
  1630. * is written without DLAB set, this mode will be disabled.
  1631. */
  1632. if (up->port.type == PORT_16750)
  1633. serial_outp(up, UART_FCR, fcr);
  1634. serial_outp(up, UART_LCR, cval); /* reset DLAB */
  1635. up->lcr = cval; /* Save LCR */
  1636. if (up->port.type != PORT_16750) {
  1637. if (fcr & UART_FCR_ENABLE_FIFO) {
  1638. /* emulated UARTs (Lucent Venus 167x) need two steps */
  1639. serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
  1640. }
  1641. serial_outp(up, UART_FCR, fcr); /* set fcr */
  1642. }
  1643. serial8250_set_mctrl(&up->port, up->port.mctrl);
  1644. spin_unlock_irqrestore(&up->port.lock, flags);
  1645. }
  1646. static void
  1647. serial8250_pm(struct uart_port *port, unsigned int state,
  1648. unsigned int oldstate)
  1649. {
  1650. struct uart_8250_port *p = (struct uart_8250_port *)port;
  1651. serial8250_set_sleep(p, state != 0);
  1652. if (p->pm)
  1653. p->pm(port, state, oldstate);
  1654. }
  1655. /*
  1656. * Resource handling.
  1657. */
  1658. static int serial8250_request_std_resource(struct uart_8250_port *up)
  1659. {
  1660. unsigned int size = 8 << up->port.regshift;
  1661. int ret = 0;
  1662. switch (up->port.iotype) {
  1663. case UPIO_AU:
  1664. size = 0x100000;
  1665. /* fall thru */
  1666. case UPIO_MEM:
  1667. if (!up->port.mapbase)
  1668. break;
  1669. if (!request_mem_region(up->port.mapbase, size, "serial")) {
  1670. ret = -EBUSY;
  1671. break;
  1672. }
  1673. if (up->port.flags & UPF_IOREMAP) {
  1674. up->port.membase = ioremap(up->port.mapbase, size);
  1675. if (!up->port.membase) {
  1676. release_mem_region(up->port.mapbase, size);
  1677. ret = -ENOMEM;
  1678. }
  1679. }
  1680. break;
  1681. case UPIO_HUB6:
  1682. case UPIO_PORT:
  1683. if (!request_region(up->port.iobase, size, "serial"))
  1684. ret = -EBUSY;
  1685. break;
  1686. }
  1687. return ret;
  1688. }
  1689. static void serial8250_release_std_resource(struct uart_8250_port *up)
  1690. {
  1691. unsigned int size = 8 << up->port.regshift;
  1692. switch (up->port.iotype) {
  1693. case UPIO_AU:
  1694. size = 0x100000;
  1695. /* fall thru */
  1696. case UPIO_MEM:
  1697. if (!up->port.mapbase)
  1698. break;
  1699. if (up->port.flags & UPF_IOREMAP) {
  1700. iounmap(up->port.membase);
  1701. up->port.membase = NULL;
  1702. }
  1703. release_mem_region(up->port.mapbase, size);
  1704. break;
  1705. case UPIO_HUB6:
  1706. case UPIO_PORT:
  1707. release_region(up->port.iobase, size);
  1708. break;
  1709. }
  1710. }
  1711. static int serial8250_request_rsa_resource(struct uart_8250_port *up)
  1712. {
  1713. unsigned long start = UART_RSA_BASE << up->port.regshift;
  1714. unsigned int size = 8 << up->port.regshift;
  1715. int ret = 0;
  1716. switch (up->port.iotype) {
  1717. case UPIO_MEM:
  1718. ret = -EINVAL;
  1719. break;
  1720. case UPIO_HUB6:
  1721. case UPIO_PORT:
  1722. start += up->port.iobase;
  1723. if (!request_region(start, size, "serial-rsa"))
  1724. ret = -EBUSY;
  1725. break;
  1726. }
  1727. return ret;
  1728. }
  1729. static void serial8250_release_rsa_resource(struct uart_8250_port *up)
  1730. {
  1731. unsigned long offset = UART_RSA_BASE << up->port.regshift;
  1732. unsigned int size = 8 << up->port.regshift;
  1733. switch (up->port.iotype) {
  1734. case UPIO_MEM:
  1735. break;
  1736. case UPIO_HUB6:
  1737. case UPIO_PORT:
  1738. release_region(up->port.iobase + offset, size);
  1739. break;
  1740. }
  1741. }
  1742. static void serial8250_release_port(struct uart_port *port)
  1743. {
  1744. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1745. serial8250_release_std_resource(up);
  1746. if (up->port.type == PORT_RSA)
  1747. serial8250_release_rsa_resource(up);
  1748. }
  1749. static int serial8250_request_port(struct uart_port *port)
  1750. {
  1751. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1752. int ret = 0;
  1753. ret = serial8250_request_std_resource(up);
  1754. if (ret == 0 && up->port.type == PORT_RSA) {
  1755. ret = serial8250_request_rsa_resource(up);
  1756. if (ret < 0)
  1757. serial8250_release_std_resource(up);
  1758. }
  1759. return ret;
  1760. }
  1761. static void serial8250_config_port(struct uart_port *port, int flags)
  1762. {
  1763. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1764. int probeflags = PROBE_ANY;
  1765. int ret;
  1766. /*
  1767. * Find the region that we can probe for. This in turn
  1768. * tells us whether we can probe for the type of port.
  1769. */
  1770. ret = serial8250_request_std_resource(up);
  1771. if (ret < 0)
  1772. return;
  1773. ret = serial8250_request_rsa_resource(up);
  1774. if (ret < 0)
  1775. probeflags &= ~PROBE_RSA;
  1776. if (flags & UART_CONFIG_TYPE)
  1777. autoconfig(up, probeflags);
  1778. if (up->port.type != PORT_UNKNOWN && flags & UART_CONFIG_IRQ)
  1779. autoconfig_irq(up);
  1780. if (up->port.type != PORT_RSA && probeflags & PROBE_RSA)
  1781. serial8250_release_rsa_resource(up);
  1782. if (up->port.type == PORT_UNKNOWN)
  1783. serial8250_release_std_resource(up);
  1784. }
  1785. static int
  1786. serial8250_verify_port(struct uart_port *port, struct serial_struct *ser)
  1787. {
  1788. if (ser->irq >= NR_IRQS || ser->irq < 0 ||
  1789. ser->baud_base < 9600 || ser->type < PORT_UNKNOWN ||
  1790. ser->type >= ARRAY_SIZE(uart_config) || ser->type == PORT_CIRRUS ||
  1791. ser->type == PORT_STARTECH)
  1792. return -EINVAL;
  1793. return 0;
  1794. }
  1795. static const char *
  1796. serial8250_type(struct uart_port *port)
  1797. {
  1798. int type = port->type;
  1799. if (type >= ARRAY_SIZE(uart_config))
  1800. type = 0;
  1801. return uart_config[type].name;
  1802. }
  1803. static struct uart_ops serial8250_pops = {
  1804. .tx_empty = serial8250_tx_empty,
  1805. .set_mctrl = serial8250_set_mctrl,
  1806. .get_mctrl = serial8250_get_mctrl,
  1807. .stop_tx = serial8250_stop_tx,
  1808. .start_tx = serial8250_start_tx,
  1809. .stop_rx = serial8250_stop_rx,
  1810. .enable_ms = serial8250_enable_ms,
  1811. .break_ctl = serial8250_break_ctl,
  1812. .startup = serial8250_startup,
  1813. .shutdown = serial8250_shutdown,
  1814. .set_termios = serial8250_set_termios,
  1815. .pm = serial8250_pm,
  1816. .type = serial8250_type,
  1817. .release_port = serial8250_release_port,
  1818. .request_port = serial8250_request_port,
  1819. .config_port = serial8250_config_port,
  1820. .verify_port = serial8250_verify_port,
  1821. };
  1822. static struct uart_8250_port serial8250_ports[UART_NR];
  1823. static void __init serial8250_isa_init_ports(void)
  1824. {
  1825. struct uart_8250_port *up;
  1826. static int first = 1;
  1827. int i;
  1828. if (!first)
  1829. return;
  1830. first = 0;
  1831. for (i = 0; i < nr_uarts; i++) {
  1832. struct uart_8250_port *up = &serial8250_ports[i];
  1833. up->port.line = i;
  1834. spin_lock_init(&up->port.lock);
  1835. init_timer(&up->timer);
  1836. up->timer.function = serial8250_timeout;
  1837. /*
  1838. * ALPHA_KLUDGE_MCR needs to be killed.
  1839. */
  1840. up->mcr_mask = ~ALPHA_KLUDGE_MCR;
  1841. up->mcr_force = ALPHA_KLUDGE_MCR;
  1842. up->port.ops = &serial8250_pops;
  1843. }
  1844. for (i = 0, up = serial8250_ports;
  1845. i < ARRAY_SIZE(old_serial_port) && i < nr_uarts;
  1846. i++, up++) {
  1847. up->port.iobase = old_serial_port[i].port;
  1848. up->port.irq = irq_canonicalize(old_serial_port[i].irq);
  1849. up->port.uartclk = old_serial_port[i].baud_base * 16;
  1850. up->port.flags = old_serial_port[i].flags;
  1851. up->port.hub6 = old_serial_port[i].hub6;
  1852. up->port.membase = old_serial_port[i].iomem_base;
  1853. up->port.iotype = old_serial_port[i].io_type;
  1854. up->port.regshift = old_serial_port[i].iomem_reg_shift;
  1855. if (share_irqs)
  1856. up->port.flags |= UPF_SHARE_IRQ;
  1857. }
  1858. }
  1859. static void __init
  1860. serial8250_register_ports(struct uart_driver *drv, struct device *dev)
  1861. {
  1862. int i;
  1863. serial8250_isa_init_ports();
  1864. for (i = 0; i < nr_uarts; i++) {
  1865. struct uart_8250_port *up = &serial8250_ports[i];
  1866. up->port.dev = dev;
  1867. uart_add_one_port(drv, &up->port);
  1868. }
  1869. }
  1870. #ifdef CONFIG_SERIAL_8250_CONSOLE
  1871. #define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
  1872. /*
  1873. * Wait for transmitter & holding register to empty
  1874. */
  1875. static inline void wait_for_xmitr(struct uart_8250_port *up, int bits)
  1876. {
  1877. unsigned int status, tmout = 10000;
  1878. /* Wait up to 10ms for the character(s) to be sent. */
  1879. do {
  1880. status = serial_in(up, UART_LSR);
  1881. if (status & UART_LSR_BI)
  1882. up->lsr_break_flag = UART_LSR_BI;
  1883. if (--tmout == 0)
  1884. break;
  1885. udelay(1);
  1886. } while ((status & bits) != bits);
  1887. /* Wait up to 1s for flow control if necessary */
  1888. if (up->port.flags & UPF_CONS_FLOW) {
  1889. tmout = 1000000;
  1890. while (--tmout &&
  1891. ((serial_in(up, UART_MSR) & UART_MSR_CTS) == 0))
  1892. udelay(1);
  1893. }
  1894. }
  1895. static void serial8250_console_putchar(struct uart_port *port, int ch)
  1896. {
  1897. struct uart_8250_port *up = (struct uart_8250_port *)port;
  1898. wait_for_xmitr(up, UART_LSR_THRE);
  1899. serial_out(up, UART_TX, ch);
  1900. }
  1901. /*
  1902. * Print a string to the serial port trying not to disturb
  1903. * any possible real use of the port...
  1904. *
  1905. * The console_lock must be held when we get here.
  1906. */
  1907. static void
  1908. serial8250_console_write(struct console *co, const char *s, unsigned int count)
  1909. {
  1910. struct uart_8250_port *up = &serial8250_ports[co->index];
  1911. unsigned int ier;
  1912. touch_nmi_watchdog();
  1913. /*
  1914. * First save the IER then disable the interrupts
  1915. */
  1916. ier = serial_in(up, UART_IER);
  1917. if (up->capabilities & UART_CAP_UUE)
  1918. serial_out(up, UART_IER, UART_IER_UUE);
  1919. else
  1920. serial_out(up, UART_IER, 0);
  1921. uart_console_write(&up->port, s, count, serial8250_console_putchar);
  1922. /*
  1923. * Finally, wait for transmitter to become empty
  1924. * and restore the IER
  1925. */
  1926. wait_for_xmitr(up, BOTH_EMPTY);
  1927. serial_out(up, UART_IER, ier);
  1928. }
  1929. static int serial8250_console_setup(struct console *co, char *options)
  1930. {
  1931. struct uart_port *port;
  1932. int baud = 9600;
  1933. int bits = 8;
  1934. int parity = 'n';
  1935. int flow = 'n';
  1936. /*
  1937. * Check whether an invalid uart number has been specified, and
  1938. * if so, search for the first available port that does have
  1939. * console support.
  1940. */
  1941. if (co->index >= nr_uarts)
  1942. co->index = 0;
  1943. port = &serial8250_ports[co->index].port;
  1944. if (!port->iobase && !port->membase)
  1945. return -ENODEV;
  1946. if (options)
  1947. uart_parse_options(options, &baud, &parity, &bits, &flow);
  1948. return uart_set_options(port, co, baud, parity, bits, flow);
  1949. }
  1950. static struct uart_driver serial8250_reg;
  1951. static struct console serial8250_console = {
  1952. .name = "ttyS",
  1953. .write = serial8250_console_write,
  1954. .device = uart_console_device,
  1955. .setup = serial8250_console_setup,
  1956. .flags = CON_PRINTBUFFER,
  1957. .index = -1,
  1958. .data = &serial8250_reg,
  1959. };
  1960. static int __init serial8250_console_init(void)
  1961. {
  1962. serial8250_isa_init_ports();
  1963. register_console(&serial8250_console);
  1964. return 0;
  1965. }
  1966. console_initcall(serial8250_console_init);
  1967. static int __init find_port(struct uart_port *p)
  1968. {
  1969. int line;
  1970. struct uart_port *port;
  1971. for (line = 0; line < nr_uarts; line++) {
  1972. port = &serial8250_ports[line].port;
  1973. if (uart_match_port(p, port))
  1974. return line;
  1975. }
  1976. return -ENODEV;
  1977. }
  1978. int __init serial8250_start_console(struct uart_port *port, char *options)
  1979. {
  1980. int line;
  1981. line = find_port(port);
  1982. if (line < 0)
  1983. return -ENODEV;
  1984. add_preferred_console("ttyS", line, options);
  1985. printk("Adding console on ttyS%d at %s 0x%lx (options '%s')\n",
  1986. line, port->iotype == UPIO_MEM ? "MMIO" : "I/O port",
  1987. port->iotype == UPIO_MEM ? (unsigned long) port->mapbase :
  1988. (unsigned long) port->iobase, options);
  1989. if (!(serial8250_console.flags & CON_ENABLED)) {
  1990. serial8250_console.flags &= ~CON_PRINTBUFFER;
  1991. register_console(&serial8250_console);
  1992. }
  1993. return line;
  1994. }
  1995. #define SERIAL8250_CONSOLE &serial8250_console
  1996. #else
  1997. #define SERIAL8250_CONSOLE NULL
  1998. #endif
  1999. static struct uart_driver serial8250_reg = {
  2000. .owner = THIS_MODULE,
  2001. .driver_name = "serial",
  2002. .devfs_name = "tts/",
  2003. .dev_name = "ttyS",
  2004. .major = TTY_MAJOR,
  2005. .minor = 64,
  2006. .nr = UART_NR,
  2007. .cons = SERIAL8250_CONSOLE,
  2008. };
  2009. /*
  2010. * early_serial_setup - early registration for 8250 ports
  2011. *
  2012. * Setup an 8250 port structure prior to console initialisation. Use
  2013. * after console initialisation will cause undefined behaviour.
  2014. */
  2015. int __init early_serial_setup(struct uart_port *port)
  2016. {
  2017. if (port->line >= ARRAY_SIZE(serial8250_ports))
  2018. return -ENODEV;
  2019. serial8250_isa_init_ports();
  2020. serial8250_ports[port->line].port = *port;
  2021. serial8250_ports[port->line].port.ops = &serial8250_pops;
  2022. return 0;
  2023. }
  2024. /**
  2025. * serial8250_suspend_port - suspend one serial port
  2026. * @line: serial line number
  2027. * @level: the level of port suspension, as per uart_suspend_port
  2028. *
  2029. * Suspend one serial port.
  2030. */
  2031. void serial8250_suspend_port(int line)
  2032. {
  2033. uart_suspend_port(&serial8250_reg, &serial8250_ports[line].port);
  2034. }
  2035. /**
  2036. * serial8250_resume_port - resume one serial port
  2037. * @line: serial line number
  2038. * @level: the level of port resumption, as per uart_resume_port
  2039. *
  2040. * Resume one serial port.
  2041. */
  2042. void serial8250_resume_port(int line)
  2043. {
  2044. uart_resume_port(&serial8250_reg, &serial8250_ports[line].port);
  2045. }
  2046. /*
  2047. * Register a set of serial devices attached to a platform device. The
  2048. * list is terminated with a zero flags entry, which means we expect
  2049. * all entries to have at least UPF_BOOT_AUTOCONF set.
  2050. */
  2051. static int __devinit serial8250_probe(struct platform_device *dev)
  2052. {
  2053. struct plat_serial8250_port *p = dev->dev.platform_data;
  2054. struct uart_port port;
  2055. int ret, i;
  2056. memset(&port, 0, sizeof(struct uart_port));
  2057. for (i = 0; p && p->flags != 0; p++, i++) {
  2058. port.iobase = p->iobase;
  2059. port.membase = p->membase;
  2060. port.irq = p->irq;
  2061. port.uartclk = p->uartclk;
  2062. port.regshift = p->regshift;
  2063. port.iotype = p->iotype;
  2064. port.flags = p->flags;
  2065. port.mapbase = p->mapbase;
  2066. port.hub6 = p->hub6;
  2067. port.dev = &dev->dev;
  2068. if (share_irqs)
  2069. port.flags |= UPF_SHARE_IRQ;
  2070. ret = serial8250_register_port(&port);
  2071. if (ret < 0) {
  2072. dev_err(&dev->dev, "unable to register port at index %d "
  2073. "(IO%lx MEM%lx IRQ%d): %d\n", i,
  2074. p->iobase, p->mapbase, p->irq, ret);
  2075. }
  2076. }
  2077. return 0;
  2078. }
  2079. /*
  2080. * Remove serial ports registered against a platform device.
  2081. */
  2082. static int __devexit serial8250_remove(struct platform_device *dev)
  2083. {
  2084. int i;
  2085. for (i = 0; i < nr_uarts; i++) {
  2086. struct uart_8250_port *up = &serial8250_ports[i];
  2087. if (up->port.dev == &dev->dev)
  2088. serial8250_unregister_port(i);
  2089. }
  2090. return 0;
  2091. }
  2092. static int serial8250_suspend(struct platform_device *dev, pm_message_t state)
  2093. {
  2094. int i;
  2095. for (i = 0; i < UART_NR; i++) {
  2096. struct uart_8250_port *up = &serial8250_ports[i];
  2097. if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
  2098. uart_suspend_port(&serial8250_reg, &up->port);
  2099. }
  2100. return 0;
  2101. }
  2102. static int serial8250_resume(struct platform_device *dev)
  2103. {
  2104. int i;
  2105. for (i = 0; i < UART_NR; i++) {
  2106. struct uart_8250_port *up = &serial8250_ports[i];
  2107. if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
  2108. uart_resume_port(&serial8250_reg, &up->port);
  2109. }
  2110. return 0;
  2111. }
  2112. static struct platform_driver serial8250_isa_driver = {
  2113. .probe = serial8250_probe,
  2114. .remove = __devexit_p(serial8250_remove),
  2115. .suspend = serial8250_suspend,
  2116. .resume = serial8250_resume,
  2117. .driver = {
  2118. .name = "serial8250",
  2119. .owner = THIS_MODULE,
  2120. },
  2121. };
  2122. /*
  2123. * This "device" covers _all_ ISA 8250-compatible serial devices listed
  2124. * in the table in include/asm/serial.h
  2125. */
  2126. static struct platform_device *serial8250_isa_devs;
  2127. /*
  2128. * serial8250_register_port and serial8250_unregister_port allows for
  2129. * 16x50 serial ports to be configured at run-time, to support PCMCIA
  2130. * modems and PCI multiport cards.
  2131. */
  2132. static DEFINE_MUTEX(serial_mutex);
  2133. static struct uart_8250_port *serial8250_find_match_or_unused(struct uart_port *port)
  2134. {
  2135. int i;
  2136. /*
  2137. * First, find a port entry which matches.
  2138. */
  2139. for (i = 0; i < nr_uarts; i++)
  2140. if (uart_match_port(&serial8250_ports[i].port, port))
  2141. return &serial8250_ports[i];
  2142. /*
  2143. * We didn't find a matching entry, so look for the first
  2144. * free entry. We look for one which hasn't been previously
  2145. * used (indicated by zero iobase).
  2146. */
  2147. for (i = 0; i < nr_uarts; i++)
  2148. if (serial8250_ports[i].port.type == PORT_UNKNOWN &&
  2149. serial8250_ports[i].port.iobase == 0)
  2150. return &serial8250_ports[i];
  2151. /*
  2152. * That also failed. Last resort is to find any entry which
  2153. * doesn't have a real port associated with it.
  2154. */
  2155. for (i = 0; i < nr_uarts; i++)
  2156. if (serial8250_ports[i].port.type == PORT_UNKNOWN)
  2157. return &serial8250_ports[i];
  2158. return NULL;
  2159. }
  2160. /**
  2161. * serial8250_register_port - register a serial port
  2162. * @port: serial port template
  2163. *
  2164. * Configure the serial port specified by the request. If the
  2165. * port exists and is in use, it is hung up and unregistered
  2166. * first.
  2167. *
  2168. * The port is then probed and if necessary the IRQ is autodetected
  2169. * If this fails an error is returned.
  2170. *
  2171. * On success the port is ready to use and the line number is returned.
  2172. */
  2173. int serial8250_register_port(struct uart_port *port)
  2174. {
  2175. struct uart_8250_port *uart;
  2176. int ret = -ENOSPC;
  2177. if (port->uartclk == 0)
  2178. return -EINVAL;
  2179. mutex_lock(&serial_mutex);
  2180. uart = serial8250_find_match_or_unused(port);
  2181. if (uart) {
  2182. uart_remove_one_port(&serial8250_reg, &uart->port);
  2183. uart->port.iobase = port->iobase;
  2184. uart->port.membase = port->membase;
  2185. uart->port.irq = port->irq;
  2186. uart->port.uartclk = port->uartclk;
  2187. uart->port.fifosize = port->fifosize;
  2188. uart->port.regshift = port->regshift;
  2189. uart->port.iotype = port->iotype;
  2190. uart->port.flags = port->flags | UPF_BOOT_AUTOCONF;
  2191. uart->port.mapbase = port->mapbase;
  2192. if (port->dev)
  2193. uart->port.dev = port->dev;
  2194. ret = uart_add_one_port(&serial8250_reg, &uart->port);
  2195. if (ret == 0)
  2196. ret = uart->port.line;
  2197. }
  2198. mutex_unlock(&serial_mutex);
  2199. return ret;
  2200. }
  2201. EXPORT_SYMBOL(serial8250_register_port);
  2202. /**
  2203. * serial8250_unregister_port - remove a 16x50 serial port at runtime
  2204. * @line: serial line number
  2205. *
  2206. * Remove one serial port. This may not be called from interrupt
  2207. * context. We hand the port back to the our control.
  2208. */
  2209. void serial8250_unregister_port(int line)
  2210. {
  2211. struct uart_8250_port *uart = &serial8250_ports[line];
  2212. mutex_lock(&serial_mutex);
  2213. uart_remove_one_port(&serial8250_reg, &uart->port);
  2214. if (serial8250_isa_devs) {
  2215. uart->port.flags &= ~UPF_BOOT_AUTOCONF;
  2216. uart->port.type = PORT_UNKNOWN;
  2217. uart->port.dev = &serial8250_isa_devs->dev;
  2218. uart_add_one_port(&serial8250_reg, &uart->port);
  2219. } else {
  2220. uart->port.dev = NULL;
  2221. }
  2222. mutex_unlock(&serial_mutex);
  2223. }
  2224. EXPORT_SYMBOL(serial8250_unregister_port);
  2225. static int __init serial8250_init(void)
  2226. {
  2227. int ret, i;
  2228. if (nr_uarts > UART_NR)
  2229. nr_uarts = UART_NR;
  2230. printk(KERN_INFO "Serial: 8250/16550 driver $Revision: 1.90 $ "
  2231. "%d ports, IRQ sharing %sabled\n", nr_uarts,
  2232. share_irqs ? "en" : "dis");
  2233. for (i = 0; i < NR_IRQS; i++)
  2234. spin_lock_init(&irq_lists[i].lock);
  2235. ret = uart_register_driver(&serial8250_reg);
  2236. if (ret)
  2237. goto out;
  2238. serial8250_isa_devs = platform_device_alloc("serial8250",
  2239. PLAT8250_DEV_LEGACY);
  2240. if (!serial8250_isa_devs) {
  2241. ret = -ENOMEM;
  2242. goto unreg_uart_drv;
  2243. }
  2244. ret = platform_device_add(serial8250_isa_devs);
  2245. if (ret)
  2246. goto put_dev;
  2247. serial8250_register_ports(&serial8250_reg, &serial8250_isa_devs->dev);
  2248. ret = platform_driver_register(&serial8250_isa_driver);
  2249. if (ret == 0)
  2250. goto out;
  2251. platform_device_del(serial8250_isa_devs);
  2252. put_dev:
  2253. platform_device_put(serial8250_isa_devs);
  2254. unreg_uart_drv:
  2255. uart_unregister_driver(&serial8250_reg);
  2256. out:
  2257. return ret;
  2258. }
  2259. static void __exit serial8250_exit(void)
  2260. {
  2261. struct platform_device *isa_dev = serial8250_isa_devs;
  2262. /*
  2263. * This tells serial8250_unregister_port() not to re-register
  2264. * the ports (thereby making serial8250_isa_driver permanently
  2265. * in use.)
  2266. */
  2267. serial8250_isa_devs = NULL;
  2268. platform_driver_unregister(&serial8250_isa_driver);
  2269. platform_device_unregister(isa_dev);
  2270. uart_unregister_driver(&serial8250_reg);
  2271. }
  2272. module_init(serial8250_init);
  2273. module_exit(serial8250_exit);
  2274. EXPORT_SYMBOL(serial8250_suspend_port);
  2275. EXPORT_SYMBOL(serial8250_resume_port);
  2276. MODULE_LICENSE("GPL");
  2277. MODULE_DESCRIPTION("Generic 8250/16x50 serial driver $Revision: 1.90 $");
  2278. module_param(share_irqs, uint, 0644);
  2279. MODULE_PARM_DESC(share_irqs, "Share IRQs with other non-8250/16x50 devices"
  2280. " (unsafe)");
  2281. module_param(nr_uarts, uint, 0644);
  2282. MODULE_PARM_DESC(nr_uarts, "Maximum number of UARTs supported. (1-" __MODULE_STRING(CONFIG_SERIAL_8250_NR_UARTS) ")");
  2283. #ifdef CONFIG_SERIAL_8250_RSA
  2284. module_param_array(probe_rsa, ulong, &probe_rsa_count, 0444);
  2285. MODULE_PARM_DESC(probe_rsa, "Probe I/O ports for RSA");
  2286. #endif
  2287. MODULE_ALIAS_CHARDEV_MAJOR(TTY_MAJOR);