Nelze vybrat více než 25 témat Téma musí začínat písmenem nebo číslem, může obsahovat pomlčky („-“) a může být dlouhé až 35 znaků.
 
 
 
 
 

214 řádky
5.1 KiB

  1. /*
  2. * wiringSerial.c:
  3. * Handle a serial port
  4. ***********************************************************************
  5. * This file is part of wiringPi:
  6. * https://projects.drogon.net/raspberry-pi/wiringpi/
  7. *
  8. * wiringPi is free software: you can redistribute it and/or modify
  9. * it under the terms of the GNU Lesser General Public License as published by
  10. * the Free Software Foundation, either version 3 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * wiringPi is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU Lesser General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU Lesser General Public License
  19. * along with wiringPi. If not, see <http://www.gnu.org/licenses/>.
  20. ***********************************************************************
  21. */
  22. #include <stdio.h>
  23. #include <stdlib.h>
  24. #include <stdint.h>
  25. #include <stdarg.h>
  26. #include <string.h>
  27. #include <termios.h>
  28. #include <unistd.h>
  29. #include <fcntl.h>
  30. #include <sys/ioctl.h>
  31. #include <sys/types.h>
  32. #include <sys/stat.h>
  33. #include "wiringSerial.h"
  34. /*
  35. * serialOpen:
  36. * Open and initialise the serial port, setting all the right
  37. * port parameters - or as many as are required - hopefully!
  38. *********************************************************************************
  39. */
  40. int serialOpen (const char *device, const int baud)
  41. {
  42. struct termios options ;
  43. speed_t myBaud ;
  44. int status, fd ;
  45. switch (baud)
  46. {
  47. case 50: myBaud = B50 ; break ;
  48. case 75: myBaud = B75 ; break ;
  49. case 110: myBaud = B110 ; break ;
  50. case 134: myBaud = B134 ; break ;
  51. case 150: myBaud = B150 ; break ;
  52. case 200: myBaud = B200 ; break ;
  53. case 300: myBaud = B300 ; break ;
  54. case 600: myBaud = B600 ; break ;
  55. case 1200: myBaud = B1200 ; break ;
  56. case 1800: myBaud = B1800 ; break ;
  57. case 2400: myBaud = B2400 ; break ;
  58. case 4800: myBaud = B4800 ; break ;
  59. case 9600: myBaud = B9600 ; break ;
  60. case 19200: myBaud = B19200 ; break ;
  61. case 38400: myBaud = B38400 ; break ;
  62. case 57600: myBaud = B57600 ; break ;
  63. case 115200: myBaud = B115200 ; break ;
  64. case 230400: myBaud = B230400 ; break ;
  65. default:
  66. return -2 ;
  67. }
  68. if ((fd = open (device, O_RDWR | O_NOCTTY | O_NDELAY | O_NONBLOCK)) == -1)
  69. return -1 ;
  70. fcntl (fd, F_SETFL, O_RDWR) ;
  71. // Get and modify current options:
  72. tcgetattr (fd, &options) ;
  73. cfmakeraw (&options) ;
  74. cfsetispeed (&options, myBaud) ;
  75. cfsetospeed (&options, myBaud) ;
  76. options.c_cflag |= (CLOCAL | CREAD) ;
  77. options.c_cflag &= ~PARENB ;
  78. options.c_cflag &= ~CSTOPB ;
  79. options.c_cflag &= ~CSIZE ;
  80. options.c_cflag |= CS8 ;
  81. options.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG) ;
  82. options.c_oflag &= ~OPOST ;
  83. options.c_cc [VMIN] = 0 ;
  84. options.c_cc [VTIME] = 100 ; // Ten seconds (100 deciseconds)
  85. tcsetattr (fd, TCSANOW | TCSAFLUSH, &options) ;
  86. ioctl (fd, TIOCMGET, &status);
  87. status |= TIOCM_DTR ;
  88. status |= TIOCM_RTS ;
  89. ioctl (fd, TIOCMSET, &status);
  90. usleep (10000) ; // 10mS
  91. return fd ;
  92. }
  93. /*
  94. * serialFlush:
  95. * Flush the serial buffers (both tx & rx)
  96. *********************************************************************************
  97. */
  98. void serialFlush (const int fd)
  99. {
  100. tcflush (fd, TCIOFLUSH) ;
  101. }
  102. /*
  103. * serialClose:
  104. * Release the serial port
  105. *********************************************************************************
  106. */
  107. void serialClose (const int fd)
  108. {
  109. close (fd) ;
  110. }
  111. /*
  112. * serialPutchar:
  113. * Send a single character to the serial port
  114. *********************************************************************************
  115. */
  116. void serialPutchar (const int fd, const unsigned char c)
  117. {
  118. write (fd, &c, 1) ;
  119. }
  120. /*
  121. * serialPuts:
  122. * Send a string to the serial port
  123. *********************************************************************************
  124. */
  125. void serialPuts (const int fd, const char *s)
  126. {
  127. write (fd, s, strlen (s)) ;
  128. }
  129. /*
  130. * serialPrintf:
  131. * Printf over Serial
  132. *********************************************************************************
  133. */
  134. void serialPrintf (const int fd, const char *message, ...)
  135. {
  136. va_list argp ;
  137. char buffer [1024] ;
  138. va_start (argp, message) ;
  139. vsnprintf (buffer, 1023, message, argp) ;
  140. va_end (argp) ;
  141. serialPuts (fd, buffer) ;
  142. }
  143. /*
  144. * serialDataAvail:
  145. * Return the number of bytes of data avalable to be read in the serial port
  146. *********************************************************************************
  147. */
  148. int serialDataAvail (const int fd)
  149. {
  150. int result ;
  151. if (ioctl (fd, FIONREAD, &result) == -1)
  152. return -1 ;
  153. return result ;
  154. }
  155. /*
  156. * serialGetchar:
  157. * Get a single character from the serial device.
  158. * Note: Zero is a valid character and this function will time-out after
  159. * 10 seconds.
  160. *********************************************************************************
  161. */
  162. int serialGetchar (const int fd)
  163. {
  164. uint8_t x ;
  165. if (read (fd, &x, 1) != 1)
  166. return -1 ;
  167. return ((int)x) & 0xFF ;
  168. }