90 :
public goby::middleware::io::detail::SerialThread<line_in_group, line_out_group,
91 publish_layer, subscribe_layer, ThreadType,
95 goby::middleware::io::detail::SerialThread<line_in_group, line_out_group, publish_layer,
96 subscribe_layer, ThreadType, use_indexed_groups>;
107 void async_read()
override
109 buffer_write_ptr_ = buffer_.data();
113 void read_first_byte()
115 boost::asio::async_read(
116 this->mutable_serial_port(),
117 boost::asio::buffer(buffer_write_ptr_,
118 buffer_.size() - (buffer_write_ptr_ - buffer_.data())),
119 boost::asio::transfer_exactly(1),
120 [
this](
const boost::system::error_code& ec, std::size_t bytes_transferred) {
121 if (!ec && bytes_transferred > 0)
123 if (buffer_[0] != SERIAL_MAGIC[0])
125 goby::glog.is_warn() &&
126 goby::glog <<
"Invalid first byte, expected: " << SERIAL_MAGIC[0]
127 <<
", received: " << buffer_[0] << std::endl;
132 buffer_write_ptr_ += bytes_transferred;
138 this->handle_read_error(ec);
145 boost::asio::async_read(
146 this->mutable_serial_port(),
147 boost::asio::buffer(buffer_write_ptr_,
148 buffer_.size() - (buffer_write_ptr_ - buffer_.data())),
150 [
this](
const boost::system::error_code& ec, std::size_t bytes_transferred) {
151 if (!ec && bytes_transferred > 0)
153 if (memcmp(buffer_.data(), SERIAL_MAGIC, SERIAL_MAGIC_BYTES) != 0)
155 goby::glog.is_warn() &&
157 <<
"Invalid magic word, expected: " << SERIAL_MAGIC
159 << std::string(buffer_.data(), buffer_.data() + SERIAL_MAGIC_BYTES)
165 buffer_write_ptr_ += bytes_transferred;
171 this->handle_read_error(ec);
178 boost::asio::async_read(
179 this->mutable_serial_port(),
180 boost::asio::buffer(buffer_write_ptr_,
181 buffer_.size() - (buffer_write_ptr_ - buffer_.data())),
182 boost::asio::transfer_exactly(SIZE_BYTES),
183 [
this](
const boost::system::error_code& ec, std::size_t bytes_transferred) {
184 if (!ec && bytes_transferred > 0)
187 message_size_ |= buffer_[SERIAL_MAGIC_BYTES];
188 message_size_ <<= BITS_IN_BYTE;
189 message_size_ |= buffer_[SERIAL_MAGIC_BYTES + 1];
190 if (message_size_ > SERIAL_MAX_SIZE)
192 goby::glog.is_warn() &&
194 <<
"Reported message size is larger than SERIAL_MAX_SIZE. Reported:"
195 << message_size_ <<
", expected max: " << SERIAL_MAX_SIZE
202 buffer_write_ptr_ += bytes_transferred;
208 this->handle_read_error(ec);
215 boost::asio::async_read(
216 this->mutable_serial_port(),
217 boost::asio::buffer(buffer_write_ptr_,
218 buffer_.size() - (buffer_write_ptr_ - buffer_.data())),
219 boost::asio::transfer_exactly(CRC_SIZE),
220 [
this](
const boost::system::error_code& ec, std::size_t bytes_transferred) {
221 if (!ec && bytes_transferred > 0)
224 char* ptr = reinterpret_cast<char*>(&crc32_);
227 for (int i = 0; i < 4; i++) { ptr[3 - i] = buffer_write_ptr_[i]; }
229 buffer_write_ptr_ += bytes_transferred;
234 this->handle_read_error(ec);
241 boost::asio::async_read(
242 this->mutable_serial_port(),
243 boost::asio::buffer(buffer_write_ptr_,
244 buffer_.size() - (buffer_write_ptr_ - buffer_.data())),
245 boost::asio::transfer_exactly(message_size_),
246 [
this](
const boost::system::error_code& ec, std::size_t bytes_transferred) {
247 if (!ec && bytes_transferred > 0)
249 auto actual_crc32 = calculate_crc32(buffer_write_ptr_, bytes_transferred);
251 if (crc32_ != actual_crc32)
253 goby::glog.is_warn() &&
254 goby::glog <<
"message_size_: " << message_size_
255 <<
", bytes_transferred: " << bytes_transferred
256 <<
", expected crc32: " << crc32_
257 <<
", actual_crc32: " << actual_crc32 << std::endl;
259 goby::glog.is_warn() && goby::glog <<
"CRC32 failure. Expected: " << crc32_
260 <<
", actual: " << actual_crc32
266 buffer_write_ptr_ += bytes_transferred;
268 auto io_msg = std::make_shared<goby::middleware::protobuf::IOData>();
269 io_msg->set_data(std::string(buffer_.data(), buffer_write_ptr_));
270 this->handle_read_success(buffer_write_ptr_ - buffer_.data(), io_msg);
275 this->handle_read_error(ec);
281 std::array<char, SERIAL_MAX_SIZE> buffer_;
282 char* buffer_write_ptr_{buffer_.data()};
283 std::uint16_t message_size_{0};
284 std::uint32_t crc32_{0};