169 lines
		
	
	
		
			4.3 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
		
		
			
		
	
	
			169 lines
		
	
	
		
			4.3 KiB
		
	
	
	
		
			Plaintext
		
	
	
	
|  | // | ||
|  | // detail/impl/posix_serial_port_service.ipp | ||
|  | // ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | ||
|  | // | ||
|  | // Copyright (c) 2003-2023 Christopher M. Kohlhoff (chris at kohlhoff dot com) | ||
|  | // Copyright (c) 2008 Rep Invariant Systems, Inc. (info@repinvariant.com) | ||
|  | // | ||
|  | // Distributed under the Boost Software License, Version 1.0. (See accompanying | ||
|  | // file LICENSE_1_0.txt or copy at http://www.boost.org/LICENSE_1_0.txt) | ||
|  | // | ||
|  | 
 | ||
|  | #ifndef ASIO_DETAIL_IMPL_POSIX_SERIAL_PORT_SERVICE_IPP | ||
|  | #define ASIO_DETAIL_IMPL_POSIX_SERIAL_PORT_SERVICE_IPP | ||
|  | 
 | ||
|  | #if defined(_MSC_VER) && (_MSC_VER >= 1200) | ||
|  | # pragma once | ||
|  | #endif // defined(_MSC_VER) && (_MSC_VER >= 1200) | ||
|  | 
 | ||
|  | #include "asio/detail/config.hpp" | ||
|  | 
 | ||
|  | #if defined(ASIO_HAS_SERIAL_PORT) | ||
|  | #if !defined(ASIO_WINDOWS) && !defined(__CYGWIN__) | ||
|  | 
 | ||
|  | #include <cstring> | ||
|  | #include "asio/detail/posix_serial_port_service.hpp" | ||
|  | 
 | ||
|  | #include "asio/detail/push_options.hpp" | ||
|  | 
 | ||
|  | namespace asio { | ||
|  | namespace detail { | ||
|  | 
 | ||
|  | posix_serial_port_service::posix_serial_port_service( | ||
|  |     execution_context& context) | ||
|  |   : execution_context_service_base<posix_serial_port_service>(context), | ||
|  |     descriptor_service_(context) | ||
|  | { | ||
|  | } | ||
|  | 
 | ||
|  | void posix_serial_port_service::shutdown() | ||
|  | { | ||
|  |   descriptor_service_.shutdown(); | ||
|  | } | ||
|  | 
 | ||
|  | asio::error_code posix_serial_port_service::open( | ||
|  |     posix_serial_port_service::implementation_type& impl, | ||
|  |     const std::string& device, asio::error_code& ec) | ||
|  | { | ||
|  |   if (is_open(impl)) | ||
|  |   { | ||
|  |     ec = asio::error::already_open; | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   descriptor_ops::state_type state = 0; | ||
|  |   int fd = descriptor_ops::open(device.c_str(), | ||
|  |       O_RDWR | O_NONBLOCK | O_NOCTTY, ec); | ||
|  |   if (fd < 0) | ||
|  |   { | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   int s = descriptor_ops::fcntl(fd, F_GETFL, ec); | ||
|  |   if (s >= 0) | ||
|  |     s = descriptor_ops::fcntl(fd, F_SETFL, s | O_NONBLOCK, ec); | ||
|  |   if (s < 0) | ||
|  |   { | ||
|  |     asio::error_code ignored_ec; | ||
|  |     descriptor_ops::close(fd, state, ignored_ec); | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   // Set up default serial port options. | ||
|  |   termios ios; | ||
|  |   s = ::tcgetattr(fd, &ios); | ||
|  |   descriptor_ops::get_last_error(ec, s < 0); | ||
|  |   if (s >= 0) | ||
|  |   { | ||
|  | #if defined(_BSD_SOURCE) || defined(_DEFAULT_SOURCE) | ||
|  |     ::cfmakeraw(&ios); | ||
|  | #else | ||
|  |     ios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ||
|  |         | ISTRIP | INLCR | IGNCR | ICRNL | IXON); | ||
|  |     ios.c_oflag &= ~OPOST; | ||
|  |     ios.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN); | ||
|  |     ios.c_cflag &= ~(CSIZE | PARENB); | ||
|  |     ios.c_cflag |= CS8; | ||
|  | #endif | ||
|  |     ios.c_iflag |= IGNPAR; | ||
|  |     ios.c_cflag |= CREAD | CLOCAL; | ||
|  |     s = ::tcsetattr(fd, TCSANOW, &ios); | ||
|  |     descriptor_ops::get_last_error(ec, s < 0); | ||
|  |   } | ||
|  |   if (s < 0) | ||
|  |   { | ||
|  |     asio::error_code ignored_ec; | ||
|  |     descriptor_ops::close(fd, state, ignored_ec); | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   // We're done. Take ownership of the serial port descriptor. | ||
|  |   if (descriptor_service_.assign(impl, fd, ec)) | ||
|  |   { | ||
|  |     asio::error_code ignored_ec; | ||
|  |     descriptor_ops::close(fd, state, ignored_ec); | ||
|  |   } | ||
|  | 
 | ||
|  |   ASIO_ERROR_LOCATION(ec); | ||
|  |   return ec; | ||
|  | } | ||
|  | 
 | ||
|  | asio::error_code posix_serial_port_service::do_set_option( | ||
|  |     posix_serial_port_service::implementation_type& impl, | ||
|  |     posix_serial_port_service::store_function_type store, | ||
|  |     const void* option, asio::error_code& ec) | ||
|  | { | ||
|  |   termios ios; | ||
|  |   int s = ::tcgetattr(descriptor_service_.native_handle(impl), &ios); | ||
|  |   descriptor_ops::get_last_error(ec, s < 0); | ||
|  |   if (s < 0) | ||
|  |   { | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   if (store(option, ios, ec)) | ||
|  |   { | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   s = ::tcsetattr(descriptor_service_.native_handle(impl), TCSANOW, &ios); | ||
|  |   descriptor_ops::get_last_error(ec, s < 0); | ||
|  |   ASIO_ERROR_LOCATION(ec); | ||
|  |   return ec; | ||
|  | } | ||
|  | 
 | ||
|  | asio::error_code posix_serial_port_service::do_get_option( | ||
|  |     const posix_serial_port_service::implementation_type& impl, | ||
|  |     posix_serial_port_service::load_function_type load, | ||
|  |     void* option, asio::error_code& ec) const | ||
|  | { | ||
|  |   termios ios; | ||
|  |   int s = ::tcgetattr(descriptor_service_.native_handle(impl), &ios); | ||
|  |   descriptor_ops::get_last_error(ec, s < 0); | ||
|  |   if (s < 0) | ||
|  |   { | ||
|  |     ASIO_ERROR_LOCATION(ec); | ||
|  |     return ec; | ||
|  |   } | ||
|  | 
 | ||
|  |   load(option, ios, ec); | ||
|  |   ASIO_ERROR_LOCATION(ec); | ||
|  |   return ec; | ||
|  | } | ||
|  | 
 | ||
|  | } // namespace detail | ||
|  | } // namespace asio | ||
|  | 
 | ||
|  | #include "asio/detail/pop_options.hpp" | ||
|  | 
 | ||
|  | #endif // !defined(ASIO_WINDOWS) && !defined(__CYGWIN__) | ||
|  | #endif // defined(ASIO_HAS_SERIAL_PORT) | ||
|  | 
 | ||
|  | #endif // ASIO_DETAIL_IMPL_POSIX_SERIAL_PORT_SERVICE_IPP |