serial.c 44 KB

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