8250.c 70 KB

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