Stefan Schuermans commited on 2011-12-11 20:22:55
Showing 2 changed files, with 176 additions and 0 deletions.
| ... | ... |
@@ -0,0 +1,117 @@ |
| 1 |
+/* Blinker |
|
| 2 |
+ Copyright 2011 Stefan Schuermans <stefan@blinkenarea.org> |
|
| 3 |
+ Copyleft GNU public license - http://www.gnu.org/copyleft/gpl.html |
|
| 4 |
+ a blinkenarea.org project */ |
|
| 5 |
+ |
|
| 6 |
+#include <fcntl.h> |
|
| 7 |
+#include <sys/stat.h> |
|
| 8 |
+#include <sys/types.h> |
|
| 9 |
+#include <string> |
|
| 10 |
+#include <strings.h> |
|
| 11 |
+#include <termios.h> |
|
| 12 |
+#include <unistd.h> |
|
| 13 |
+ |
|
| 14 |
+#include "Device.h" |
|
| 15 |
+#include "Io.h" |
|
| 16 |
+#include "SerCfg.h" |
|
| 17 |
+ |
|
| 18 |
+namespace Blinker {
|
|
| 19 |
+ |
|
| 20 |
+/** |
|
| 21 |
+ * @brief constructor |
|
| 22 |
+ * @param[in] path path to device |
|
| 23 |
+ */ |
|
| 24 |
+Device::Device(const std::string &path) |
|
| 25 |
+{
|
|
| 26 |
+ // open device |
|
| 27 |
+ m_fd = open(path.c_str(), O_CLOEXEC | O_NOCTTY | O_NONBLOCK); |
|
| 28 |
+} |
|
| 29 |
+ |
|
| 30 |
+/// destructor |
|
| 31 |
+Device::~Device() |
|
| 32 |
+{
|
|
| 33 |
+ // exit if not initialized |
|
| 34 |
+ if (m_fd == -1) |
|
| 35 |
+ return; |
|
| 36 |
+ |
|
| 37 |
+ // close device |
|
| 38 |
+ close(m_fd); |
|
| 39 |
+} |
|
| 40 |
+ |
|
| 41 |
+/** |
|
| 42 |
+ * @brief set serial port configuration |
|
| 43 |
+ * @param[in] serCfg serial port configuration |
|
| 44 |
+ * @return if configuration succeeded |
|
| 45 |
+ * |
|
| 46 |
+ * This function should only be used if device is a serial port. |
|
| 47 |
+ */ |
|
| 48 |
+bool Device::setSerCfg(const SerCfg& serCfg) |
|
| 49 |
+{
|
|
| 50 |
+ struct termios tio; |
|
| 51 |
+ |
|
| 52 |
+ // exit if not initialized |
|
| 53 |
+ if (m_fd == -1) |
|
| 54 |
+ return false; |
|
| 55 |
+ |
|
| 56 |
+ // set up serial port configuration structure |
|
| 57 |
+ bzero(&tio, sizeof(tio)); |
|
| 58 |
+ tio.c_cflag = CLOCAL | HUPCL | CREAD; |
|
| 59 |
+ tio.c_iflag = IGNBRK | IGNPAR; |
|
| 60 |
+ tio.c_oflag = 0; |
|
| 61 |
+ tio.c_lflag = 0; |
|
| 62 |
+ tio.c_cc[VTIME] = 1; // 0.1 sec timeout |
|
| 63 |
+ tio.c_cc[VMIN] = 0; // return on single char read |
|
| 64 |
+ switch (serCfg.m_baud) {
|
|
| 65 |
+ case 300: tio.c_cflag |= B300; break; |
|
| 66 |
+ case 600: tio.c_cflag |= B600; break; |
|
| 67 |
+ case 1200: tio.c_cflag |= B1200; break; |
|
| 68 |
+ case 2400: tio.c_cflag |= B2400; break; |
|
| 69 |
+ case 4800: tio.c_cflag |= B4800; break; |
|
| 70 |
+ case 9600: tio.c_cflag |= B9600; break; |
|
| 71 |
+ case 19200: tio.c_cflag |= B19200; break; |
|
| 72 |
+ case 38400: tio.c_cflag |= B38400; break; |
|
| 73 |
+ case 57600: tio.c_cflag |= B57600; break; |
|
| 74 |
+ case 115200: tio.c_cflag |= B115200; break; |
|
| 75 |
+ default: return false; // invalid setting |
|
| 76 |
+ } |
|
| 77 |
+ switch (serCfg.m_data) {
|
|
| 78 |
+ case 5: tio.c_cflag |= CS5; break; |
|
| 79 |
+ case 6: tio.c_cflag |= CS6; break; |
|
| 80 |
+ case 7: tio.c_cflag |= CS7; break; |
|
| 81 |
+ case 8: tio.c_cflag |= CS8; break; |
|
| 82 |
+ default: return false; // invalid setting |
|
| 83 |
+ } |
|
| 84 |
+ switch (serCfg.m_parity) {
|
|
| 85 |
+ case SerCfg::ParityNone: break; |
|
| 86 |
+ case SerCfg::ParityEven: tio.c_cflag |= PARENB; break; |
|
| 87 |
+ case SerCfg::ParityOdd: tio.c_cflag |= PARENB | PARODD; break; |
|
| 88 |
+ default: return false; // invalid setting |
|
| 89 |
+ } |
|
| 90 |
+ switch (serCfg.m_stop) {
|
|
| 91 |
+ case 1: break; |
|
| 92 |
+ case 2: tio.c_cflag |= CSTOPB; break; |
|
| 93 |
+ default: return false; // invalid setting |
|
| 94 |
+ } |
|
| 95 |
+ |
|
| 96 |
+ // configure serial port |
|
| 97 |
+ return tcsetattr(m_fd, TCSANOW, &tio) != -1; |
|
| 98 |
+} |
|
| 99 |
+ |
|
| 100 |
+/** |
|
| 101 |
+ * @brief write data to device |
|
| 102 |
+ * @param[in] data data to write |
|
| 103 |
+ * @return if the data could be written |
|
| 104 |
+ */ |
|
| 105 |
+bool Device::write(const std::string &data) |
|
| 106 |
+{
|
|
| 107 |
+ // exit if not initialized |
|
| 108 |
+ if (m_fd == -1) |
|
| 109 |
+ return false; |
|
| 110 |
+ |
|
| 111 |
+ // write data |
|
| 112 |
+ return ::write(m_fd, data.c_str(), data.size()) == (ssize_t)data.size(); |
|
| 113 |
+} |
|
| 114 |
+ |
|
| 115 |
+} // namespace Blinker |
|
| 116 |
+ |
|
| 117 |
+ |
| ... | ... |
@@ -0,0 +1,59 @@ |
| 1 |
+/* Blinker |
|
| 2 |
+ Copyright 2011 Stefan Schuermans <stefan@blinkenarea.org> |
|
| 3 |
+ Copyleft GNU public license - http://www.gnu.org/copyleft/gpl.html |
|
| 4 |
+ a blinkenarea.org project */ |
|
| 5 |
+ |
|
| 6 |
+#ifndef DEVICE_H |
|
| 7 |
+#define DEVICE_H |
|
| 8 |
+ |
|
| 9 |
+#include <string> |
|
| 10 |
+ |
|
| 11 |
+#include "Io.h" |
|
| 12 |
+#include "SerCfg.h" |
|
| 13 |
+ |
|
| 14 |
+namespace Blinker {
|
|
| 15 |
+ |
|
| 16 |
+/// a character device |
|
| 17 |
+class Device: public Io |
|
| 18 |
+{
|
|
| 19 |
+public: |
|
| 20 |
+ /** |
|
| 21 |
+ * @brief constructor |
|
| 22 |
+ * @param[in] path path to device |
|
| 23 |
+ */ |
|
| 24 |
+ Device(const std::string &path); |
|
| 25 |
+ |
|
| 26 |
+ /// destructor |
|
| 27 |
+ ~Device(); |
|
| 28 |
+ |
|
| 29 |
+private: |
|
| 30 |
+ /// copy constructor disabled |
|
| 31 |
+ Device(const Device &that); |
|
| 32 |
+ |
|
| 33 |
+ /// assignment operator disabled |
|
| 34 |
+ const Device & operator=(const Device &that); |
|
| 35 |
+ |
|
| 36 |
+public: |
|
| 37 |
+ /** |
|
| 38 |
+ * @brief set serial port configuration |
|
| 39 |
+ * @param[in] serCfg serial port configuration |
|
| 40 |
+ * @return if configuration succeeded |
|
| 41 |
+ * |
|
| 42 |
+ * This function should only be used if device is a serial port. |
|
| 43 |
+ */ |
|
| 44 |
+ bool setSerCfg(const SerCfg& serCfg); |
|
| 45 |
+ |
|
| 46 |
+ /** |
|
| 47 |
+ * @brief write data to device |
|
| 48 |
+ * @param[in] data data to write |
|
| 49 |
+ * @return if the data could be written |
|
| 50 |
+ */ |
|
| 51 |
+ bool write(const std::string &data); |
|
| 52 |
+ |
|
| 53 |
+}; // class Device |
|
| 54 |
+ |
|
| 55 |
+} // namespace Blinker |
|
| 56 |
+ |
|
| 57 |
+#endif // #ifndef DEVICE_H |
|
| 58 |
+ |
|
| 59 |
+ |
|
| 0 | 60 |