8250.c 65 KB

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