pch_uart.c 36 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451
  1. /*
  2. *Copyright (C) 2010 OKI SEMICONDUCTOR CO., LTD.
  3. *
  4. *This program is free software; you can redistribute it and/or modify
  5. *it under the terms of the GNU General Public License as published by
  6. *the Free Software Foundation; version 2 of the License.
  7. *
  8. *This program is distributed in the hope that it will be useful,
  9. *but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. *MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. *GNU General Public License for more details.
  12. *
  13. *You should have received a copy of the GNU General Public License
  14. *along with this program; if not, write to the Free Software
  15. *Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
  16. */
  17. #include <linux/serial_reg.h>
  18. #include <linux/pci.h>
  19. #include <linux/module.h>
  20. #include <linux/pci.h>
  21. #include <linux/serial_core.h>
  22. #include <linux/interrupt.h>
  23. #include <linux/io.h>
  24. #include <linux/dmaengine.h>
  25. #include <linux/pch_dma.h>
  26. enum {
  27. PCH_UART_HANDLED_RX_INT_SHIFT,
  28. PCH_UART_HANDLED_TX_INT_SHIFT,
  29. PCH_UART_HANDLED_RX_ERR_INT_SHIFT,
  30. PCH_UART_HANDLED_RX_TRG_INT_SHIFT,
  31. PCH_UART_HANDLED_MS_INT_SHIFT,
  32. };
  33. enum {
  34. PCH_UART_8LINE,
  35. PCH_UART_2LINE,
  36. };
  37. #define PCH_UART_DRIVER_DEVICE "ttyPCH"
  38. #define PCH_UART_NR_GE_256FIFO 1
  39. #define PCH_UART_NR_GE_64FIFO 3
  40. #define PCH_UART_NR_GE (PCH_UART_NR_GE_256FIFO+PCH_UART_NR_GE_64FIFO)
  41. #define PCH_UART_NR PCH_UART_NR_GE
  42. #define PCH_UART_HANDLED_RX_INT (1<<((PCH_UART_HANDLED_RX_INT_SHIFT)<<1))
  43. #define PCH_UART_HANDLED_TX_INT (1<<((PCH_UART_HANDLED_TX_INT_SHIFT)<<1))
  44. #define PCH_UART_HANDLED_RX_ERR_INT (1<<((\
  45. PCH_UART_HANDLED_RX_ERR_INT_SHIFT)<<1))
  46. #define PCH_UART_HANDLED_RX_TRG_INT (1<<((\
  47. PCH_UART_HANDLED_RX_TRG_INT_SHIFT)<<1))
  48. #define PCH_UART_HANDLED_MS_INT (1<<((PCH_UART_HANDLED_MS_INT_SHIFT)<<1))
  49. #define PCH_UART_RBR 0x00
  50. #define PCH_UART_THR 0x00
  51. #define PCH_UART_IER_MASK (PCH_UART_IER_ERBFI|PCH_UART_IER_ETBEI|\
  52. PCH_UART_IER_ELSI|PCH_UART_IER_EDSSI)
  53. #define PCH_UART_IER_ERBFI 0x00000001
  54. #define PCH_UART_IER_ETBEI 0x00000002
  55. #define PCH_UART_IER_ELSI 0x00000004
  56. #define PCH_UART_IER_EDSSI 0x00000008
  57. #define PCH_UART_IIR_IP 0x00000001
  58. #define PCH_UART_IIR_IID 0x00000006
  59. #define PCH_UART_IIR_MSI 0x00000000
  60. #define PCH_UART_IIR_TRI 0x00000002
  61. #define PCH_UART_IIR_RRI 0x00000004
  62. #define PCH_UART_IIR_REI 0x00000006
  63. #define PCH_UART_IIR_TOI 0x00000008
  64. #define PCH_UART_IIR_FIFO256 0x00000020
  65. #define PCH_UART_IIR_FIFO64 PCH_UART_IIR_FIFO256
  66. #define PCH_UART_IIR_FE 0x000000C0
  67. #define PCH_UART_FCR_FIFOE 0x00000001
  68. #define PCH_UART_FCR_RFR 0x00000002
  69. #define PCH_UART_FCR_TFR 0x00000004
  70. #define PCH_UART_FCR_DMS 0x00000008
  71. #define PCH_UART_FCR_FIFO256 0x00000020
  72. #define PCH_UART_FCR_RFTL 0x000000C0
  73. #define PCH_UART_FCR_RFTL1 0x00000000
  74. #define PCH_UART_FCR_RFTL64 0x00000040
  75. #define PCH_UART_FCR_RFTL128 0x00000080
  76. #define PCH_UART_FCR_RFTL224 0x000000C0
  77. #define PCH_UART_FCR_RFTL16 PCH_UART_FCR_RFTL64
  78. #define PCH_UART_FCR_RFTL32 PCH_UART_FCR_RFTL128
  79. #define PCH_UART_FCR_RFTL56 PCH_UART_FCR_RFTL224
  80. #define PCH_UART_FCR_RFTL4 PCH_UART_FCR_RFTL64
  81. #define PCH_UART_FCR_RFTL8 PCH_UART_FCR_RFTL128
  82. #define PCH_UART_FCR_RFTL14 PCH_UART_FCR_RFTL224
  83. #define PCH_UART_FCR_RFTL_SHIFT 6
  84. #define PCH_UART_LCR_WLS 0x00000003
  85. #define PCH_UART_LCR_STB 0x00000004
  86. #define PCH_UART_LCR_PEN 0x00000008
  87. #define PCH_UART_LCR_EPS 0x00000010
  88. #define PCH_UART_LCR_SP 0x00000020
  89. #define PCH_UART_LCR_SB 0x00000040
  90. #define PCH_UART_LCR_DLAB 0x00000080
  91. #define PCH_UART_LCR_NP 0x00000000
  92. #define PCH_UART_LCR_OP PCH_UART_LCR_PEN
  93. #define PCH_UART_LCR_EP (PCH_UART_LCR_PEN | PCH_UART_LCR_EPS)
  94. #define PCH_UART_LCR_1P (PCH_UART_LCR_PEN | PCH_UART_LCR_SP)
  95. #define PCH_UART_LCR_0P (PCH_UART_LCR_PEN | PCH_UART_LCR_EPS |\
  96. PCH_UART_LCR_SP)
  97. #define PCH_UART_LCR_5BIT 0x00000000
  98. #define PCH_UART_LCR_6BIT 0x00000001
  99. #define PCH_UART_LCR_7BIT 0x00000002
  100. #define PCH_UART_LCR_8BIT 0x00000003
  101. #define PCH_UART_MCR_DTR 0x00000001
  102. #define PCH_UART_MCR_RTS 0x00000002
  103. #define PCH_UART_MCR_OUT 0x0000000C
  104. #define PCH_UART_MCR_LOOP 0x00000010
  105. #define PCH_UART_MCR_AFE 0x00000020
  106. #define PCH_UART_LSR_DR 0x00000001
  107. #define PCH_UART_LSR_ERR (1<<7)
  108. #define PCH_UART_MSR_DCTS 0x00000001
  109. #define PCH_UART_MSR_DDSR 0x00000002
  110. #define PCH_UART_MSR_TERI 0x00000004
  111. #define PCH_UART_MSR_DDCD 0x00000008
  112. #define PCH_UART_MSR_CTS 0x00000010
  113. #define PCH_UART_MSR_DSR 0x00000020
  114. #define PCH_UART_MSR_RI 0x00000040
  115. #define PCH_UART_MSR_DCD 0x00000080
  116. #define PCH_UART_MSR_DELTA (PCH_UART_MSR_DCTS | PCH_UART_MSR_DDSR |\
  117. PCH_UART_MSR_TERI | PCH_UART_MSR_DDCD)
  118. #define PCH_UART_DLL 0x00
  119. #define PCH_UART_DLM 0x01
  120. #define DIV_ROUND(a, b) (((a) + ((b)/2)) / (b))
  121. #define PCH_UART_IID_RLS (PCH_UART_IIR_REI)
  122. #define PCH_UART_IID_RDR (PCH_UART_IIR_RRI)
  123. #define PCH_UART_IID_RDR_TO (PCH_UART_IIR_RRI | PCH_UART_IIR_TOI)
  124. #define PCH_UART_IID_THRE (PCH_UART_IIR_TRI)
  125. #define PCH_UART_IID_MS (PCH_UART_IIR_MSI)
  126. #define PCH_UART_HAL_PARITY_NONE (PCH_UART_LCR_NP)
  127. #define PCH_UART_HAL_PARITY_ODD (PCH_UART_LCR_OP)
  128. #define PCH_UART_HAL_PARITY_EVEN (PCH_UART_LCR_EP)
  129. #define PCH_UART_HAL_PARITY_FIX1 (PCH_UART_LCR_1P)
  130. #define PCH_UART_HAL_PARITY_FIX0 (PCH_UART_LCR_0P)
  131. #define PCH_UART_HAL_5BIT (PCH_UART_LCR_5BIT)
  132. #define PCH_UART_HAL_6BIT (PCH_UART_LCR_6BIT)
  133. #define PCH_UART_HAL_7BIT (PCH_UART_LCR_7BIT)
  134. #define PCH_UART_HAL_8BIT (PCH_UART_LCR_8BIT)
  135. #define PCH_UART_HAL_STB1 0
  136. #define PCH_UART_HAL_STB2 (PCH_UART_LCR_STB)
  137. #define PCH_UART_HAL_CLR_TX_FIFO (PCH_UART_FCR_TFR)
  138. #define PCH_UART_HAL_CLR_RX_FIFO (PCH_UART_FCR_RFR)
  139. #define PCH_UART_HAL_CLR_ALL_FIFO (PCH_UART_HAL_CLR_TX_FIFO | \
  140. PCH_UART_HAL_CLR_RX_FIFO)
  141. #define PCH_UART_HAL_DMA_MODE0 0
  142. #define PCH_UART_HAL_FIFO_DIS 0
  143. #define PCH_UART_HAL_FIFO16 (PCH_UART_FCR_FIFOE)
  144. #define PCH_UART_HAL_FIFO256 (PCH_UART_FCR_FIFOE | \
  145. PCH_UART_FCR_FIFO256)
  146. #define PCH_UART_HAL_FIFO64 (PCH_UART_HAL_FIFO256)
  147. #define PCH_UART_HAL_TRIGGER1 (PCH_UART_FCR_RFTL1)
  148. #define PCH_UART_HAL_TRIGGER64 (PCH_UART_FCR_RFTL64)
  149. #define PCH_UART_HAL_TRIGGER128 (PCH_UART_FCR_RFTL128)
  150. #define PCH_UART_HAL_TRIGGER224 (PCH_UART_FCR_RFTL224)
  151. #define PCH_UART_HAL_TRIGGER16 (PCH_UART_FCR_RFTL16)
  152. #define PCH_UART_HAL_TRIGGER32 (PCH_UART_FCR_RFTL32)
  153. #define PCH_UART_HAL_TRIGGER56 (PCH_UART_FCR_RFTL56)
  154. #define PCH_UART_HAL_TRIGGER4 (PCH_UART_FCR_RFTL4)
  155. #define PCH_UART_HAL_TRIGGER8 (PCH_UART_FCR_RFTL8)
  156. #define PCH_UART_HAL_TRIGGER14 (PCH_UART_FCR_RFTL14)
  157. #define PCH_UART_HAL_TRIGGER_L (PCH_UART_FCR_RFTL64)
  158. #define PCH_UART_HAL_TRIGGER_M (PCH_UART_FCR_RFTL128)
  159. #define PCH_UART_HAL_TRIGGER_H (PCH_UART_FCR_RFTL224)
  160. #define PCH_UART_HAL_RX_INT (PCH_UART_IER_ERBFI)
  161. #define PCH_UART_HAL_TX_INT (PCH_UART_IER_ETBEI)
  162. #define PCH_UART_HAL_RX_ERR_INT (PCH_UART_IER_ELSI)
  163. #define PCH_UART_HAL_MS_INT (PCH_UART_IER_EDSSI)
  164. #define PCH_UART_HAL_ALL_INT (PCH_UART_IER_MASK)
  165. #define PCH_UART_HAL_DTR (PCH_UART_MCR_DTR)
  166. #define PCH_UART_HAL_RTS (PCH_UART_MCR_RTS)
  167. #define PCH_UART_HAL_OUT (PCH_UART_MCR_OUT)
  168. #define PCH_UART_HAL_LOOP (PCH_UART_MCR_LOOP)
  169. #define PCH_UART_HAL_AFE (PCH_UART_MCR_AFE)
  170. struct pch_uart_buffer {
  171. unsigned char *buf;
  172. int size;
  173. };
  174. struct eg20t_port {
  175. struct uart_port port;
  176. int port_type;
  177. void __iomem *membase;
  178. resource_size_t mapbase;
  179. unsigned int iobase;
  180. struct pci_dev *pdev;
  181. int fifo_size;
  182. int base_baud;
  183. int start_tx;
  184. int start_rx;
  185. int tx_empty;
  186. int int_dis_flag;
  187. int trigger;
  188. int trigger_level;
  189. struct pch_uart_buffer rxbuf;
  190. unsigned int dmsr;
  191. unsigned int fcr;
  192. unsigned int use_dma;
  193. unsigned int use_dma_flag;
  194. struct dma_async_tx_descriptor *desc_tx;
  195. struct dma_async_tx_descriptor *desc_rx;
  196. struct pch_dma_slave param_tx;
  197. struct pch_dma_slave param_rx;
  198. struct dma_chan *chan_tx;
  199. struct dma_chan *chan_rx;
  200. struct scatterlist sg_tx;
  201. struct scatterlist sg_rx;
  202. int tx_dma_use;
  203. void *rx_buf_virt;
  204. dma_addr_t rx_buf_dma;
  205. };
  206. static unsigned int default_baud = 9600;
  207. static const int trigger_level_256[4] = { 1, 64, 128, 224 };
  208. static const int trigger_level_64[4] = { 1, 16, 32, 56 };
  209. static const int trigger_level_16[4] = { 1, 4, 8, 14 };
  210. static const int trigger_level_1[4] = { 1, 1, 1, 1 };
  211. static void pch_uart_hal_request(struct pci_dev *pdev, int fifosize,
  212. int base_baud)
  213. {
  214. struct eg20t_port *priv = pci_get_drvdata(pdev);
  215. priv->trigger_level = 1;
  216. priv->fcr = 0;
  217. }
  218. static unsigned int get_msr(struct eg20t_port *priv, void __iomem *base)
  219. {
  220. unsigned int msr = ioread8(base + UART_MSR);
  221. priv->dmsr |= msr & PCH_UART_MSR_DELTA;
  222. return msr;
  223. }
  224. static void pch_uart_hal_enable_interrupt(struct eg20t_port *priv,
  225. unsigned int flag)
  226. {
  227. u8 ier = ioread8(priv->membase + UART_IER);
  228. ier |= flag & PCH_UART_IER_MASK;
  229. iowrite8(ier, priv->membase + UART_IER);
  230. }
  231. static void pch_uart_hal_disable_interrupt(struct eg20t_port *priv,
  232. unsigned int flag)
  233. {
  234. u8 ier = ioread8(priv->membase + UART_IER);
  235. ier &= ~(flag & PCH_UART_IER_MASK);
  236. iowrite8(ier, priv->membase + UART_IER);
  237. }
  238. static int pch_uart_hal_set_line(struct eg20t_port *priv, int baud,
  239. unsigned int parity, unsigned int bits,
  240. unsigned int stb)
  241. {
  242. unsigned int dll, dlm, lcr;
  243. int div;
  244. div = DIV_ROUND(priv->base_baud / 16, baud);
  245. if (div < 0 || USHRT_MAX <= div) {
  246. pr_err("Invalid Baud(div=0x%x)\n", div);
  247. return -EINVAL;
  248. }
  249. dll = (unsigned int)div & 0x00FFU;
  250. dlm = ((unsigned int)div >> 8) & 0x00FFU;
  251. if (parity & ~(PCH_UART_LCR_PEN | PCH_UART_LCR_EPS | PCH_UART_LCR_SP)) {
  252. pr_err("Invalid parity(0x%x)\n", parity);
  253. return -EINVAL;
  254. }
  255. if (bits & ~PCH_UART_LCR_WLS) {
  256. pr_err("Invalid bits(0x%x)\n", bits);
  257. return -EINVAL;
  258. }
  259. if (stb & ~PCH_UART_LCR_STB) {
  260. pr_err("Invalid STB(0x%x)\n", stb);
  261. return -EINVAL;
  262. }
  263. lcr = parity;
  264. lcr |= bits;
  265. lcr |= stb;
  266. pr_debug("%s:baud = %d, div = %04x, lcr = %02x (%lu)\n",
  267. __func__, baud, div, lcr, jiffies);
  268. iowrite8(PCH_UART_LCR_DLAB, priv->membase + UART_LCR);
  269. iowrite8(dll, priv->membase + PCH_UART_DLL);
  270. iowrite8(dlm, priv->membase + PCH_UART_DLM);
  271. iowrite8(lcr, priv->membase + UART_LCR);
  272. return 0;
  273. }
  274. static int pch_uart_hal_fifo_reset(struct eg20t_port *priv,
  275. unsigned int flag)
  276. {
  277. if (flag & ~(PCH_UART_FCR_TFR | PCH_UART_FCR_RFR)) {
  278. pr_err("%s:Invalid flag(0x%x)\n", __func__, flag);
  279. return -EINVAL;
  280. }
  281. iowrite8(PCH_UART_FCR_FIFOE | priv->fcr, priv->membase + UART_FCR);
  282. iowrite8(PCH_UART_FCR_FIFOE | priv->fcr | flag,
  283. priv->membase + UART_FCR);
  284. iowrite8(priv->fcr, priv->membase + UART_FCR);
  285. return 0;
  286. }
  287. static int pch_uart_hal_set_fifo(struct eg20t_port *priv,
  288. unsigned int dmamode,
  289. unsigned int fifo_size, unsigned int trigger)
  290. {
  291. u8 fcr;
  292. if (dmamode & ~PCH_UART_FCR_DMS) {
  293. pr_err("%s:Invalid DMA Mode(0x%x)\n", __func__, dmamode);
  294. return -EINVAL;
  295. }
  296. if (fifo_size & ~(PCH_UART_FCR_FIFOE | PCH_UART_FCR_FIFO256)) {
  297. pr_err("%s:Invalid FIFO SIZE(0x%x)\n", __func__, fifo_size);
  298. return -EINVAL;
  299. }
  300. if (trigger & ~PCH_UART_FCR_RFTL) {
  301. pr_err("%s:Invalid TRIGGER(0x%x)\n", __func__, trigger);
  302. return -EINVAL;
  303. }
  304. switch (priv->fifo_size) {
  305. case 256:
  306. priv->trigger_level =
  307. trigger_level_256[trigger >> PCH_UART_FCR_RFTL_SHIFT];
  308. break;
  309. case 64:
  310. priv->trigger_level =
  311. trigger_level_64[trigger >> PCH_UART_FCR_RFTL_SHIFT];
  312. break;
  313. case 16:
  314. priv->trigger_level =
  315. trigger_level_16[trigger >> PCH_UART_FCR_RFTL_SHIFT];
  316. break;
  317. default:
  318. priv->trigger_level =
  319. trigger_level_1[trigger >> PCH_UART_FCR_RFTL_SHIFT];
  320. break;
  321. }
  322. fcr =
  323. dmamode | fifo_size | trigger | PCH_UART_FCR_RFR | PCH_UART_FCR_TFR;
  324. iowrite8(PCH_UART_FCR_FIFOE, priv->membase + UART_FCR);
  325. iowrite8(PCH_UART_FCR_FIFOE | PCH_UART_FCR_RFR | PCH_UART_FCR_TFR,
  326. priv->membase + UART_FCR);
  327. iowrite8(fcr, priv->membase + UART_FCR);
  328. priv->fcr = fcr;
  329. return 0;
  330. }
  331. static u8 pch_uart_hal_get_modem(struct eg20t_port *priv)
  332. {
  333. priv->dmsr = 0;
  334. return get_msr(priv, priv->membase);
  335. }
  336. static int pch_uart_hal_write(struct eg20t_port *priv,
  337. const unsigned char *buf, int tx_size)
  338. {
  339. int i;
  340. unsigned int thr;
  341. for (i = 0; i < tx_size;) {
  342. thr = buf[i++];
  343. iowrite8(thr, priv->membase + PCH_UART_THR);
  344. }
  345. return i;
  346. }
  347. static int pch_uart_hal_read(struct eg20t_port *priv, unsigned char *buf,
  348. int rx_size)
  349. {
  350. int i;
  351. u8 rbr, lsr;
  352. lsr = ioread8(priv->membase + UART_LSR);
  353. for (i = 0, lsr = ioread8(priv->membase + UART_LSR);
  354. i < rx_size && lsr & UART_LSR_DR;
  355. lsr = ioread8(priv->membase + UART_LSR)) {
  356. rbr = ioread8(priv->membase + PCH_UART_RBR);
  357. buf[i++] = rbr;
  358. }
  359. return i;
  360. }
  361. static unsigned int pch_uart_hal_get_iid(struct eg20t_port *priv)
  362. {
  363. unsigned int iir;
  364. int ret;
  365. iir = ioread8(priv->membase + UART_IIR);
  366. ret = (iir & (PCH_UART_IIR_IID | PCH_UART_IIR_TOI | PCH_UART_IIR_IP));
  367. return ret;
  368. }
  369. static u8 pch_uart_hal_get_line_status(struct eg20t_port *priv)
  370. {
  371. return ioread8(priv->membase + UART_LSR);
  372. }
  373. static void pch_uart_hal_set_break(struct eg20t_port *priv, int on)
  374. {
  375. unsigned int lcr;
  376. lcr = ioread8(priv->membase + UART_LCR);
  377. if (on)
  378. lcr |= PCH_UART_LCR_SB;
  379. else
  380. lcr &= ~PCH_UART_LCR_SB;
  381. iowrite8(lcr, priv->membase + UART_LCR);
  382. }
  383. static int push_rx(struct eg20t_port *priv, const unsigned char *buf,
  384. int size)
  385. {
  386. struct uart_port *port;
  387. struct tty_struct *tty;
  388. port = &priv->port;
  389. tty = tty_port_tty_get(&port->state->port);
  390. if (!tty) {
  391. pr_debug("%s:tty is busy now", __func__);
  392. return -EBUSY;
  393. }
  394. tty_insert_flip_string(tty, buf, size);
  395. tty_flip_buffer_push(tty);
  396. tty_kref_put(tty);
  397. return 0;
  398. }
  399. static int pop_tx_x(struct eg20t_port *priv, unsigned char *buf)
  400. {
  401. int ret;
  402. struct uart_port *port = &priv->port;
  403. if (port->x_char) {
  404. pr_debug("%s:X character send %02x (%lu)\n", __func__,
  405. port->x_char, jiffies);
  406. buf[0] = port->x_char;
  407. port->x_char = 0;
  408. ret = 1;
  409. } else {
  410. ret = 0;
  411. }
  412. return ret;
  413. }
  414. static int dma_push_rx(struct eg20t_port *priv, int size)
  415. {
  416. struct tty_struct *tty;
  417. int room;
  418. struct uart_port *port = &priv->port;
  419. port = &priv->port;
  420. tty = tty_port_tty_get(&port->state->port);
  421. if (!tty) {
  422. pr_debug("%s:tty is busy now", __func__);
  423. return 0;
  424. }
  425. room = tty_buffer_request_room(tty, size);
  426. if (room < size)
  427. dev_warn(port->dev, "Rx overrun: dropping %u bytes\n",
  428. size - room);
  429. if (!room)
  430. return room;
  431. tty_insert_flip_string(tty, sg_virt(&priv->sg_rx), size);
  432. port->icount.rx += room;
  433. tty_kref_put(tty);
  434. return room;
  435. }
  436. static void pch_free_dma(struct uart_port *port)
  437. {
  438. struct eg20t_port *priv;
  439. priv = container_of(port, struct eg20t_port, port);
  440. if (priv->chan_tx) {
  441. dma_release_channel(priv->chan_tx);
  442. priv->chan_tx = NULL;
  443. }
  444. if (priv->chan_rx) {
  445. dma_release_channel(priv->chan_rx);
  446. priv->chan_rx = NULL;
  447. }
  448. if (sg_dma_address(&priv->sg_rx))
  449. dma_free_coherent(port->dev, port->fifosize,
  450. sg_virt(&priv->sg_rx),
  451. sg_dma_address(&priv->sg_rx));
  452. return;
  453. }
  454. static bool filter(struct dma_chan *chan, void *slave)
  455. {
  456. struct pch_dma_slave *param = slave;
  457. if ((chan->chan_id == param->chan_id) && (param->dma_dev ==
  458. chan->device->dev)) {
  459. chan->private = param;
  460. return true;
  461. } else {
  462. return false;
  463. }
  464. }
  465. static void pch_request_dma(struct uart_port *port)
  466. {
  467. dma_cap_mask_t mask;
  468. struct dma_chan *chan;
  469. struct pci_dev *dma_dev;
  470. struct pch_dma_slave *param;
  471. struct eg20t_port *priv =
  472. container_of(port, struct eg20t_port, port);
  473. dma_cap_zero(mask);
  474. dma_cap_set(DMA_SLAVE, mask);
  475. dma_dev = pci_get_bus_and_slot(2, PCI_DEVFN(0xa, 0)); /* Get DMA's dev
  476. information */
  477. /* Set Tx DMA */
  478. param = &priv->param_tx;
  479. param->dma_dev = &dma_dev->dev;
  480. param->chan_id = priv->port.line;
  481. param->tx_reg = port->mapbase + UART_TX;
  482. chan = dma_request_channel(mask, filter, param);
  483. if (!chan) {
  484. pr_err("%s:dma_request_channel FAILS(Tx)\n", __func__);
  485. return;
  486. }
  487. priv->chan_tx = chan;
  488. /* Set Rx DMA */
  489. param = &priv->param_rx;
  490. param->dma_dev = &dma_dev->dev;
  491. param->chan_id = priv->port.line + 1; /* Rx = Tx + 1 */
  492. param->rx_reg = port->mapbase + UART_RX;
  493. chan = dma_request_channel(mask, filter, param);
  494. if (!chan) {
  495. pr_err("%s:dma_request_channel FAILS(Rx)\n", __func__);
  496. dma_release_channel(priv->chan_tx);
  497. return;
  498. }
  499. /* Get Consistent memory for DMA */
  500. priv->rx_buf_virt = dma_alloc_coherent(port->dev, port->fifosize,
  501. &priv->rx_buf_dma, GFP_KERNEL);
  502. priv->chan_rx = chan;
  503. }
  504. static void pch_dma_rx_complete(void *arg)
  505. {
  506. struct eg20t_port *priv = arg;
  507. struct uart_port *port = &priv->port;
  508. struct tty_struct *tty = tty_port_tty_get(&port->state->port);
  509. if (!tty) {
  510. pr_debug("%s:tty is busy now", __func__);
  511. return;
  512. }
  513. if (dma_push_rx(priv, priv->trigger_level))
  514. tty_flip_buffer_push(tty);
  515. tty_kref_put(tty);
  516. }
  517. static void pch_dma_tx_complete(void *arg)
  518. {
  519. struct eg20t_port *priv = arg;
  520. struct uart_port *port = &priv->port;
  521. struct circ_buf *xmit = &port->state->xmit;
  522. xmit->tail += sg_dma_len(&priv->sg_tx);
  523. xmit->tail &= UART_XMIT_SIZE - 1;
  524. port->icount.tx += sg_dma_len(&priv->sg_tx);
  525. async_tx_ack(priv->desc_tx);
  526. priv->tx_dma_use = 0;
  527. }
  528. static int pop_tx(struct eg20t_port *priv, unsigned char *buf, int size)
  529. {
  530. int count = 0;
  531. struct uart_port *port = &priv->port;
  532. struct circ_buf *xmit = &port->state->xmit;
  533. if (uart_tx_stopped(port) || uart_circ_empty(xmit) || count >= size)
  534. goto pop_tx_end;
  535. do {
  536. int cnt_to_end =
  537. CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE);
  538. int sz = min(size - count, cnt_to_end);
  539. memcpy(&buf[count], &xmit->buf[xmit->tail], sz);
  540. xmit->tail = (xmit->tail + sz) & (UART_XMIT_SIZE - 1);
  541. count += sz;
  542. } while (!uart_circ_empty(xmit) && count < size);
  543. pop_tx_end:
  544. pr_debug("%d characters. Remained %d characters. (%lu)\n",
  545. count, size - count, jiffies);
  546. return count;
  547. }
  548. static int handle_rx_to(struct eg20t_port *priv)
  549. {
  550. struct pch_uart_buffer *buf;
  551. int rx_size;
  552. int ret;
  553. if (!priv->start_rx) {
  554. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_RX_INT);
  555. return 0;
  556. }
  557. buf = &priv->rxbuf;
  558. do {
  559. rx_size = pch_uart_hal_read(priv, buf->buf, buf->size);
  560. ret = push_rx(priv, buf->buf, rx_size);
  561. if (ret)
  562. return 0;
  563. } while (rx_size == buf->size);
  564. return PCH_UART_HANDLED_RX_INT;
  565. }
  566. static int handle_rx(struct eg20t_port *priv)
  567. {
  568. return handle_rx_to(priv);
  569. }
  570. static int dma_handle_rx(struct eg20t_port *priv)
  571. {
  572. struct uart_port *port = &priv->port;
  573. struct dma_async_tx_descriptor *desc;
  574. struct scatterlist *sg;
  575. priv = container_of(port, struct eg20t_port, port);
  576. sg = &priv->sg_rx;
  577. sg_init_table(&priv->sg_rx, 1); /* Initialize SG table */
  578. sg_dma_len(sg) = priv->fifo_size;
  579. sg_set_page(&priv->sg_rx, virt_to_page(priv->rx_buf_virt),
  580. sg_dma_len(sg), (unsigned long)priv->rx_buf_virt &
  581. ~PAGE_MASK);
  582. sg_dma_address(sg) = priv->rx_buf_dma;
  583. desc = priv->chan_rx->device->device_prep_slave_sg(priv->chan_rx,
  584. sg, 1, DMA_FROM_DEVICE,
  585. DMA_PREP_INTERRUPT);
  586. if (!desc)
  587. return 0;
  588. priv->desc_rx = desc;
  589. desc->callback = pch_dma_rx_complete;
  590. desc->callback_param = priv;
  591. desc->tx_submit(desc);
  592. dma_async_issue_pending(priv->chan_rx);
  593. return PCH_UART_HANDLED_RX_INT;
  594. }
  595. static unsigned int handle_tx(struct eg20t_port *priv)
  596. {
  597. struct uart_port *port = &priv->port;
  598. struct circ_buf *xmit = &port->state->xmit;
  599. int ret;
  600. int fifo_size;
  601. int tx_size;
  602. int size;
  603. int tx_empty;
  604. if (!priv->start_tx) {
  605. pr_info("%s:Tx isn't started. (%lu)\n", __func__, jiffies);
  606. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_TX_INT);
  607. priv->tx_empty = 1;
  608. return 0;
  609. }
  610. fifo_size = max(priv->fifo_size, 1);
  611. tx_empty = 1;
  612. if (pop_tx_x(priv, xmit->buf)) {
  613. pch_uart_hal_write(priv, xmit->buf, 1);
  614. port->icount.tx++;
  615. tx_empty = 0;
  616. fifo_size--;
  617. }
  618. size = min(xmit->head - xmit->tail, fifo_size);
  619. tx_size = pop_tx(priv, xmit->buf, size);
  620. if (tx_size > 0) {
  621. ret = pch_uart_hal_write(priv, xmit->buf, tx_size);
  622. port->icount.tx += ret;
  623. tx_empty = 0;
  624. }
  625. priv->tx_empty = tx_empty;
  626. if (tx_empty)
  627. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_TX_INT);
  628. return PCH_UART_HANDLED_TX_INT;
  629. }
  630. static unsigned int dma_handle_tx(struct eg20t_port *priv)
  631. {
  632. struct uart_port *port = &priv->port;
  633. struct circ_buf *xmit = &port->state->xmit;
  634. struct scatterlist *sg = &priv->sg_tx;
  635. int nent;
  636. int fifo_size;
  637. int tx_empty;
  638. struct dma_async_tx_descriptor *desc;
  639. if (!priv->start_tx) {
  640. pr_info("%s:Tx isn't started. (%lu)\n", __func__, jiffies);
  641. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_TX_INT);
  642. priv->tx_empty = 1;
  643. return 0;
  644. }
  645. fifo_size = max(priv->fifo_size, 1);
  646. tx_empty = 1;
  647. if (pop_tx_x(priv, xmit->buf)) {
  648. pch_uart_hal_write(priv, xmit->buf, 1);
  649. port->icount.tx++;
  650. tx_empty = 0;
  651. fifo_size--;
  652. }
  653. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_TX_INT);
  654. priv->tx_dma_use = 1;
  655. sg_init_table(&priv->sg_tx, 1); /* Initialize SG table */
  656. sg_set_page(&priv->sg_tx, virt_to_page(xmit->buf),
  657. UART_XMIT_SIZE, (int)xmit->buf & ~PAGE_MASK);
  658. nent = dma_map_sg(port->dev, &priv->sg_tx, 1, DMA_TO_DEVICE);
  659. if (!nent) {
  660. pr_err("%s:dma_map_sg Failed\n", __func__);
  661. return 0;
  662. }
  663. sg->offset = xmit->tail & (UART_XMIT_SIZE - 1);
  664. sg_dma_address(sg) = (sg_dma_address(sg) & ~(UART_XMIT_SIZE - 1)) +
  665. sg->offset;
  666. sg_dma_len(sg) = min((int)CIRC_CNT(xmit->head, xmit->tail,
  667. UART_XMIT_SIZE), CIRC_CNT_TO_END(xmit->head,
  668. xmit->tail, UART_XMIT_SIZE));
  669. desc = priv->chan_tx->device->device_prep_slave_sg(priv->chan_tx,
  670. sg, nent, DMA_TO_DEVICE, DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
  671. if (!desc) {
  672. pr_err("%s:device_prep_slave_sg Failed\n", __func__);
  673. return 0;
  674. }
  675. dma_sync_sg_for_device(port->dev, sg, 1, DMA_TO_DEVICE);
  676. priv->desc_tx = desc;
  677. desc->callback = pch_dma_tx_complete;
  678. desc->callback_param = priv;
  679. desc->tx_submit(desc);
  680. dma_async_issue_pending(priv->chan_tx);
  681. return PCH_UART_HANDLED_TX_INT;
  682. }
  683. static void pch_uart_err_ir(struct eg20t_port *priv, unsigned int lsr)
  684. {
  685. u8 fcr = ioread8(priv->membase + UART_FCR);
  686. /* Reset FIFO */
  687. fcr |= UART_FCR_CLEAR_RCVR;
  688. iowrite8(fcr, priv->membase + UART_FCR);
  689. if (lsr & PCH_UART_LSR_ERR)
  690. dev_err(&priv->pdev->dev, "Error data in FIFO\n");
  691. if (lsr & UART_LSR_FE)
  692. dev_err(&priv->pdev->dev, "Framing Error\n");
  693. if (lsr & UART_LSR_PE)
  694. dev_err(&priv->pdev->dev, "Parity Error\n");
  695. if (lsr & UART_LSR_OE)
  696. dev_err(&priv->pdev->dev, "Overrun Error\n");
  697. }
  698. static irqreturn_t pch_uart_interrupt(int irq, void *dev_id)
  699. {
  700. struct eg20t_port *priv = dev_id;
  701. unsigned int handled;
  702. u8 lsr;
  703. int ret = 0;
  704. unsigned int iid;
  705. unsigned long flags;
  706. spin_lock_irqsave(&priv->port.lock, flags);
  707. handled = 0;
  708. while ((iid = pch_uart_hal_get_iid(priv)) > 1) {
  709. switch (iid) {
  710. case PCH_UART_IID_RLS: /* Receiver Line Status */
  711. lsr = pch_uart_hal_get_line_status(priv);
  712. if (lsr & (PCH_UART_LSR_ERR | UART_LSR_FE |
  713. UART_LSR_PE | UART_LSR_OE)) {
  714. pch_uart_err_ir(priv, lsr);
  715. ret = PCH_UART_HANDLED_RX_ERR_INT;
  716. }
  717. break;
  718. case PCH_UART_IID_RDR: /* Received Data Ready */
  719. if (priv->use_dma)
  720. ret = dma_handle_rx(priv);
  721. else
  722. ret = handle_rx(priv);
  723. break;
  724. case PCH_UART_IID_RDR_TO: /* Received Data Ready
  725. (FIFO Timeout) */
  726. ret = handle_rx_to(priv);
  727. break;
  728. case PCH_UART_IID_THRE: /* Transmitter Holding Register
  729. Empty */
  730. if (priv->use_dma)
  731. ret = dma_handle_tx(priv);
  732. else
  733. ret = handle_tx(priv);
  734. break;
  735. case PCH_UART_IID_MS: /* Modem Status */
  736. ret = PCH_UART_HANDLED_MS_INT;
  737. break;
  738. default: /* Never junp to this label */
  739. pr_err("%s:iid=%d (%lu)\n", __func__, iid, jiffies);
  740. ret = -1;
  741. break;
  742. }
  743. handled |= (unsigned int)ret;
  744. }
  745. if (handled == 0 && iid <= 1) {
  746. if (priv->int_dis_flag)
  747. priv->int_dis_flag = 0;
  748. }
  749. spin_unlock_irqrestore(&priv->port.lock, flags);
  750. return IRQ_RETVAL(handled);
  751. }
  752. /* This function tests whether the transmitter fifo and shifter for the port
  753. described by 'port' is empty. */
  754. static unsigned int pch_uart_tx_empty(struct uart_port *port)
  755. {
  756. struct eg20t_port *priv;
  757. int ret;
  758. priv = container_of(port, struct eg20t_port, port);
  759. if (priv->tx_empty)
  760. ret = TIOCSER_TEMT;
  761. else
  762. ret = 0;
  763. return ret;
  764. }
  765. /* Returns the current state of modem control inputs. */
  766. static unsigned int pch_uart_get_mctrl(struct uart_port *port)
  767. {
  768. struct eg20t_port *priv;
  769. u8 modem;
  770. unsigned int ret = 0;
  771. priv = container_of(port, struct eg20t_port, port);
  772. modem = pch_uart_hal_get_modem(priv);
  773. if (modem & UART_MSR_DCD)
  774. ret |= TIOCM_CAR;
  775. if (modem & UART_MSR_RI)
  776. ret |= TIOCM_RNG;
  777. if (modem & UART_MSR_DSR)
  778. ret |= TIOCM_DSR;
  779. if (modem & UART_MSR_CTS)
  780. ret |= TIOCM_CTS;
  781. return ret;
  782. }
  783. static void pch_uart_set_mctrl(struct uart_port *port, unsigned int mctrl)
  784. {
  785. u32 mcr = 0;
  786. unsigned int dat;
  787. struct eg20t_port *priv = container_of(port, struct eg20t_port, port);
  788. if (mctrl & TIOCM_DTR)
  789. mcr |= UART_MCR_DTR;
  790. if (mctrl & TIOCM_RTS)
  791. mcr |= UART_MCR_RTS;
  792. if (mctrl & TIOCM_LOOP)
  793. mcr |= UART_MCR_LOOP;
  794. if (mctrl) {
  795. dat = pch_uart_get_mctrl(port);
  796. dat |= mcr;
  797. iowrite8(dat, priv->membase + UART_MCR);
  798. }
  799. }
  800. static void pch_uart_stop_tx(struct uart_port *port)
  801. {
  802. struct eg20t_port *priv;
  803. priv = container_of(port, struct eg20t_port, port);
  804. priv->start_tx = 0;
  805. priv->tx_dma_use = 0;
  806. }
  807. static void pch_uart_start_tx(struct uart_port *port)
  808. {
  809. struct eg20t_port *priv;
  810. priv = container_of(port, struct eg20t_port, port);
  811. if (priv->use_dma)
  812. if (priv->tx_dma_use)
  813. return;
  814. priv->start_tx = 1;
  815. pch_uart_hal_enable_interrupt(priv, PCH_UART_HAL_TX_INT);
  816. }
  817. static void pch_uart_stop_rx(struct uart_port *port)
  818. {
  819. struct eg20t_port *priv;
  820. priv = container_of(port, struct eg20t_port, port);
  821. priv->start_rx = 0;
  822. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_RX_INT);
  823. priv->int_dis_flag = 1;
  824. }
  825. /* Enable the modem status interrupts. */
  826. static void pch_uart_enable_ms(struct uart_port *port)
  827. {
  828. struct eg20t_port *priv;
  829. priv = container_of(port, struct eg20t_port, port);
  830. pch_uart_hal_enable_interrupt(priv, PCH_UART_HAL_MS_INT);
  831. }
  832. /* Control the transmission of a break signal. */
  833. static void pch_uart_break_ctl(struct uart_port *port, int ctl)
  834. {
  835. struct eg20t_port *priv;
  836. unsigned long flags;
  837. priv = container_of(port, struct eg20t_port, port);
  838. spin_lock_irqsave(&port->lock, flags);
  839. pch_uart_hal_set_break(priv, ctl);
  840. spin_unlock_irqrestore(&port->lock, flags);
  841. }
  842. /* Grab any interrupt resources and initialise any low level driver state. */
  843. static int pch_uart_startup(struct uart_port *port)
  844. {
  845. struct eg20t_port *priv;
  846. int ret;
  847. int fifo_size;
  848. int trigger_level;
  849. priv = container_of(port, struct eg20t_port, port);
  850. priv->tx_empty = 1;
  851. port->uartclk = priv->base_baud;
  852. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_ALL_INT);
  853. ret = pch_uart_hal_set_line(priv, default_baud,
  854. PCH_UART_HAL_PARITY_NONE, PCH_UART_HAL_8BIT,
  855. PCH_UART_HAL_STB1);
  856. if (ret)
  857. return ret;
  858. switch (priv->fifo_size) {
  859. case 256:
  860. fifo_size = PCH_UART_HAL_FIFO256;
  861. break;
  862. case 64:
  863. fifo_size = PCH_UART_HAL_FIFO64;
  864. break;
  865. case 16:
  866. fifo_size = PCH_UART_HAL_FIFO16;
  867. case 1:
  868. default:
  869. fifo_size = PCH_UART_HAL_FIFO_DIS;
  870. break;
  871. }
  872. switch (priv->trigger) {
  873. case PCH_UART_HAL_TRIGGER1:
  874. trigger_level = 1;
  875. break;
  876. case PCH_UART_HAL_TRIGGER_L:
  877. trigger_level = priv->fifo_size / 4;
  878. break;
  879. case PCH_UART_HAL_TRIGGER_M:
  880. trigger_level = priv->fifo_size / 2;
  881. break;
  882. case PCH_UART_HAL_TRIGGER_H:
  883. default:
  884. trigger_level = priv->fifo_size - (priv->fifo_size / 8);
  885. break;
  886. }
  887. priv->trigger_level = trigger_level;
  888. ret = pch_uart_hal_set_fifo(priv, PCH_UART_HAL_DMA_MODE0,
  889. fifo_size, priv->trigger);
  890. if (ret < 0)
  891. return ret;
  892. ret = request_irq(priv->port.irq, pch_uart_interrupt, IRQF_SHARED,
  893. KBUILD_MODNAME, priv);
  894. if (ret < 0)
  895. return ret;
  896. if (priv->use_dma)
  897. pch_request_dma(port);
  898. priv->start_rx = 1;
  899. pch_uart_hal_enable_interrupt(priv, PCH_UART_HAL_RX_INT);
  900. uart_update_timeout(port, CS8, default_baud);
  901. return 0;
  902. }
  903. static void pch_uart_shutdown(struct uart_port *port)
  904. {
  905. struct eg20t_port *priv;
  906. int ret;
  907. priv = container_of(port, struct eg20t_port, port);
  908. pch_uart_hal_disable_interrupt(priv, PCH_UART_HAL_ALL_INT);
  909. pch_uart_hal_fifo_reset(priv, PCH_UART_HAL_CLR_ALL_FIFO);
  910. ret = pch_uart_hal_set_fifo(priv, PCH_UART_HAL_DMA_MODE0,
  911. PCH_UART_HAL_FIFO_DIS, PCH_UART_HAL_TRIGGER1);
  912. if (ret)
  913. pr_err("pch_uart_hal_set_fifo Failed(ret=%d)\n", ret);
  914. if (priv->use_dma_flag)
  915. pch_free_dma(port);
  916. free_irq(priv->port.irq, priv);
  917. }
  918. /* Change the port parameters, including word length, parity, stop
  919. *bits. Update read_status_mask and ignore_status_mask to indicate
  920. *the types of events we are interested in receiving. */
  921. static void pch_uart_set_termios(struct uart_port *port,
  922. struct ktermios *termios, struct ktermios *old)
  923. {
  924. int baud;
  925. int rtn;
  926. unsigned int parity, bits, stb;
  927. struct eg20t_port *priv;
  928. unsigned long flags;
  929. priv = container_of(port, struct eg20t_port, port);
  930. switch (termios->c_cflag & CSIZE) {
  931. case CS5:
  932. bits = PCH_UART_HAL_5BIT;
  933. break;
  934. case CS6:
  935. bits = PCH_UART_HAL_6BIT;
  936. break;
  937. case CS7:
  938. bits = PCH_UART_HAL_7BIT;
  939. break;
  940. default: /* CS8 */
  941. bits = PCH_UART_HAL_8BIT;
  942. break;
  943. }
  944. if (termios->c_cflag & CSTOPB)
  945. stb = PCH_UART_HAL_STB2;
  946. else
  947. stb = PCH_UART_HAL_STB1;
  948. if (termios->c_cflag & PARENB) {
  949. if (!(termios->c_cflag & PARODD))
  950. parity = PCH_UART_HAL_PARITY_ODD;
  951. else
  952. parity = PCH_UART_HAL_PARITY_EVEN;
  953. } else {
  954. parity = PCH_UART_HAL_PARITY_NONE;
  955. }
  956. termios->c_cflag &= ~CMSPAR; /* Mark/Space parity is not supported */
  957. baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk / 16);
  958. spin_lock_irqsave(&port->lock, flags);
  959. uart_update_timeout(port, termios->c_cflag, baud);
  960. rtn = pch_uart_hal_set_line(priv, baud, parity, bits, stb);
  961. if (rtn)
  962. goto out;
  963. /* Don't rewrite B0 */
  964. if (tty_termios_baud_rate(termios))
  965. tty_termios_encode_baud_rate(termios, baud, baud);
  966. out:
  967. spin_unlock_irqrestore(&port->lock, flags);
  968. }
  969. static const char *pch_uart_type(struct uart_port *port)
  970. {
  971. return KBUILD_MODNAME;
  972. }
  973. static void pch_uart_release_port(struct uart_port *port)
  974. {
  975. struct eg20t_port *priv;
  976. priv = container_of(port, struct eg20t_port, port);
  977. pci_iounmap(priv->pdev, priv->membase);
  978. pci_release_regions(priv->pdev);
  979. }
  980. static int pch_uart_request_port(struct uart_port *port)
  981. {
  982. struct eg20t_port *priv;
  983. int ret;
  984. void __iomem *membase;
  985. priv = container_of(port, struct eg20t_port, port);
  986. ret = pci_request_regions(priv->pdev, KBUILD_MODNAME);
  987. if (ret < 0)
  988. return -EBUSY;
  989. membase = pci_iomap(priv->pdev, 1, 0);
  990. if (!membase) {
  991. pci_release_regions(priv->pdev);
  992. return -EBUSY;
  993. }
  994. priv->membase = port->membase = membase;
  995. return 0;
  996. }
  997. static void pch_uart_config_port(struct uart_port *port, int type)
  998. {
  999. struct eg20t_port *priv;
  1000. priv = container_of(port, struct eg20t_port, port);
  1001. if (type & UART_CONFIG_TYPE) {
  1002. port->type = priv->port_type;
  1003. pch_uart_request_port(port);
  1004. }
  1005. }
  1006. static int pch_uart_verify_port(struct uart_port *port,
  1007. struct serial_struct *serinfo)
  1008. {
  1009. struct eg20t_port *priv;
  1010. priv = container_of(port, struct eg20t_port, port);
  1011. if (serinfo->flags & UPF_LOW_LATENCY) {
  1012. pr_info("PCH UART : Use PIO Mode (without DMA)\n");
  1013. priv->use_dma = 0;
  1014. serinfo->flags &= ~UPF_LOW_LATENCY;
  1015. } else {
  1016. #ifndef CONFIG_PCH_DMA
  1017. pr_err("%s : PCH DMA is not Loaded.\n", __func__);
  1018. return -EOPNOTSUPP;
  1019. #endif
  1020. priv->use_dma = 1;
  1021. priv->use_dma_flag = 1;
  1022. pr_info("PCH UART : Use DMA Mode\n");
  1023. }
  1024. return 0;
  1025. }
  1026. static struct uart_ops pch_uart_ops = {
  1027. .tx_empty = pch_uart_tx_empty,
  1028. .set_mctrl = pch_uart_set_mctrl,
  1029. .get_mctrl = pch_uart_get_mctrl,
  1030. .stop_tx = pch_uart_stop_tx,
  1031. .start_tx = pch_uart_start_tx,
  1032. .stop_rx = pch_uart_stop_rx,
  1033. .enable_ms = pch_uart_enable_ms,
  1034. .break_ctl = pch_uart_break_ctl,
  1035. .startup = pch_uart_startup,
  1036. .shutdown = pch_uart_shutdown,
  1037. .set_termios = pch_uart_set_termios,
  1038. /* .pm = pch_uart_pm, Not supported yet */
  1039. /* .set_wake = pch_uart_set_wake, Not supported yet */
  1040. .type = pch_uart_type,
  1041. .release_port = pch_uart_release_port,
  1042. .request_port = pch_uart_request_port,
  1043. .config_port = pch_uart_config_port,
  1044. .verify_port = pch_uart_verify_port
  1045. };
  1046. static struct uart_driver pch_uart_driver = {
  1047. .owner = THIS_MODULE,
  1048. .driver_name = KBUILD_MODNAME,
  1049. .dev_name = PCH_UART_DRIVER_DEVICE,
  1050. .major = 0,
  1051. .minor = 0,
  1052. .nr = PCH_UART_NR,
  1053. };
  1054. static struct eg20t_port *pch_uart_init_port(struct pci_dev *pdev,
  1055. int port_type)
  1056. {
  1057. struct eg20t_port *priv;
  1058. int ret;
  1059. unsigned int iobase;
  1060. unsigned int mapbase;
  1061. unsigned char *rxbuf;
  1062. int fifosize, base_baud;
  1063. static int num;
  1064. priv = kzalloc(sizeof(struct eg20t_port), GFP_KERNEL);
  1065. if (priv == NULL)
  1066. goto init_port_alloc_err;
  1067. rxbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
  1068. if (!rxbuf)
  1069. goto init_port_free_txbuf;
  1070. switch (port_type) {
  1071. case PORT_UNKNOWN:
  1072. fifosize = 256; /* UART0 */
  1073. base_baud = 1843200; /* 1.8432MHz */
  1074. break;
  1075. case PORT_8250:
  1076. fifosize = 64; /* UART1~3 */
  1077. base_baud = 1843200; /* 1.8432MHz */
  1078. break;
  1079. default:
  1080. dev_err(&pdev->dev, "Invalid Port Type(=%d)\n", port_type);
  1081. goto init_port_hal_free;
  1082. }
  1083. iobase = pci_resource_start(pdev, 0);
  1084. mapbase = pci_resource_start(pdev, 1);
  1085. priv->mapbase = mapbase;
  1086. priv->iobase = iobase;
  1087. priv->pdev = pdev;
  1088. priv->tx_empty = 1;
  1089. priv->rxbuf.buf = rxbuf;
  1090. priv->rxbuf.size = PAGE_SIZE;
  1091. priv->fifo_size = fifosize;
  1092. priv->base_baud = base_baud;
  1093. priv->port_type = PORT_MAX_8250 + port_type + 1;
  1094. priv->port.dev = &pdev->dev;
  1095. priv->port.iobase = iobase;
  1096. priv->port.membase = NULL;
  1097. priv->port.mapbase = mapbase;
  1098. priv->port.irq = pdev->irq;
  1099. priv->port.iotype = UPIO_PORT;
  1100. priv->port.ops = &pch_uart_ops;
  1101. priv->port.flags = UPF_BOOT_AUTOCONF;
  1102. priv->port.fifosize = fifosize;
  1103. priv->port.line = num++;
  1104. priv->trigger = PCH_UART_HAL_TRIGGER_M;
  1105. pci_set_drvdata(pdev, priv);
  1106. pch_uart_hal_request(pdev, fifosize, base_baud);
  1107. ret = uart_add_one_port(&pch_uart_driver, &priv->port);
  1108. if (ret < 0)
  1109. goto init_port_hal_free;
  1110. return priv;
  1111. init_port_hal_free:
  1112. free_page((unsigned long)rxbuf);
  1113. init_port_free_txbuf:
  1114. kfree(priv);
  1115. init_port_alloc_err:
  1116. return NULL;
  1117. }
  1118. static void pch_uart_exit_port(struct eg20t_port *priv)
  1119. {
  1120. uart_remove_one_port(&pch_uart_driver, &priv->port);
  1121. pci_set_drvdata(priv->pdev, NULL);
  1122. free_page((unsigned long)priv->rxbuf.buf);
  1123. }
  1124. static void pch_uart_pci_remove(struct pci_dev *pdev)
  1125. {
  1126. struct eg20t_port *priv;
  1127. priv = (struct eg20t_port *)pci_get_drvdata(pdev);
  1128. pch_uart_exit_port(priv);
  1129. pci_disable_device(pdev);
  1130. kfree(priv);
  1131. return;
  1132. }
  1133. #ifdef CONFIG_PM
  1134. static int pch_uart_pci_suspend(struct pci_dev *pdev, pm_message_t state)
  1135. {
  1136. struct eg20t_port *priv = pci_get_drvdata(pdev);
  1137. uart_suspend_port(&pch_uart_driver, &priv->port);
  1138. pci_save_state(pdev);
  1139. pci_set_power_state(pdev, pci_choose_state(pdev, state));
  1140. return 0;
  1141. }
  1142. static int pch_uart_pci_resume(struct pci_dev *pdev)
  1143. {
  1144. struct eg20t_port *priv = pci_get_drvdata(pdev);
  1145. int ret;
  1146. pci_set_power_state(pdev, PCI_D0);
  1147. pci_restore_state(pdev);
  1148. ret = pci_enable_device(pdev);
  1149. if (ret) {
  1150. dev_err(&pdev->dev,
  1151. "%s-pci_enable_device failed(ret=%d) ", __func__, ret);
  1152. return ret;
  1153. }
  1154. uart_resume_port(&pch_uart_driver, &priv->port);
  1155. return 0;
  1156. }
  1157. #else
  1158. #define pch_uart_pci_suspend NULL
  1159. #define pch_uart_pci_resume NULL
  1160. #endif
  1161. static DEFINE_PCI_DEVICE_TABLE(pch_uart_pci_id) = {
  1162. {PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x8811),
  1163. .driver_data = PCH_UART_8LINE},
  1164. {PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x8812),
  1165. .driver_data = PCH_UART_2LINE},
  1166. {PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x8813),
  1167. .driver_data = PCH_UART_2LINE},
  1168. {PCI_DEVICE(PCI_VENDOR_ID_INTEL, 0x8814),
  1169. .driver_data = PCH_UART_2LINE},
  1170. {0,},
  1171. };
  1172. static int __devinit pch_uart_pci_probe(struct pci_dev *pdev,
  1173. const struct pci_device_id *id)
  1174. {
  1175. int ret;
  1176. struct eg20t_port *priv;
  1177. ret = pci_enable_device(pdev);
  1178. if (ret < 0)
  1179. goto probe_error;
  1180. priv = pch_uart_init_port(pdev, id->driver_data);
  1181. if (!priv) {
  1182. ret = -EBUSY;
  1183. goto probe_disable_device;
  1184. }
  1185. pci_set_drvdata(pdev, priv);
  1186. return ret;
  1187. probe_disable_device:
  1188. pci_disable_device(pdev);
  1189. probe_error:
  1190. return ret;
  1191. }
  1192. static struct pci_driver pch_uart_pci_driver = {
  1193. .name = "pch_uart",
  1194. .id_table = pch_uart_pci_id,
  1195. .probe = pch_uart_pci_probe,
  1196. .remove = __devexit_p(pch_uart_pci_remove),
  1197. .suspend = pch_uart_pci_suspend,
  1198. .resume = pch_uart_pci_resume,
  1199. };
  1200. static int __init pch_uart_module_init(void)
  1201. {
  1202. int ret;
  1203. /* register as UART driver */
  1204. ret = uart_register_driver(&pch_uart_driver);
  1205. if (ret < 0)
  1206. return ret;
  1207. /* register as PCI driver */
  1208. ret = pci_register_driver(&pch_uart_pci_driver);
  1209. if (ret < 0)
  1210. uart_unregister_driver(&pch_uart_driver);
  1211. return ret;
  1212. }
  1213. module_init(pch_uart_module_init);
  1214. static void __exit pch_uart_module_exit(void)
  1215. {
  1216. pci_unregister_driver(&pch_uart_pci_driver);
  1217. uart_unregister_driver(&pch_uart_driver);
  1218. }
  1219. module_exit(pch_uart_module_exit);
  1220. MODULE_LICENSE("GPL v2");
  1221. MODULE_DESCRIPTION("Intel EG20T PCH UART PCI Driver");
  1222. module_param(default_baud, uint, S_IRUGO);