Move most platform-specific code into overlay directories

[libs/core.git] / source / io / unix / serial.cpp

diff --git a/source/io/unix/serial.cpp b/source/io/unix/serial.cpp
new file mode 100644 (file)
index 0000000..49d9e9c
--- /dev/null
+++ b/source/io/unix/serial.cpp
@@ -0,0 +1,121 @@
+#include <fcntl.h>
+#include <termios.h>
+#include <msp/core/systemerror.h>
+#include <msp/strings/format.h>
+#include "handle_private.h"
+#include "serial.h"
+#include "serial_private.h"
+
+using namespace std;
+
+namespace Msp {
+namespace IO {
+
+void Serial::platform_init(const string &port)
+{
+       string fn = port;
+       if(fn.compare(0, 5, "/dev/"))
+               fn = "/dev/"+fn;
+
+       *handle = open(fn.c_str(), O_RDWR);
+       if(!handle)
+               throw system_error(format("open(%s)", port));
+       mode = M_READ|M_WRITE;
+
+       termios t;
+       tcgetattr(*handle, &t);
+       t.c_iflag &= ~(ISTRIP|INLCR|IGNCR|ICRNL|IXON);
+       t.c_lflag &= ~(ECHO|ICANON|ISIG|IEXTEN);
+       t.c_oflag &= ~(OPOST|OCRNL|ONOCR|ONLRET);
+       t.c_cc[VMIN] = 1;
+       t.c_cc[VTIME] = 0;
+       tcsetattr(*handle, TCSADRAIN, &t);
+}
+
+
+void Serial::DeviceState::get_from(const Handle &handle)
+{
+       tcgetattr(*handle, &state);
+}
+
+void Serial::DeviceState::apply_to(const Handle &handle)
+{
+       if(tcsetattr(*handle, TCSADRAIN, &state)==-1)
+               throw system_error("tcsetattr");
+}
+
+void Serial::DeviceState::set_baud_rate(unsigned baud)
+{
+       speed_t speed;
+       switch(baud)
+       {
+       case 0:      speed = B0; break;
+       case 50:     speed = B50; break;
+       case 75:     speed = B75; break;
+       case 110:    speed = B110; break;
+       case 134:    speed = B134; break;
+       case 150:    speed = B150; break;
+       case 200:    speed = B200; break;
+       case 300:    speed = B300; break;
+       case 600:    speed = B600; break;
+       case 1200:   speed = B1200; break;
+       case 1800:   speed = B1800; break;
+       case 2400:   speed = B2400; break;
+       case 4800:   speed = B4800; break;
+       case 9600:   speed = B9600; break;
+       case 19200:  speed = B19200; break;
+       case 38400:  speed = B38400; break;
+       case 57600:  speed = B57600; break;
+       case 115200: speed = B115200; break;
+       case 230400: speed = B230400; break;
+       default: throw invalid_argument("set_baud_rate");
+       }
+
+       cfsetospeed(&state, speed);
+       cfsetispeed(&state, speed);
+}
+
+void Serial::DeviceState::set_data_bits(unsigned bits)
+{
+       tcflag_t flag;
+       switch(bits)
+       {
+       case 5: flag = CS5; break;
+       case 6: flag = CS6; break;
+       case 7: flag = CS7; break;
+       case 8: flag = CS8; break;
+       default: throw invalid_argument("set_data_bits");
+       }
+
+       state.c_cflag = (state.c_cflag&~CSIZE)|flag;
+}
+
+void Serial::DeviceState::set_parity(Serial::Parity par)
+{
+       tcflag_t flag;
+       switch(par)
+       {
+       case Serial::NONE: flag = 0; break;
+       case Serial::EVEN: flag = PARENB; break;
+       case Serial::ODD:  flag = PARENB|PARODD; break;
+       default: throw invalid_argument("set_parity");
+       }
+
+       state.c_cflag = (state.c_cflag&~(PARENB|PARODD))|flag;
+}
+
+void Serial::DeviceState::set_stop_bits(unsigned bits)
+{
+       tcflag_t flag;
+       switch(bits)
+       {
+       case 1: flag = 0; break;
+       case 2: flag = CSTOPB; break;
+       default: throw invalid_argument("set_stop_bits");
+       }
+
+       state.c_cflag = (state.c_cflag&~CSTOPB)|flag;
+}
+
+} // namespace IO
+} // namespace MSp