dev_serial.c 45 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575
  1. /*
  2. * Copyright (c) 2006-2024, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2006-03-13 bernard first version
  9. * 2012-05-15 lgnq modified according bernard's implementation.
  10. * 2012-05-28 bernard code cleanup
  11. * 2012-11-23 bernard fix compiler warning.
  12. * 2013-02-20 bernard use RT_SERIAL_RB_BUFSZ to define
  13. * the size of ring buffer.
  14. * 2014-07-10 bernard rewrite serial framework
  15. * 2014-12-31 bernard use open_flag for poll_tx stream mode.
  16. * 2015-05-19 Quintin fix DMA tx mod tx_dma->activated flag !=RT_FALSE BUG
  17. * in open function.
  18. * 2015-11-10 bernard fix the poll rx issue when there is no data.
  19. * 2016-05-10 armink add fifo mode to DMA rx when serial->config.bufsz != 0.
  20. * 2017-01-19 aubr.cool prevent change serial rx bufsz when serial is opened.
  21. * 2017-11-07 JasonJia fix data bits error issue when using tcsetattr.
  22. * 2017-11-15 JasonJia fix poll rx issue when data is full.
  23. * add TCFLSH and FIONREAD support.
  24. * 2018-12-08 Ernest Chen add DMA choice
  25. * 2020-09-14 WillianChan add a line feed to the carriage return character
  26. * when using interrupt tx
  27. * 2020-12-14 Meco Man implement function of setting window's size(TIOCSWINSZ)
  28. * 2021-08-22 Meco Man implement function of getting window's size(TIOCGWINSZ)
  29. * 2023-09-15 xqyjlj perf rt_hw_interrupt_disable/enable
  30. * 2024-11-25 zhujiale add bypass mode
  31. */
  32. #include <rthw.h>
  33. #include <rtthread.h>
  34. #include <rtdevice.h>
  35. #define DBG_TAG "UART"
  36. #define DBG_LVL DBG_INFO
  37. #include <rtdbg.h>
  38. #ifdef RT_USING_POSIX_STDIO
  39. #include <dfs_file.h>
  40. #include <fcntl.h>
  41. #include <unistd.h>
  42. #include <poll.h>
  43. #include <sys/ioctl.h>
  44. #ifdef RT_USING_POSIX_TERMIOS
  45. #include <termios.h>
  46. #endif
  47. /* it's possible the 'getc/putc' is defined by stdio.h in gcc/newlib. */
  48. #ifdef getc
  49. #undef getc
  50. #endif
  51. #ifdef putc
  52. #undef putc
  53. #endif
  54. RT_OBJECT_HOOKLIST_DEFINE(rt_hw_serial_rxind);
  55. static rt_err_t serial_fops_rx_ind(rt_device_t dev, rt_size_t size)
  56. {
  57. rt_wqueue_wakeup(&(dev->wait_queue), (void*)POLLIN);
  58. RT_OBJECT_HOOKLIST_CALL(rt_hw_serial_rxind, (dev, size));
  59. return RT_EOK;
  60. }
  61. /* fops for serial */
  62. static int serial_fops_open(struct dfs_file *fd)
  63. {
  64. rt_err_t ret = 0;
  65. rt_uint16_t flags = 0;
  66. rt_device_t device;
  67. device = (rt_device_t)fd->vnode->data;
  68. RT_ASSERT(device != RT_NULL);
  69. switch (fd->flags & O_ACCMODE)
  70. {
  71. case O_RDONLY:
  72. LOG_D("fops open: O_RDONLY!");
  73. flags = RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_RDONLY;
  74. break;
  75. case O_WRONLY:
  76. LOG_D("fops open: O_WRONLY!");
  77. flags = RT_DEVICE_FLAG_WRONLY;
  78. break;
  79. case O_RDWR:
  80. LOG_D("fops open: O_RDWR!");
  81. flags = RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_RDWR;
  82. break;
  83. default:
  84. LOG_E("fops open: unknown mode - %d!", fd->flags & O_ACCMODE);
  85. break;
  86. }
  87. if ((fd->flags & O_ACCMODE) != O_WRONLY)
  88. rt_device_set_rx_indicate(device, serial_fops_rx_ind);
  89. ret = rt_device_open(device, flags);
  90. if (ret == RT_EOK) return 0;
  91. return ret;
  92. }
  93. static int serial_fops_close(struct dfs_file *fd)
  94. {
  95. rt_device_t device;
  96. device = (rt_device_t)fd->vnode->data;
  97. rt_device_set_rx_indicate(device, RT_NULL);
  98. rt_device_close(device);
  99. return 0;
  100. }
  101. static int serial_fops_ioctl(struct dfs_file *fd, int cmd, void *args)
  102. {
  103. rt_device_t device;
  104. int flags = (int)(rt_base_t)args;
  105. int mask = O_NONBLOCK | O_APPEND;
  106. device = (rt_device_t)fd->vnode->data;
  107. switch (cmd)
  108. {
  109. case FIONREAD:
  110. break;
  111. case FIONWRITE:
  112. break;
  113. case F_SETFL:
  114. flags &= mask;
  115. fd->flags &= ~mask;
  116. fd->flags |= flags;
  117. break;
  118. }
  119. return rt_device_control(device, cmd, args);
  120. }
  121. #ifdef RT_USING_DFS_V2
  122. static ssize_t serial_fops_read(struct dfs_file *fd, void *buf, size_t count, off_t *pos)
  123. #else
  124. static ssize_t serial_fops_read(struct dfs_file *fd, void *buf, size_t count)
  125. #endif
  126. {
  127. int size = 0;
  128. rt_device_t device;
  129. int wait_ret;
  130. device = (rt_device_t)fd->vnode->data;
  131. do
  132. {
  133. size = rt_device_read(device, -1, buf, count);
  134. if (size <= 0)
  135. {
  136. if (fd->flags & O_NONBLOCK)
  137. {
  138. size = -EAGAIN;
  139. break;
  140. }
  141. wait_ret = rt_wqueue_wait_interruptible(&(device->wait_queue), 0, RT_WAITING_FOREVER);
  142. if (wait_ret != RT_EOK)
  143. {
  144. break;
  145. }
  146. }
  147. }while (size <= 0);
  148. if (size < 0)
  149. {
  150. size = 0;
  151. }
  152. return size;
  153. }
  154. #ifdef RT_USING_DFS_V2
  155. static ssize_t serial_fops_write(struct dfs_file *fd, const void *buf, size_t count, off_t *pos)
  156. #else
  157. static ssize_t serial_fops_write(struct dfs_file *fd, const void *buf, size_t count)
  158. #endif
  159. {
  160. rt_device_t device;
  161. device = (rt_device_t)fd->vnode->data;
  162. return rt_device_write(device, -1, buf, count);
  163. }
  164. static int serial_fops_poll(struct dfs_file *fd, struct rt_pollreq *req)
  165. {
  166. int mask = 0;
  167. int flags = 0;
  168. rt_device_t device;
  169. struct rt_serial_device *serial;
  170. device = (rt_device_t)fd->vnode->data;
  171. RT_ASSERT(device != RT_NULL);
  172. serial = (struct rt_serial_device *)device;
  173. /* only support POLLIN */
  174. flags = fd->flags & O_ACCMODE;
  175. if (flags == O_RDONLY || flags == O_RDWR)
  176. {
  177. rt_base_t level;
  178. struct rt_serial_rx_fifo* rx_fifo;
  179. rt_poll_add(&(device->wait_queue), req);
  180. rx_fifo = (struct rt_serial_rx_fifo*) serial->serial_rx;
  181. level = rt_spin_lock_irqsave(&(serial->spinlock));
  182. if ((rx_fifo->get_index != rx_fifo->put_index) || (rx_fifo->get_index == rx_fifo->put_index && rx_fifo->is_full == RT_TRUE))
  183. mask |= POLLIN;
  184. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  185. }
  186. return mask;
  187. }
  188. static const struct dfs_file_ops _serial_fops =
  189. {
  190. .open = serial_fops_open,
  191. .close = serial_fops_close,
  192. .ioctl = serial_fops_ioctl,
  193. .read = serial_fops_read,
  194. .write = serial_fops_write,
  195. .poll = serial_fops_poll,
  196. };
  197. #endif /* RT_USING_POSIX_STDIO */
  198. /*
  199. * Serial poll routines
  200. */
  201. rt_inline int _serial_poll_rx(struct rt_serial_device *serial, rt_uint8_t *data, int length)
  202. {
  203. int ch;
  204. int size;
  205. RT_ASSERT(serial != RT_NULL);
  206. size = length;
  207. while (length)
  208. {
  209. ch = serial->ops->getc(serial);
  210. if (ch == -1) break;
  211. *data = ch;
  212. data ++; length --;
  213. if(serial->parent.open_flag & RT_DEVICE_FLAG_STREAM)
  214. {
  215. if (ch == '\n') break;
  216. }
  217. }
  218. return size - length;
  219. }
  220. rt_inline int _serial_poll_tx(struct rt_serial_device *serial, const rt_uint8_t *data, int length)
  221. {
  222. int size;
  223. RT_ASSERT(serial != RT_NULL);
  224. size = length;
  225. while (length)
  226. {
  227. /*
  228. * to be polite with serial console add a line feed
  229. * to the carriage return character
  230. */
  231. if (*data == '\n' && (serial->parent.open_flag & RT_DEVICE_FLAG_STREAM))
  232. {
  233. serial->ops->putc(serial, '\r');
  234. }
  235. if(serial->ops->putc(serial, *data) < 0) {
  236. break;
  237. }
  238. ++ data;
  239. -- length;
  240. }
  241. return size - length;
  242. }
  243. /*
  244. * Serial interrupt routines
  245. */
  246. rt_inline int _serial_int_rx(struct rt_serial_device *serial, rt_uint8_t *data, int length)
  247. {
  248. int size;
  249. struct rt_serial_rx_fifo* rx_fifo;
  250. RT_ASSERT(serial != RT_NULL);
  251. size = length;
  252. rx_fifo = (struct rt_serial_rx_fifo*) serial->serial_rx;
  253. RT_ASSERT(rx_fifo != RT_NULL);
  254. #ifdef RT_USING_SERIAL_BYPASS
  255. if (serial->bypass)
  256. {
  257. rt_bypass_work_straight(serial);
  258. while (length)
  259. {
  260. rt_uint8_t ch;
  261. if (!rt_bypass_getchar(serial, &ch))
  262. break;
  263. *data = ch & 0xff;
  264. data++; length--;
  265. }
  266. return size - length;
  267. }
  268. #endif
  269. /* read from software FIFO */
  270. while (length)
  271. {
  272. int ch;
  273. rt_base_t level;
  274. /* disable interrupt */
  275. level = rt_spin_lock_irqsave(&(serial->spinlock));
  276. /* there's no data: */
  277. if ((rx_fifo->get_index == rx_fifo->put_index) && (rx_fifo->is_full == RT_FALSE))
  278. {
  279. /* no data, enable interrupt and break out */
  280. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  281. break;
  282. }
  283. /* otherwise there's the data: */
  284. ch = rx_fifo->buffer[rx_fifo->get_index];
  285. rx_fifo->get_index += 1;
  286. if (rx_fifo->get_index >= serial->config.bufsz) rx_fifo->get_index = 0;
  287. if (rx_fifo->is_full == RT_TRUE)
  288. {
  289. rx_fifo->is_full = RT_FALSE;
  290. }
  291. /* enable interrupt */
  292. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  293. *data = ch & 0xff;
  294. data ++; length --;
  295. }
  296. return size - length;
  297. }
  298. rt_inline int _serial_int_tx(struct rt_serial_device *serial, const rt_uint8_t *data, int length)
  299. {
  300. int size;
  301. struct rt_serial_tx_fifo *tx;
  302. RT_ASSERT(serial != RT_NULL);
  303. size = length;
  304. tx = (struct rt_serial_tx_fifo*) serial->serial_tx;
  305. RT_ASSERT(tx != RT_NULL);
  306. while (length)
  307. {
  308. /*
  309. * to be polite with serial console add a line feed
  310. * to the carriage return character
  311. */
  312. if (*data == '\n' && (serial->parent.open_flag & RT_DEVICE_FLAG_STREAM))
  313. {
  314. if (serial->ops->putc(serial, '\r') == -1)
  315. {
  316. rt_completion_wait(&(tx->completion), RT_WAITING_FOREVER);
  317. continue;
  318. }
  319. }
  320. while (serial->ops->putc(serial, *(char*)data) == -1)
  321. {
  322. rt_completion_wait(&(tx->completion), RT_WAITING_FOREVER);
  323. }
  324. data ++; length --;
  325. }
  326. return size - length;
  327. }
  328. static void _serial_check_buffer_size(void)
  329. {
  330. static rt_bool_t already_output = RT_FALSE;
  331. if (already_output == RT_FALSE)
  332. {
  333. #if !defined(RT_USING_ULOG) || defined(ULOG_USING_ISR_LOG)
  334. LOG_W("Warning: There is no enough buffer for saving data,"
  335. " please increase the RT_SERIAL_RB_BUFSZ option.");
  336. #endif
  337. already_output = RT_TRUE;
  338. }
  339. }
  340. #if defined(RT_USING_POSIX_STDIO) || defined(RT_SERIAL_USING_DMA)
  341. static rt_ssize_t _serial_fifo_calc_recved_len(struct rt_serial_device *serial)
  342. {
  343. struct rt_serial_rx_fifo *rx_fifo = (struct rt_serial_rx_fifo *) serial->serial_rx;
  344. RT_ASSERT(rx_fifo != RT_NULL);
  345. if (rx_fifo->put_index == rx_fifo->get_index)
  346. {
  347. return (rx_fifo->is_full == RT_FALSE ? 0 : serial->config.bufsz);
  348. }
  349. else
  350. {
  351. if (rx_fifo->put_index > rx_fifo->get_index)
  352. {
  353. return rx_fifo->put_index - rx_fifo->get_index;
  354. }
  355. else
  356. {
  357. return serial->config.bufsz - (rx_fifo->get_index - rx_fifo->put_index);
  358. }
  359. }
  360. }
  361. #endif /* RT_USING_POSIX_STDIO || RT_SERIAL_USING_DMA */
  362. #ifdef RT_SERIAL_USING_DMA
  363. /**
  364. * Calculate DMA received data length.
  365. *
  366. * @param serial serial device
  367. *
  368. * @return length
  369. */
  370. static rt_ssize_t rt_dma_calc_recved_len(struct rt_serial_device *serial)
  371. {
  372. return _serial_fifo_calc_recved_len(serial);
  373. }
  374. /**
  375. * Read data finish by DMA mode then update the get index for receive fifo.
  376. *
  377. * @param serial serial device
  378. * @param len get data length for this operate
  379. */
  380. static void rt_dma_recv_update_get_index(struct rt_serial_device *serial, rt_size_t len)
  381. {
  382. struct rt_serial_rx_fifo *rx_fifo = (struct rt_serial_rx_fifo *) serial->serial_rx;
  383. RT_ASSERT(rx_fifo != RT_NULL);
  384. RT_ASSERT(len <= rt_dma_calc_recved_len(serial));
  385. if (rx_fifo->is_full && len != 0) rx_fifo->is_full = RT_FALSE;
  386. rx_fifo->get_index += (rt_uint16_t)len;
  387. if (rx_fifo->get_index >= serial->config.bufsz)
  388. {
  389. rx_fifo->get_index %= serial->config.bufsz;
  390. }
  391. }
  392. /**
  393. * DMA received finish then update put index for receive fifo.
  394. *
  395. * @param serial serial device
  396. * @param len received length for this transmit
  397. */
  398. static void rt_dma_recv_update_put_index(struct rt_serial_device *serial, rt_size_t len)
  399. {
  400. struct rt_serial_rx_fifo *rx_fifo = (struct rt_serial_rx_fifo *)serial->serial_rx;
  401. RT_ASSERT(rx_fifo != RT_NULL);
  402. if (rx_fifo->get_index <= rx_fifo->put_index)
  403. {
  404. rx_fifo->put_index += (rt_uint16_t)len;
  405. /* beyond the fifo end */
  406. if (rx_fifo->put_index >= serial->config.bufsz)
  407. {
  408. rx_fifo->put_index %= serial->config.bufsz;
  409. /* force overwrite get index */
  410. if (rx_fifo->put_index >= rx_fifo->get_index)
  411. {
  412. rx_fifo->is_full = RT_TRUE;
  413. }
  414. }
  415. }
  416. else
  417. {
  418. rx_fifo->put_index += (rt_uint16_t)len;
  419. if (rx_fifo->put_index >= rx_fifo->get_index)
  420. {
  421. /* beyond the fifo end */
  422. if (rx_fifo->put_index >= serial->config.bufsz)
  423. {
  424. rx_fifo->put_index %= serial->config.bufsz;
  425. }
  426. /* force overwrite get index */
  427. rx_fifo->is_full = RT_TRUE;
  428. }
  429. }
  430. if(rx_fifo->is_full == RT_TRUE)
  431. {
  432. _serial_check_buffer_size();
  433. rx_fifo->get_index = rx_fifo->put_index;
  434. }
  435. }
  436. /*
  437. * Serial DMA routines
  438. */
  439. rt_inline int _serial_dma_rx(struct rt_serial_device *serial, rt_uint8_t *data, int length)
  440. {
  441. rt_base_t level;
  442. RT_ASSERT((serial != RT_NULL) && (data != RT_NULL));
  443. level = rt_spin_lock_irqsave(&(serial->spinlock));
  444. if (serial->config.bufsz == 0)
  445. {
  446. int result = RT_EOK;
  447. struct rt_serial_rx_dma *rx_dma;
  448. rx_dma = (struct rt_serial_rx_dma*)serial->serial_rx;
  449. RT_ASSERT(rx_dma != RT_NULL);
  450. if (rx_dma->activated != RT_TRUE)
  451. {
  452. rx_dma->activated = RT_TRUE;
  453. RT_ASSERT(serial->ops->dma_transmit != RT_NULL);
  454. serial->ops->dma_transmit(serial, data, length, RT_SERIAL_DMA_RX);
  455. }
  456. else result = -RT_EBUSY;
  457. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  458. if (result == RT_EOK) return length;
  459. rt_set_errno(result);
  460. return 0;
  461. }
  462. else
  463. {
  464. struct rt_serial_rx_fifo *rx_fifo = (struct rt_serial_rx_fifo *) serial->serial_rx;
  465. rt_size_t recv_len = 0, fifo_recved_len = rt_dma_calc_recved_len(serial);
  466. RT_ASSERT(rx_fifo != RT_NULL);
  467. if (length < (int)fifo_recved_len)
  468. recv_len = length;
  469. else
  470. recv_len = fifo_recved_len;
  471. if (rx_fifo->get_index + recv_len < serial->config.bufsz)
  472. rt_memcpy(data, rx_fifo->buffer + rx_fifo->get_index, recv_len);
  473. else
  474. {
  475. rt_memcpy(data, rx_fifo->buffer + rx_fifo->get_index,
  476. serial->config.bufsz - rx_fifo->get_index);
  477. rt_memcpy(data + serial->config.bufsz - rx_fifo->get_index, rx_fifo->buffer,
  478. recv_len + rx_fifo->get_index - serial->config.bufsz);
  479. }
  480. rt_dma_recv_update_get_index(serial, recv_len);
  481. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  482. return recv_len;
  483. }
  484. }
  485. rt_inline int _serial_dma_tx(struct rt_serial_device *serial, const rt_uint8_t *data, int length)
  486. {
  487. rt_base_t level;
  488. rt_err_t result;
  489. struct rt_serial_tx_dma *tx_dma;
  490. tx_dma = (struct rt_serial_tx_dma*)(serial->serial_tx);
  491. result = rt_data_queue_push(&(tx_dma->data_queue), data, length, RT_WAITING_FOREVER);
  492. if (result == RT_EOK)
  493. {
  494. level = rt_spin_lock_irqsave(&(serial->spinlock));
  495. if (tx_dma->activated != RT_TRUE)
  496. {
  497. tx_dma->activated = RT_TRUE;
  498. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  499. /* make a DMA transfer */
  500. serial->ops->dma_transmit(serial, (rt_uint8_t *)data, length, RT_SERIAL_DMA_TX);
  501. }
  502. else
  503. {
  504. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  505. }
  506. return length;
  507. }
  508. else
  509. {
  510. rt_set_errno(result);
  511. return 0;
  512. }
  513. }
  514. #endif /* RT_SERIAL_USING_DMA */
  515. /* RT-Thread Device Interface */
  516. /*
  517. * This function initializes serial device.
  518. */
  519. static rt_err_t rt_serial_init(struct rt_device *dev)
  520. {
  521. rt_err_t result = RT_EOK;
  522. struct rt_serial_device *serial;
  523. RT_ASSERT(dev != RT_NULL);
  524. serial = (struct rt_serial_device *)dev;
  525. /* initialize rx/tx */
  526. serial->serial_rx = RT_NULL;
  527. serial->serial_tx = RT_NULL;
  528. rt_memset(&serial->rx_notify, 0, sizeof(struct rt_device_notify));
  529. /* apply configuration */
  530. if (serial->ops->configure)
  531. result = serial->ops->configure(serial, &serial->config);
  532. return result;
  533. }
  534. static rt_err_t rt_serial_open(struct rt_device *dev, rt_uint16_t oflag)
  535. {
  536. rt_uint16_t stream_flag = 0;
  537. struct rt_serial_device *serial;
  538. RT_ASSERT(dev != RT_NULL);
  539. serial = (struct rt_serial_device *)dev;
  540. LOG_D("open serial device: 0x%08x with open flag: 0x%04x",
  541. dev, oflag);
  542. /* check device flag with the open flag */
  543. if ((oflag & RT_DEVICE_FLAG_DMA_RX) && !(dev->flag & RT_DEVICE_FLAG_DMA_RX))
  544. return -RT_EIO;
  545. if ((oflag & RT_DEVICE_FLAG_DMA_TX) && !(dev->flag & RT_DEVICE_FLAG_DMA_TX))
  546. return -RT_EIO;
  547. if ((oflag & RT_DEVICE_FLAG_INT_RX) && !(dev->flag & RT_DEVICE_FLAG_INT_RX))
  548. return -RT_EIO;
  549. if ((oflag & RT_DEVICE_FLAG_INT_TX) && !(dev->flag & RT_DEVICE_FLAG_INT_TX))
  550. return -RT_EIO;
  551. /* keep steam flag */
  552. if ((oflag & RT_DEVICE_FLAG_STREAM) || (dev->open_flag & RT_DEVICE_FLAG_STREAM))
  553. stream_flag = RT_DEVICE_FLAG_STREAM;
  554. /* get open flags */
  555. dev->open_flag = oflag & 0xff;
  556. #ifdef RT_USING_PINCTRL
  557. /* initialize iomux in DM */
  558. rt_pin_ctrl_confs_apply_by_name(dev, RT_NULL);
  559. #endif
  560. /* initialize the Rx/Tx structure according to open flag */
  561. if (serial->serial_rx == RT_NULL)
  562. {
  563. if (oflag & RT_DEVICE_FLAG_INT_RX)
  564. {
  565. struct rt_serial_rx_fifo* rx_fifo;
  566. rx_fifo = (struct rt_serial_rx_fifo*) rt_malloc (sizeof(struct rt_serial_rx_fifo) +
  567. serial->config.bufsz);
  568. RT_ASSERT(rx_fifo != RT_NULL);
  569. rx_fifo->buffer = (rt_uint8_t*) (rx_fifo + 1);
  570. rt_memset(rx_fifo->buffer, 0, serial->config.bufsz);
  571. rx_fifo->put_index = 0;
  572. rx_fifo->get_index = 0;
  573. rx_fifo->is_full = RT_FALSE;
  574. serial->serial_rx = rx_fifo;
  575. dev->open_flag |= RT_DEVICE_FLAG_INT_RX;
  576. /* configure low level device */
  577. serial->ops->control(serial, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_FLAG_INT_RX);
  578. }
  579. #ifdef RT_SERIAL_USING_DMA
  580. else if (oflag & RT_DEVICE_FLAG_DMA_RX)
  581. {
  582. if (serial->config.bufsz == 0) {
  583. struct rt_serial_rx_dma* rx_dma;
  584. rx_dma = (struct rt_serial_rx_dma*) rt_malloc (sizeof(struct rt_serial_rx_dma));
  585. RT_ASSERT(rx_dma != RT_NULL);
  586. rx_dma->activated = RT_FALSE;
  587. serial->serial_rx = rx_dma;
  588. } else {
  589. struct rt_serial_rx_fifo* rx_fifo;
  590. rx_fifo = (struct rt_serial_rx_fifo*) rt_malloc (sizeof(struct rt_serial_rx_fifo) +
  591. serial->config.bufsz);
  592. RT_ASSERT(rx_fifo != RT_NULL);
  593. rx_fifo->buffer = (rt_uint8_t*) (rx_fifo + 1);
  594. rt_memset(rx_fifo->buffer, 0, serial->config.bufsz);
  595. rx_fifo->put_index = 0;
  596. rx_fifo->get_index = 0;
  597. rx_fifo->is_full = RT_FALSE;
  598. serial->serial_rx = rx_fifo;
  599. /* configure fifo address and length to low level device */
  600. serial->ops->control(serial, RT_DEVICE_CTRL_CONFIG, (void *) RT_DEVICE_FLAG_DMA_RX);
  601. }
  602. dev->open_flag |= RT_DEVICE_FLAG_DMA_RX;
  603. }
  604. #endif /* RT_SERIAL_USING_DMA */
  605. else
  606. {
  607. serial->serial_rx = RT_NULL;
  608. }
  609. }
  610. else
  611. {
  612. if (oflag & RT_DEVICE_FLAG_INT_RX)
  613. dev->open_flag |= RT_DEVICE_FLAG_INT_RX;
  614. #ifdef RT_SERIAL_USING_DMA
  615. else if (oflag & RT_DEVICE_FLAG_DMA_RX)
  616. dev->open_flag |= RT_DEVICE_FLAG_DMA_RX;
  617. #endif /* RT_SERIAL_USING_DMA */
  618. }
  619. if (serial->serial_tx == RT_NULL)
  620. {
  621. if (oflag & RT_DEVICE_FLAG_INT_TX)
  622. {
  623. struct rt_serial_tx_fifo *tx_fifo;
  624. tx_fifo = (struct rt_serial_tx_fifo*) rt_malloc(sizeof(struct rt_serial_tx_fifo));
  625. RT_ASSERT(tx_fifo != RT_NULL);
  626. rt_completion_init(&(tx_fifo->completion));
  627. serial->serial_tx = tx_fifo;
  628. dev->open_flag |= RT_DEVICE_FLAG_INT_TX;
  629. /* configure low level device */
  630. serial->ops->control(serial, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_FLAG_INT_TX);
  631. }
  632. #ifdef RT_SERIAL_USING_DMA
  633. else if (oflag & RT_DEVICE_FLAG_DMA_TX)
  634. {
  635. struct rt_serial_tx_dma* tx_dma;
  636. tx_dma = (struct rt_serial_tx_dma*) rt_malloc (sizeof(struct rt_serial_tx_dma));
  637. RT_ASSERT(tx_dma != RT_NULL);
  638. tx_dma->activated = RT_FALSE;
  639. rt_data_queue_init(&(tx_dma->data_queue), 8, 4, RT_NULL);
  640. serial->serial_tx = tx_dma;
  641. dev->open_flag |= RT_DEVICE_FLAG_DMA_TX;
  642. /* configure low level device */
  643. serial->ops->control(serial, RT_DEVICE_CTRL_CONFIG, (void *)RT_DEVICE_FLAG_DMA_TX);
  644. }
  645. #endif /* RT_SERIAL_USING_DMA */
  646. else
  647. {
  648. serial->serial_tx = RT_NULL;
  649. }
  650. }
  651. else
  652. {
  653. if (oflag & RT_DEVICE_FLAG_INT_TX)
  654. dev->open_flag |= RT_DEVICE_FLAG_INT_TX;
  655. #ifdef RT_SERIAL_USING_DMA
  656. else if (oflag & RT_DEVICE_FLAG_DMA_TX)
  657. dev->open_flag |= RT_DEVICE_FLAG_DMA_TX;
  658. #endif /* RT_SERIAL_USING_DMA */
  659. }
  660. /* set stream flag */
  661. dev->open_flag |= stream_flag;
  662. return RT_EOK;
  663. }
  664. static rt_err_t rt_serial_close(struct rt_device *dev)
  665. {
  666. struct rt_serial_device *serial;
  667. RT_ASSERT(dev != RT_NULL);
  668. serial = (struct rt_serial_device *)dev;
  669. /* this device has more reference count */
  670. if (dev->ref_count > 1) return RT_EOK;
  671. if (dev->open_flag & RT_DEVICE_FLAG_INT_RX)
  672. {
  673. struct rt_serial_rx_fifo* rx_fifo;
  674. /* configure low level device */
  675. serial->ops->control(serial, RT_DEVICE_CTRL_CLR_INT, (void*)RT_DEVICE_FLAG_INT_RX);
  676. dev->open_flag &= ~RT_DEVICE_FLAG_INT_RX;
  677. rx_fifo = (struct rt_serial_rx_fifo*)serial->serial_rx;
  678. RT_ASSERT(rx_fifo != RT_NULL);
  679. rt_free(rx_fifo);
  680. serial->serial_rx = RT_NULL;
  681. }
  682. #ifdef RT_SERIAL_USING_DMA
  683. else if (dev->open_flag & RT_DEVICE_FLAG_DMA_RX)
  684. {
  685. /* configure low level device */
  686. serial->ops->control(serial, RT_DEVICE_CTRL_CLR_INT, (void *) RT_DEVICE_FLAG_DMA_RX);
  687. dev->open_flag &= ~RT_DEVICE_FLAG_DMA_RX;
  688. if (serial->config.bufsz == 0)
  689. {
  690. struct rt_serial_rx_dma* rx_dma;
  691. rx_dma = (struct rt_serial_rx_dma*)serial->serial_rx;
  692. RT_ASSERT(rx_dma != RT_NULL);
  693. rt_free(rx_dma);
  694. }
  695. else
  696. {
  697. struct rt_serial_rx_fifo* rx_fifo;
  698. rx_fifo = (struct rt_serial_rx_fifo*)serial->serial_rx;
  699. RT_ASSERT(rx_fifo != RT_NULL);
  700. rt_free(rx_fifo);
  701. }
  702. serial->serial_rx = RT_NULL;
  703. }
  704. #endif /* RT_SERIAL_USING_DMA */
  705. if (dev->open_flag & RT_DEVICE_FLAG_INT_TX)
  706. {
  707. struct rt_serial_tx_fifo* tx_fifo;
  708. serial->ops->control(serial, RT_DEVICE_CTRL_CLR_INT, (void*)RT_DEVICE_FLAG_INT_TX);
  709. dev->open_flag &= ~RT_DEVICE_FLAG_INT_TX;
  710. tx_fifo = (struct rt_serial_tx_fifo*)serial->serial_tx;
  711. RT_ASSERT(tx_fifo != RT_NULL);
  712. rt_free(tx_fifo);
  713. serial->serial_tx = RT_NULL;
  714. /* configure low level device */
  715. }
  716. #ifdef RT_SERIAL_USING_DMA
  717. else if (dev->open_flag & RT_DEVICE_FLAG_DMA_TX)
  718. {
  719. struct rt_serial_tx_dma* tx_dma;
  720. /* configure low level device */
  721. serial->ops->control(serial, RT_DEVICE_CTRL_CLR_INT, (void *) RT_DEVICE_FLAG_DMA_TX);
  722. dev->open_flag &= ~RT_DEVICE_FLAG_DMA_TX;
  723. tx_dma = (struct rt_serial_tx_dma*)serial->serial_tx;
  724. RT_ASSERT(tx_dma != RT_NULL);
  725. rt_data_queue_deinit(&(tx_dma->data_queue));
  726. rt_free(tx_dma);
  727. serial->serial_tx = RT_NULL;
  728. }
  729. #endif /* RT_SERIAL_USING_DMA */
  730. serial->ops->control(serial, RT_DEVICE_CTRL_CLOSE, RT_NULL);
  731. dev->flag &= ~RT_DEVICE_FLAG_ACTIVATED;
  732. return RT_EOK;
  733. }
  734. static rt_ssize_t rt_serial_read(struct rt_device *dev,
  735. rt_off_t pos,
  736. void *buffer,
  737. rt_size_t size)
  738. {
  739. struct rt_serial_device *serial;
  740. RT_ASSERT(dev != RT_NULL);
  741. if (size == 0) return 0;
  742. serial = (struct rt_serial_device *)dev;
  743. if (dev->open_flag & RT_DEVICE_FLAG_INT_RX)
  744. {
  745. return _serial_int_rx(serial, (rt_uint8_t *)buffer, size);
  746. }
  747. #ifdef RT_SERIAL_USING_DMA
  748. else if (dev->open_flag & RT_DEVICE_FLAG_DMA_RX)
  749. {
  750. return _serial_dma_rx(serial, (rt_uint8_t *)buffer, size);
  751. }
  752. #endif /* RT_SERIAL_USING_DMA */
  753. return _serial_poll_rx(serial, (rt_uint8_t *)buffer, size);
  754. }
  755. static rt_ssize_t rt_serial_write(struct rt_device *dev,
  756. rt_off_t pos,
  757. const void *buffer,
  758. rt_size_t size)
  759. {
  760. struct rt_serial_device *serial;
  761. RT_ASSERT(dev != RT_NULL);
  762. if (size == 0) return 0;
  763. serial = (struct rt_serial_device *)dev;
  764. if (dev->open_flag & RT_DEVICE_FLAG_INT_TX)
  765. {
  766. return _serial_int_tx(serial, (const rt_uint8_t *)buffer, size);
  767. }
  768. #ifdef RT_SERIAL_USING_DMA
  769. else if (dev->open_flag & RT_DEVICE_FLAG_DMA_TX)
  770. {
  771. return _serial_dma_tx(serial, (const rt_uint8_t *)buffer, size);
  772. }
  773. #endif /* RT_SERIAL_USING_DMA */
  774. else
  775. {
  776. return _serial_poll_tx(serial, (const rt_uint8_t *)buffer, size);
  777. }
  778. }
  779. #if defined(RT_USING_POSIX_TERMIOS)
  780. struct speed_baudrate_item
  781. {
  782. speed_t speed;
  783. int baudrate;
  784. };
  785. static const struct speed_baudrate_item _tbl[] =
  786. {
  787. {B2400, BAUD_RATE_2400},
  788. {B4800, BAUD_RATE_4800},
  789. {B9600, BAUD_RATE_9600},
  790. {B19200, BAUD_RATE_19200},
  791. {B38400, BAUD_RATE_38400},
  792. {B57600, BAUD_RATE_57600},
  793. {B115200, BAUD_RATE_115200},
  794. {B230400, BAUD_RATE_230400},
  795. {B460800, BAUD_RATE_460800},
  796. {B500000, BAUD_RATE_500000},
  797. {B576000, BAUD_RATE_576000},
  798. {B921600, BAUD_RATE_921600},
  799. {B1000000, BAUD_RATE_1000000},
  800. {B1152000, BAUD_RATE_1152000},
  801. {B1500000, BAUD_RATE_1500000},
  802. {B2000000, BAUD_RATE_2000000},
  803. {B2500000, BAUD_RATE_2500000},
  804. {B3000000, BAUD_RATE_3000000},
  805. {B3500000, BAUD_RATE_3500000},
  806. {B4000000, BAUD_RATE_4000000},
  807. };
  808. static speed_t _get_speed(int baudrate)
  809. {
  810. size_t index;
  811. for (index = 0; index < sizeof(_tbl)/sizeof(_tbl[0]); index ++)
  812. {
  813. if (_tbl[index].baudrate == baudrate)
  814. return _tbl[index].speed;
  815. }
  816. return B0;
  817. }
  818. static int _get_baudrate(speed_t speed)
  819. {
  820. size_t index;
  821. for (index = 0; index < sizeof(_tbl)/sizeof(_tbl[0]); index ++)
  822. {
  823. if (_tbl[index].speed == speed)
  824. return _tbl[index].baudrate;
  825. }
  826. return 0;
  827. }
  828. static void _tc_flush(struct rt_serial_device *serial, int queue)
  829. {
  830. rt_base_t level;
  831. int ch = -1;
  832. struct rt_serial_rx_fifo *rx_fifo = RT_NULL;
  833. struct rt_device *device = RT_NULL;
  834. RT_ASSERT(serial != RT_NULL);
  835. device = &(serial->parent);
  836. rx_fifo = (struct rt_serial_rx_fifo *) serial->serial_rx;
  837. switch(queue)
  838. {
  839. case TCIFLUSH:
  840. case TCIOFLUSH:
  841. RT_ASSERT(rx_fifo != RT_NULL);
  842. if((device->open_flag & RT_DEVICE_FLAG_INT_RX) || (device->open_flag & RT_DEVICE_FLAG_DMA_RX))
  843. {
  844. RT_ASSERT(RT_NULL != rx_fifo);
  845. level = rt_spin_lock_irqsave(&(serial->spinlock));
  846. rx_fifo->get_index = rx_fifo->put_index;
  847. rx_fifo->is_full = RT_FALSE;
  848. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  849. }
  850. else
  851. {
  852. while (1)
  853. {
  854. ch = serial->ops->getc(serial);
  855. if (ch == -1) break;
  856. }
  857. }
  858. break;
  859. case TCOFLUSH:
  860. break;
  861. }
  862. }
  863. static inline int _termio_to_termios(const struct termio *termio, struct termios *termios)
  864. {
  865. termios->c_iflag = termio->c_iflag;
  866. termios->c_oflag = termio->c_oflag;
  867. termios->c_cflag = termio->c_cflag;
  868. termios->c_lflag = termio->c_lflag;
  869. termios->c_line = termio->c_line;
  870. rt_memcpy(termios->c_cc, termio->c_cc, NCC);
  871. return 0;
  872. }
  873. static inline int _termios_to_termio(const struct termios *termios, struct termio *termio)
  874. {
  875. termio->c_iflag = (unsigned short)termios->c_iflag;
  876. termio->c_oflag = (unsigned short)termios->c_oflag;
  877. termio->c_cflag = (unsigned short)termios->c_cflag;
  878. termio->c_lflag = (unsigned short)termios->c_lflag;
  879. termio->c_line = termios->c_line;
  880. rt_memcpy(termio->c_cc, termios->c_cc, NCC);
  881. return 0;
  882. }
  883. #endif /* RT_USING_POSIX_TERMIOS */
  884. static rt_err_t rt_serial_control(struct rt_device *dev,
  885. int cmd,
  886. void *args)
  887. {
  888. rt_err_t ret = RT_EOK;
  889. struct rt_serial_device *serial;
  890. RT_ASSERT(dev != RT_NULL);
  891. serial = (struct rt_serial_device *)dev;
  892. switch (cmd)
  893. {
  894. case RT_DEVICE_CTRL_SUSPEND:
  895. /* suspend device */
  896. dev->flag |= RT_DEVICE_FLAG_SUSPENDED;
  897. break;
  898. case RT_DEVICE_CTRL_RESUME:
  899. /* resume device */
  900. dev->flag &= ~RT_DEVICE_FLAG_SUSPENDED;
  901. break;
  902. case RT_DEVICE_CTRL_CONFIG:
  903. if (args)
  904. {
  905. struct serial_configure *pconfig = (struct serial_configure *) args;
  906. if (pconfig->bufsz != serial->config.bufsz && serial->parent.ref_count)
  907. {
  908. /*can not change buffer size*/
  909. return -RT_EBUSY;
  910. }
  911. /* set serial configure */
  912. serial->config = *pconfig;
  913. if (serial->parent.ref_count)
  914. {
  915. /* serial device has been opened, to configure it */
  916. serial->ops->configure(serial, (struct serial_configure *) args);
  917. }
  918. }
  919. break;
  920. case RT_DEVICE_CTRL_NOTIFY_SET:
  921. if (args)
  922. {
  923. rt_memcpy(&serial->rx_notify, args, sizeof(struct rt_device_notify));
  924. }
  925. break;
  926. case RT_DEVICE_CTRL_CONSOLE_OFLAG:
  927. if (args)
  928. {
  929. *(rt_uint16_t*)args = RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_INT_RX | RT_DEVICE_FLAG_STREAM;
  930. }
  931. break;
  932. #ifdef RT_USING_POSIX_STDIO
  933. #if defined(RT_USING_POSIX_TERMIOS)
  934. case TCGETA:
  935. case TCGETS:
  936. {
  937. struct termios *tio, tmp;
  938. if (cmd == TCGETS)
  939. {
  940. tio = (struct termios*)args;
  941. }
  942. else
  943. {
  944. tio = &tmp;
  945. }
  946. if (tio == RT_NULL) return -RT_EINVAL;
  947. tio->c_iflag = 0;
  948. tio->c_oflag = 0;
  949. tio->c_lflag = 0;
  950. /* update oflag for console device */
  951. if (rt_console_get_device() == dev)
  952. tio->c_oflag = OPOST | ONLCR;
  953. /* set cflag */
  954. tio->c_cflag = 0;
  955. if (serial->config.data_bits == DATA_BITS_5)
  956. tio->c_cflag = CS5;
  957. else if (serial->config.data_bits == DATA_BITS_6)
  958. tio->c_cflag = CS6;
  959. else if (serial->config.data_bits == DATA_BITS_7)
  960. tio->c_cflag = CS7;
  961. else if (serial->config.data_bits == DATA_BITS_8)
  962. tio->c_cflag = CS8;
  963. if (serial->config.stop_bits == STOP_BITS_2)
  964. tio->c_cflag |= CSTOPB;
  965. if (serial->config.parity == PARITY_EVEN)
  966. tio->c_cflag |= PARENB;
  967. else if (serial->config.parity == PARITY_ODD)
  968. tio->c_cflag |= (PARODD | PARENB);
  969. cfsetospeed(tio, _get_speed(serial->config.baud_rate));
  970. if (cmd == TCGETA)
  971. {
  972. _termios_to_termio(tio, args);
  973. }
  974. }
  975. break;
  976. case TCSETAW:
  977. case TCSETAF:
  978. case TCSETA:
  979. case TCSETSW:
  980. case TCSETSF:
  981. case TCSETS:
  982. {
  983. int baudrate;
  984. struct serial_configure config;
  985. struct termios *tio, tmp;
  986. if ((cmd >= TCSETA) && (cmd <= TCSETA + 2))
  987. {
  988. _termio_to_termios(args, &tmp);
  989. tio = &tmp;
  990. }
  991. else
  992. {
  993. tio = (struct termios*)args;
  994. }
  995. if (tio == RT_NULL) return -RT_EINVAL;
  996. config = serial->config;
  997. baudrate = _get_baudrate(cfgetospeed(tio));
  998. config.baud_rate = baudrate;
  999. switch (tio->c_cflag & CSIZE)
  1000. {
  1001. case CS5:
  1002. config.data_bits = DATA_BITS_5;
  1003. break;
  1004. case CS6:
  1005. config.data_bits = DATA_BITS_6;
  1006. break;
  1007. case CS7:
  1008. config.data_bits = DATA_BITS_7;
  1009. break;
  1010. default:
  1011. config.data_bits = DATA_BITS_8;
  1012. break;
  1013. }
  1014. if (tio->c_cflag & CSTOPB) config.stop_bits = STOP_BITS_2;
  1015. else config.stop_bits = STOP_BITS_1;
  1016. if (tio->c_cflag & PARENB)
  1017. {
  1018. if (tio->c_cflag & PARODD) config.parity = PARITY_ODD;
  1019. else config.parity = PARITY_EVEN;
  1020. }
  1021. else config.parity = PARITY_NONE;
  1022. serial->ops->configure(serial, &config);
  1023. }
  1024. break;
  1025. #ifndef RT_USING_TTY
  1026. case TCFLSH:
  1027. {
  1028. int queue = (int)(rt_ubase_t)args;
  1029. _tc_flush(serial, queue);
  1030. }
  1031. break;
  1032. case TCXONC:
  1033. break;
  1034. #endif /*RT_USING_TTY*/
  1035. #endif /*RT_USING_POSIX_TERMIOS*/
  1036. case TIOCSWINSZ:
  1037. {
  1038. struct winsize* p_winsize;
  1039. p_winsize = (struct winsize*)args;
  1040. rt_kprintf("\x1b[8;%d;%dt", p_winsize->ws_col, p_winsize->ws_row);
  1041. }
  1042. break;
  1043. case TIOCGWINSZ:
  1044. {
  1045. struct winsize* p_winsize;
  1046. p_winsize = (struct winsize*)args;
  1047. if(rt_thread_self() != rt_thread_find("tshell"))
  1048. {
  1049. /* only can be used in tshell thread; otherwise, return default size */
  1050. p_winsize->ws_col = 80;
  1051. p_winsize->ws_row = 24;
  1052. }
  1053. else
  1054. {
  1055. #include <shell.h>
  1056. #define _TIO_BUFLEN 20
  1057. char _tio_buf[_TIO_BUFLEN];
  1058. unsigned char cnt1, cnt2, cnt3, i;
  1059. char row_s[4], col_s[4];
  1060. char *p;
  1061. rt_memset(_tio_buf, 0, _TIO_BUFLEN);
  1062. /* send the command to terminal for getting the window size of the terminal */
  1063. rt_kprintf("\033[18t");
  1064. /* waiting for the response from the terminal */
  1065. i = 0;
  1066. while(i < _TIO_BUFLEN)
  1067. {
  1068. _tio_buf[i] = finsh_getchar();
  1069. if(_tio_buf[i] != 't')
  1070. {
  1071. i ++;
  1072. }
  1073. else
  1074. {
  1075. break;
  1076. }
  1077. }
  1078. if(i == _TIO_BUFLEN)
  1079. {
  1080. /* buffer overloaded, and return default size */
  1081. p_winsize->ws_col = 80;
  1082. p_winsize->ws_row = 24;
  1083. break;
  1084. }
  1085. /* interpreting data eg: "\033[8;1;15t" which means row is 1 and col is 15 (unit: size of ONE character) */
  1086. rt_memset(row_s,0,4);
  1087. rt_memset(col_s,0,4);
  1088. cnt1 = 0;
  1089. while(cnt1 < _TIO_BUFLEN && _tio_buf[cnt1] != ';')
  1090. {
  1091. cnt1++;
  1092. }
  1093. cnt2 = ++cnt1;
  1094. while(cnt2 < _TIO_BUFLEN && _tio_buf[cnt2] != ';')
  1095. {
  1096. cnt2++;
  1097. }
  1098. p = row_s;
  1099. while(cnt1 < cnt2)
  1100. {
  1101. *p++ = _tio_buf[cnt1++];
  1102. }
  1103. p = col_s;
  1104. cnt2++;
  1105. cnt3 = rt_strlen(_tio_buf) - 1;
  1106. while(cnt2 < cnt3)
  1107. {
  1108. *p++ = _tio_buf[cnt2++];
  1109. }
  1110. /* load the window size date */
  1111. p_winsize->ws_col = atoi(col_s);
  1112. p_winsize->ws_row = atoi(row_s);
  1113. #undef _TIO_BUFLEN
  1114. }
  1115. p_winsize->ws_xpixel = 0;/* unused */
  1116. p_winsize->ws_ypixel = 0;/* unused */
  1117. }
  1118. break;
  1119. case FIONREAD:
  1120. {
  1121. rt_size_t recved = 0;
  1122. rt_base_t level;
  1123. level = rt_spin_lock_irqsave(&(serial->spinlock));
  1124. recved = _serial_fifo_calc_recved_len(serial);
  1125. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  1126. *(rt_size_t *)args = recved;
  1127. }
  1128. break;
  1129. #endif /* RT_USING_POSIX_STDIO */
  1130. default :
  1131. /* control device */
  1132. ret = serial->ops->control(serial, cmd, args);
  1133. break;
  1134. }
  1135. return ret;
  1136. }
  1137. #ifdef RT_USING_DEVICE_OPS
  1138. const static struct rt_device_ops serial_ops =
  1139. {
  1140. rt_serial_init,
  1141. rt_serial_open,
  1142. rt_serial_close,
  1143. rt_serial_read,
  1144. rt_serial_write,
  1145. rt_serial_control
  1146. };
  1147. #endif
  1148. /*
  1149. * serial register
  1150. */
  1151. rt_err_t rt_hw_serial_register(struct rt_serial_device *serial,
  1152. const char *name,
  1153. rt_uint32_t flag,
  1154. void *data)
  1155. {
  1156. rt_err_t ret;
  1157. struct rt_device *device;
  1158. RT_ASSERT(serial != RT_NULL);
  1159. rt_spin_lock_init(&(serial->spinlock));
  1160. device = &(serial->parent);
  1161. device->type = RT_Device_Class_Char;
  1162. device->rx_indicate = RT_NULL;
  1163. device->tx_complete = RT_NULL;
  1164. #ifdef RT_USING_DEVICE_OPS
  1165. device->ops = &serial_ops;
  1166. #else
  1167. device->init = rt_serial_init;
  1168. device->open = rt_serial_open;
  1169. device->close = rt_serial_close;
  1170. device->read = rt_serial_read;
  1171. device->write = rt_serial_write;
  1172. device->control = rt_serial_control;
  1173. #endif
  1174. device->user_data = data;
  1175. /* register a character device */
  1176. ret = rt_device_register(device, name, flag);
  1177. #ifdef RT_USING_POSIX_STDIO
  1178. /* set fops */
  1179. device->fops = &_serial_fops;
  1180. #endif
  1181. #if defined(RT_USING_SMART)
  1182. rt_hw_serial_register_tty(serial);
  1183. #endif
  1184. return ret;
  1185. }
  1186. /* ISR for serial interrupt */
  1187. void rt_hw_serial_isr(struct rt_serial_device *serial, int event)
  1188. {
  1189. switch (event & 0xff)
  1190. {
  1191. case RT_SERIAL_EVENT_RX_IND:
  1192. {
  1193. int ch = -1;
  1194. rt_base_t level;
  1195. struct rt_serial_rx_fifo* rx_fifo;
  1196. /* interrupt mode receive */
  1197. rx_fifo = (struct rt_serial_rx_fifo*)serial->serial_rx;
  1198. RT_ASSERT(rx_fifo != RT_NULL);
  1199. while (1)
  1200. {
  1201. ch = serial->ops->getc(serial);
  1202. if (ch == -1) break;
  1203. /* disable interrupt */
  1204. #ifdef RT_USING_SERIAL_BYPASS
  1205. if (serial->bypass && serial->bypass->upper_h && (serial->bypass->upper_h->head.next != &serial->bypass->upper_h->head))
  1206. {
  1207. rt_bool_t skip = RT_FALSE;
  1208. char buf = (char)ch;
  1209. int ret;
  1210. rt_list_t* node = serial->bypass->upper_h->head.next;
  1211. do {
  1212. struct rt_serial_bypass_func* bypass_run = rt_container_of(node, struct rt_serial_bypass_func, node);
  1213. ret = bypass_run->bypass(serial, buf, bypass_run->data);
  1214. if (!ret)
  1215. {
  1216. skip = RT_TRUE;
  1217. break;
  1218. }
  1219. node = node->next;
  1220. } while (node != &serial->bypass->upper_h->head);
  1221. if (skip)
  1222. continue;
  1223. }
  1224. #endif
  1225. level = rt_spin_lock_irqsave(&(serial->spinlock));
  1226. rx_fifo->buffer[rx_fifo->put_index] = ch;
  1227. rx_fifo->put_index += 1;
  1228. if (rx_fifo->put_index >= serial->config.bufsz) rx_fifo->put_index = 0;
  1229. /* if the next position is read index, discard this 'read char' */
  1230. if (rx_fifo->put_index == rx_fifo->get_index)
  1231. {
  1232. rx_fifo->get_index += 1;
  1233. rx_fifo->is_full = RT_TRUE;
  1234. if (rx_fifo->get_index >= serial->config.bufsz) rx_fifo->get_index = 0;
  1235. _serial_check_buffer_size();
  1236. }
  1237. /* enable interrupt */
  1238. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  1239. }
  1240. #ifdef RT_USING_SERIAL_BYPASS
  1241. if (serial->bypass && serial->bypass->lower_h)
  1242. rt_workqueue_dowork(serial->bypass->lower_workq, &serial->bypass->work);
  1243. #endif
  1244. if (serial->parent.rx_indicate != RT_NULL)
  1245. {
  1246. rt_size_t rx_length;
  1247. /* get rx length */
  1248. level = rt_spin_lock_irqsave(&(serial->spinlock));
  1249. rx_length = (rx_fifo->put_index >= rx_fifo->get_index)? (rx_fifo->put_index - rx_fifo->get_index):
  1250. (serial->config.bufsz - (rx_fifo->get_index - rx_fifo->put_index));
  1251. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  1252. if (rx_length)
  1253. {
  1254. serial->parent.rx_indicate(&serial->parent, rx_length);
  1255. }
  1256. }
  1257. break;
  1258. }
  1259. case RT_SERIAL_EVENT_TX_DONE:
  1260. {
  1261. struct rt_serial_tx_fifo* tx_fifo;
  1262. tx_fifo = (struct rt_serial_tx_fifo*)serial->serial_tx;
  1263. rt_completion_done(&(tx_fifo->completion));
  1264. break;
  1265. }
  1266. #ifdef RT_SERIAL_USING_DMA
  1267. case RT_SERIAL_EVENT_TX_DMADONE:
  1268. {
  1269. const void *data_ptr;
  1270. rt_size_t data_size;
  1271. const void *last_data_ptr;
  1272. struct rt_serial_tx_dma *tx_dma;
  1273. tx_dma = (struct rt_serial_tx_dma*) serial->serial_tx;
  1274. rt_data_queue_pop(&(tx_dma->data_queue), &last_data_ptr, &data_size, 0);
  1275. if (rt_data_queue_peek(&(tx_dma->data_queue), &data_ptr, &data_size) == RT_EOK)
  1276. {
  1277. /* transmit next data node */
  1278. tx_dma->activated = RT_TRUE;
  1279. serial->ops->dma_transmit(serial, (rt_uint8_t *)data_ptr, data_size, RT_SERIAL_DMA_TX);
  1280. }
  1281. else
  1282. {
  1283. tx_dma->activated = RT_FALSE;
  1284. }
  1285. /* invoke callback */
  1286. if (serial->parent.tx_complete != RT_NULL)
  1287. {
  1288. serial->parent.tx_complete(&serial->parent, (void*)last_data_ptr);
  1289. }
  1290. break;
  1291. }
  1292. case RT_SERIAL_EVENT_RX_DMADONE:
  1293. {
  1294. int length;
  1295. rt_base_t level;
  1296. /* get DMA rx length */
  1297. length = (event & (~0xff)) >> 8;
  1298. if (serial->config.bufsz == 0)
  1299. {
  1300. struct rt_serial_rx_dma* rx_dma;
  1301. rx_dma = (struct rt_serial_rx_dma*) serial->serial_rx;
  1302. RT_ASSERT(rx_dma != RT_NULL);
  1303. RT_ASSERT(serial->parent.rx_indicate != RT_NULL);
  1304. serial->parent.rx_indicate(&(serial->parent), length);
  1305. rx_dma->activated = RT_FALSE;
  1306. }
  1307. else
  1308. {
  1309. /* disable interrupt */
  1310. level = rt_spin_lock_irqsave(&(serial->spinlock));
  1311. /* update fifo put index */
  1312. rt_dma_recv_update_put_index(serial, length);
  1313. /* calculate received total length */
  1314. length = rt_dma_calc_recved_len(serial);
  1315. /* enable interrupt */
  1316. rt_spin_unlock_irqrestore(&(serial->spinlock), level);
  1317. /* invoke callback */
  1318. if (serial->parent.rx_indicate != RT_NULL)
  1319. {
  1320. serial->parent.rx_indicate(&(serial->parent), length);
  1321. }
  1322. }
  1323. break;
  1324. }
  1325. #endif /* RT_SERIAL_USING_DMA */
  1326. }
  1327. }