/*! * \file rtcm.h * \brief Interface for the RTCM 3.2 Standard * \author Carles Fernandez-Prades, 2015. cfernandez(at)cttc.es * * ------------------------------------------------------------------------- * * Copyright (C) 2010-2015 (see AUTHORS file for a list of contributors) * * GNSS-SDR is a software defined Global Navigation * Satellite Systems receiver * * This file is part of GNSS-SDR. * * GNSS-SDR is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * GNSS-SDR is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with GNSS-SDR. If not, see . * * ------------------------------------------------------------------------- */ #ifndef GNSS_SDR_RTCM_H_ #define GNSS_SDR_RTCM_H_ #include #include #include #include #include #include #include #include #include #include #include #include "concurrent_queue.h" #include "gnss_synchro.h" #include "galileo_fnav_message.h" #include "gps_navigation_message.h" #include "gps_cnav_navigation_message.h" #include "glonass_gnav_navigation_message.h" /*! * This class implements the generation and reading of some Message Types * defined in the RTCM 3.2 Standard, plus some utilities to handle messages. * * Generation of the following Message Types: * 1001, 1002, 1003, 1004, 1005, 1006, 1008, 1019, 1020, 1029, 1045 * * Decoding of the following Message Types: * 1019, 1045 * * Generation of the following Multiple Signal Messages: * MSM1 (message types 1071, 1091) * MSM2 (message types 1072, 1092) * MSM3 (message types 1073, 1093) * MSM4 (message types 1074, 1094) * MSM5 (message types 1075, 1095) * MSM6 (message types 1076, 1096) * MSM7 (message types 1077, 1097) * * RTCM 3 message format (size in bits): * +----------+--------+-----------+--------------------+----------+ * | preamble | 000000 | length | data message | parity | * +----------+--------+-----------+--------------------+----------+ * |<-- 8 --->|<- 6 -->|<-- 10 --->|<--- length x 8 --->|<-- 24 -->| * +----------+--------+-----------+--------------------+----------+ * * * (C) Carles Fernandez-Prades, 2015. cfernandez(at)cttc.es */ class Rtcm { public: Rtcm(unsigned short port = 2101); // & observables, unsigned short station_id); /*! * \brief Prints message type 1002 (Extended L1-Only GPS RTK Observables) */ std::string print_MT1002(const Gps_Ephemeris & gps_eph, double obs_time, const std::map & observables, unsigned short station_id); /*! * \brief Prints message type 1003 (L1 & L2 GPS RTK Observables) */ std::string print_MT1003(const Gps_Ephemeris & ephL1, const Gps_CNAV_Ephemeris & ephL2, double obs_time, const std::map & observables, unsigned short station_id); /*! * \brief Prints message type 1004 (Extended L1 & L2 GPS RTK Observables) */ std::string print_MT1004(const Gps_Ephemeris & ephL1, const Gps_CNAV_Ephemeris & ephL2, double obs_time, const std::map & observables, unsigned short station_id); /*! * \brief Prints message type 1005 (Stationary Antenna Reference Point) */ std::string print_MT1005(unsigned int ref_id, double ecef_x, double ecef_y, double ecef_z, bool gps, bool glonass, bool galileo, bool non_physical, bool single_oscillator, unsigned int quarter_cycle_indicator); /*! * \brief Verifies and reads messages of type 1005 (Stationary Antenna Reference Point). Returns 1 if anything goes wrong, 0 otherwise. */ int read_MT1005(const std::string & message, unsigned int & ref_id, double & ecef_x, double & ecef_y, double & ecef_z, bool & gps, bool & glonass, bool & galileo); /*! * \brief Prints message type 1006 (Stationary Antenna Reference Point, with Height Information) */ std::string print_MT1006(unsigned int ref_id, double ecef_x, double ecef_y, double ecef_z, bool gps, bool glonass, bool galileo, bool non_physical, bool single_oscillator, unsigned int quarter_cycle_indicator, double height); std::string print_MT1005_test(); // & observables, unsigned short station_id); /*! * \brief Prints Extended L1-Only GLONASS RTK Observables * \details This GLONASS message type is used when only L1 data is present and bandwidth is very tight, often 1012 is used in such cases. * \note Code added as part of GSoC 2017 program * \params glonass_gnav_eph GLONASS GNAV Broadcast Ephemeris * \params obs_time Time of observation at the moment of printing * \params observables Set of observables as defined by the platform * \return string with message contents */ std::string print_MT1010(const Glonass_Gnav_Ephemeris& glonass_gnav_eph, double obs_time, const std::map & observables, unsigned short station_id); /*! * \brief Prints L1&L2 GLONASS RTK Observables * \details This GLONASS message type is not generally used or supported; type 1012 is to be preferred * \note Code added as part of GSoC 2017 program * \params glonass_gnav_eph GLONASS GNAV Broadcast Ephemeris * \params obs_time Time of observation at the moment of printing * \params observables Set of observables as defined by the platform * \return string with message contents */ std::string print_MT1011(const Glonass_Gnav_Ephemeris& glonass_gnav_ephL1, const Glonass_Gnav_Ephemeris& glonass_gnav_ephL2, double obs_time, const std::map & observables, unsigned short station_id); /*! * \brief Prints Extended L1&L2 GLONASS RTK Observables * \details This GLONASS message type is the most common observational message type, with L1/L2/SNR content. This is one of the most common messages found. * \note Code added as part of GSoC 2017 program * \params glonass_gnav_eph GLONASS GNAV Broadcast Ephemeris * \params obs_time Time of observation at the moment of printing * \params observables Set of observables as defined by the platform * \return string with message contents */ std::string print_MT1012(const Glonass_Gnav_Ephemeris& glonass_gnav_ephL1, const Glonass_Gnav_Ephemeris& glonass_gnav_ephL2, double obs_time, const std::map & observables, unsigned short station_id); /*! * \brief Prints message type 1019 (GPS Ephemeris), should be broadcast in the event that * the IODC does not match the IODE, and every 2 minutes. */ std::string print_MT1019(const Gps_Ephemeris & gps_eph); /*! * \brief Verifies and reads messages of type 1019 (GPS Ephemeris). Returns 1 if anything goes wrong, 0 otherwise. */ int read_MT1019(const std::string & message, Gps_Ephemeris & gps_eph); /*! * \brief Prints message type 1020 (GLONASS Ephemeris). * \note Code added as part of GSoC 2017 program * \param glonass_gnav_eph GLONASS GNAV Broadcast Ephemeris * \param glonass_gnav_utc_model GLONASS GNAV Clock Information * \return Returns message type as a string type */ std::string print_MT1020(const Glonass_Gnav_Ephemeris & glonass_gnav_eph, const Glonass_Gnav_Utc_Model & glonass_gnav_utc_model); /*! * \brief Verifies and reads messages of type 1020 (GLONASS Ephemeris). * \note Code added as part of GSoC 2017 program * \param message Message to read as a string type * \param glonass_gnav_eph GLONASS GNAV Broadcast Ephemeris * \param glonass_gnav_utc_model GLONASS GNAV Clock Information * \return Returns 1 if anything goes wrong, 0 otherwise. */ int read_MT1020(const std::string & message, Glonass_Gnav_Ephemeris & glonass_gnav_eph, Glonass_Gnav_Utc_Model & glonass_gnav_utc_model); /*! * \brief Prints message type 1029 (Unicode Text String) */ std::string print_MT1029(unsigned int ref_id, const Gps_Ephemeris & gps_eph, double obs_time, const std::string & message); /*! * \brief Prints message type 1045 (Galileo Ephemeris), should be broadcast every 2 minutes */ std::string print_MT1045(const Galileo_Ephemeris & gal_eph); /*! * \brief Verifies and reads messages of type 1045 (Galileo Ephemeris). Returns 1 if anything goes wrong, 0 otherwise. */ int read_MT1045(const std::string & message, Galileo_Ephemeris & gal_eph); /*! * \brief Prints messages of type MSM1 (Compact GNSS observables) */ std::string print_MSM_1( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); /*! * \brief Prints messages of type MSM2 (Compact GNSS phaseranges) */ std::string print_MSM_2( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); /*! * \brief Prints messages of type MSM3 (Compact GNSS pseudoranges and phaseranges) */ std::string print_MSM_3( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); /*! * \brief Prints messages of type MSM4 (Full GNSS pseudoranges and phaseranges plus CNR) */ std::string print_MSM_4( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); /*! * \brief Prints messages of type MSM5 (Full GNSS pseudoranges, phaseranges, phaserange rate and CNR) */ std::string print_MSM_5( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); /*! * \brief Prints messages of type MSM6 (Full GNSS pseudoranges and phaseranges plus CNR, high resolution) */ std::string print_MSM_6( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); /*! * \brief Prints messages of type MSM7 (Full GNSS pseudoranges, phaseranges, phaserange rate and CNR, high resolution) */ std::string print_MSM_7( const Gps_Ephemeris & gps_eph, const Gps_CNAV_Ephemeris & gps_cnav_eph, const Galileo_Ephemeris & gal_eph, const Glonass_Gnav_Ephemeris & glo_gnav_eph, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); unsigned int lock_time(const Gps_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); // get_MT1001_4_header(unsigned int msg_number, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int smooth_int, bool sync_flag, bool divergence_free); std::bitset<58> get_MT1001_sat_content(const Gps_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<74> get_MT1002_sat_content(const Gps_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<101> get_MT1003_sat_content(const Gps_Ephemeris & ephL1, const Gps_CNAV_Ephemeris & ephL2, double obs_time, const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::bitset<125> get_MT1004_sat_content(const Gps_Ephemeris & ephL1, const Gps_CNAV_Ephemeris & ephL2, double obs_time, const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::bitset<152> get_MT1005_test(); /*! * \brief Generates contents of message header for types 1009, 1010, 1011 and 1012. GLONASS RTK Message * \note Code added as part of GSoC 2017 program * \param msg_number Message type number, acceptable options include 1009 to 1012 * \param obs_time Time of observation at the moment of printing * \param observables Set of observables as defined by the platform * \param ref_id * \param smooth_int * \param divergence_free * \return Returns the message header content as set of bits */ std::bitset<61> get_MT1009_12_header(unsigned int msg_number, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int smooth_int, bool sync_flag, bool divergence_free); /*! * \brief Get the contents of the satellite specific portion of a type 1009 Message (GLONASS Basic RTK, L1 Only) * \details Contents generated for each satellite. See table 3.5-11 * \note Code added as part of GSoC 2017 program * \param ephGNAV Ephemeris for GLONASS GNAV in L1 satellites * \param obs_time Time of observation at the moment of printing * \param gnss_synchro Information generated by channels while processing the satellite * \return Returns the message content as set of bits */ std::bitset<64> get_MT1009_sat_content(const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const Gnss_Synchro & gnss_synchro); /*! * \brief Get the contents of the satellite specific portion of a type 1010 Message (GLONASS Extended RTK, L1 Only) * \details Contents generated for each satellite. See table 3.5-12 * \note Code added as part of GSoC 2017 program * \param ephGNAV Ephemeris for GLONASS GNAV in L1 satellites * \param obs_time Time of observation at the moment of printing * \param gnss_synchro Information generated by channels while processing the satellite * \return Returns the message content as set of bits */ std::bitset<79> get_MT1010_sat_content(const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const Gnss_Synchro & gnss_synchro); /*! * \brief Get the contents of the satellite specific portion of a type 1011 Message (GLONASS Basic RTK, L1 & L2) * \details Contents generated for each satellite. See table 3.5-13 * \note Code added as part of GSoC 2017 program * \param ephGNAVL1 Ephemeris for GLONASS GNAV in L1 satellites * \param ephGNAVL2 Ephemeris for GLONASS GNAV in L2 satellites * \param obs_time Time of observation at the moment of printing * \param gnss_synchroL1 Information generated by channels while processing the GLONASS GNAV L1 satellite * \param gnss_synchroL2 Information generated by channels while processing the GLONASS GNAV L2 satellite * \return Returns the message content as set of bits */ std::bitset<107> get_MT1011_sat_content(const Glonass_Gnav_Ephemeris & ephGNAVL1, const Glonass_Gnav_Ephemeris & ephGNAVL2, double obs_time, const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); /*! * \brief Get the contents of the satellite specific portion of a type 1012 Message (GLONASS Extended RTK, L1 & L2) * \details Contents generated for each satellite. See table 3.5-14 * \note Code added as part of GSoC 2017 program * \param ephGNAVL1 Ephemeris for GLONASS GNAV in L1 satellites * \param ephGNAVL2 Ephemeris for GLONASS GNAV in L2 satellites * \param obs_time Time of observation at the moment of printing * \param gnss_synchroL1 Information generated by channels while processing the GLONASS GNAV L1 satellite * \param gnss_synchroL2 Information generated by channels while processing the GLONASS GNAV L2 satellite * \return Returns the message content as set of bits */ std::bitset<130> get_MT1012_sat_content(const Glonass_Gnav_Ephemeris & ephGNAVL1, const Glonass_Gnav_Ephemeris & ephGNAVL2, double obs_time, const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::string get_MSM_header(unsigned int msg_number, double obs_time, const std::map & observables, unsigned int ref_id, unsigned int clock_steering_indicator, unsigned int external_clock_indicator, int smooth_int, bool divergence_free, bool more_messages); std::string get_MSM_1_content_sat_data(const std::map & observables); std::string get_MSM_4_content_sat_data(const std::map & observables); std::string get_MSM_5_content_sat_data(const std::map & observables); std::string get_MSM_1_content_signal_data(const std::map & observables); std::string get_MSM_2_content_signal_data(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const std::map & observables); std::string get_MSM_3_content_signal_data(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const std::map & observables); std::string get_MSM_4_content_signal_data(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const std::map & observables); std::string get_MSM_5_content_signal_data(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const std::map & observables); std::string get_MSM_6_content_signal_data(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const std::map & observables); std::string get_MSM_7_content_signal_data(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const std::map & observables); // // Utilities // static std::map galileo_signal_map; static std::map gps_signal_map; std::vector > sort_by_signal(const std::vector > & synchro_map) const; std::vector > sort_by_PRN_mask(const std::vector > & synchro_map) const; boost::posix_time::ptime compute_GPS_time(const Gps_Ephemeris& eph, double obs_time) const; boost::posix_time::ptime compute_GPS_time(const Gps_CNAV_Ephemeris & eph, double obs_time) const; boost::posix_time::ptime compute_Galileo_time(const Galileo_Ephemeris& eph, double obs_time) const; boost::posix_time::ptime compute_GLONASS_time(const Glonass_Gnav_Ephemeris& eph, double obs_time) const; boost::posix_time::ptime gps_L1_last_lock_time[64]; boost::posix_time::ptime gps_L2_last_lock_time[64]; boost::posix_time::ptime gal_E1_last_lock_time[64]; boost::posix_time::ptime gal_E5_last_lock_time[64]; boost::posix_time::ptime glo_L1_last_lock_time[64]; boost::posix_time::ptime glo_L2_last_lock_time[64]; unsigned int lock_time_indicator(unsigned int lock_time_period_s); unsigned int msm_lock_time_indicator(unsigned int lock_time_period_s); unsigned int msm_extended_lock_time_indicator(unsigned int lock_time_period_s); // // Classes for TCP communication // unsigned short RTCM_port; //unsigned short RTCM_Station_ID; class Rtcm_Message { public: enum { header_length = 6 }; enum { max_body_length = 1029 }; Rtcm_Message() : body_length_(0) { } const char* data() const { return data_; } char* data() { return data_; } inline std::size_t length() const { return header_length + body_length_; } const char* body() const { return data_ + header_length; } char* body() { return data_ + header_length; } std::size_t body_length() const { return body_length_; } void body_length(std::size_t new_length) { body_length_ = new_length; if (body_length_ > max_body_length) body_length_ = max_body_length; } inline bool decode_header() { char header[header_length + 1] = ""; std::strncat(header, data_, header_length); if(header[0] != 'G' || header[1] != 'S') { return false; } char header2_[header_length - 1] = ""; std::strncat(header2_, data_ + 2 , header_length - 2); body_length_ = std::atoi(header2_); if(body_length_ == 0) { return false; } if (body_length_ > max_body_length) { body_length_ = 0; return false; } return true; } inline void encode_header() { char header[header_length + 1] = ""; std::sprintf(header, "GS%4d", static_cast(body_length_)); std::memcpy(data_, header, header_length); } private: char data_[header_length + max_body_length]; std::size_t body_length_; }; class Rtcm_Listener { public: virtual ~Rtcm_Listener() {} virtual void deliver(const Rtcm_Message & msg) = 0; }; class Rtcm_Listener_Room { public: inline void join(std::shared_ptr participant) { participants_.insert(participant); for (auto msg: recent_msgs_) participant->deliver(msg); } inline void leave(std::shared_ptr participant) { participants_.erase(participant); } inline void deliver(const Rtcm_Message & msg) { recent_msgs_.push_back(msg); while (recent_msgs_.size() > max_recent_msgs) recent_msgs_.pop_front(); for (auto participant: participants_) participant->deliver(msg); } private: std::set > participants_; enum { max_recent_msgs = 1 }; std::deque recent_msgs_; }; class Rtcm_Session : public Rtcm_Listener, public std::enable_shared_from_this { public: Rtcm_Session(boost::asio::ip::tcp::socket socket, Rtcm_Listener_Room & room) : socket_(std::move(socket)), room_(room) { } inline void start() { room_.join(shared_from_this()); do_read_message_header(); } inline void deliver(const Rtcm_Message & msg) { bool write_in_progress = !write_msgs_.empty(); write_msgs_.push_back(msg); if (!write_in_progress) { do_write(); } } private: inline void do_read_message_header() { auto self(shared_from_this()); boost::asio::async_read(socket_, boost::asio::buffer(read_msg_.data(), Rtcm_Message::header_length), [this, self](boost::system::error_code ec, std::size_t /*length*/) { if (!ec && read_msg_.decode_header()) { do_read_message_body(); } else if(!ec && !read_msg_.decode_header()) { client_says += read_msg_.data(); bool first = true; while(client_says.length() >= 80) { if(first == true) { std::cout << "Client from " << socket_.remote_endpoint().address() << " says "; first = false; } std::cout << client_says.substr(0, 80) << std::endl; client_says = client_says.substr(80, client_says.length() - 80); } do_read_message_header(); } else { std::cout << "Closing connection with client from " << socket_.remote_endpoint().address() << std::endl; room_.leave(shared_from_this()); } }); } inline void do_read_message_body() { auto self(shared_from_this()); boost::asio::async_read(socket_, boost::asio::buffer(read_msg_.body(), read_msg_.body_length()), [this, self](boost::system::error_code ec, std::size_t /*length*/) { if (!ec) { room_.deliver(read_msg_); //std::cout << "Delivered message (session): "; //std::cout.write(read_msg_.body(), read_msg_.body_length()); //std::cout << std::endl; do_read_message_header(); } else { std::cout << "Closing connection with client from " << socket_.remote_endpoint().address() << std::endl; room_.leave(shared_from_this()); } }); } inline void do_write() { auto self(shared_from_this()); boost::asio::async_write(socket_, boost::asio::buffer(write_msgs_.front().body(), write_msgs_.front().body_length()), [this, self](boost::system::error_code ec, std::size_t /*length*/) { if(!ec) { write_msgs_.pop_front(); if(!write_msgs_.empty()) { do_write(); } } else { std::cout << "Closing connection with client from " << socket_.remote_endpoint().address() << std::endl; room_.leave(shared_from_this()); } }); } boost::asio::ip::tcp::socket socket_; Rtcm_Listener_Room & room_; Rtcm_Message read_msg_; std::deque write_msgs_; std::string client_says; }; class Tcp_Internal_Client : public std::enable_shared_from_this { public: Tcp_Internal_Client(boost::asio::io_service& io_service, boost::asio::ip::tcp::resolver::iterator endpoint_iterator) : io_service_(io_service), socket_(io_service) { do_connect(endpoint_iterator); } inline void close() { io_service_.post([this]() { socket_.close(); }); } inline void write(const Rtcm_Message & msg) { io_service_.post( [this, msg]() { bool write_in_progress = !write_msgs_.empty(); write_msgs_.push_back(msg); if (!write_in_progress) { do_write(); } }); } private: inline void do_connect(boost::asio::ip::tcp::resolver::iterator endpoint_iterator) { boost::asio::async_connect(socket_, endpoint_iterator, [this](boost::system::error_code ec, boost::asio::ip::tcp::resolver::iterator) { if (!ec) { do_read_message(); } else { std::cout << "Server is down." << std::endl; } }); } inline void do_read_message() { boost::asio::async_read(socket_, boost::asio::buffer(read_msg_.data(), 1029), [this](boost::system::error_code ec, std::size_t /*length*/) { if (!ec ) { do_read_message(); } else { std::cout << "Error in client" << std::endl; socket_.close(); } }); } inline void do_write() { boost::asio::async_write(socket_, boost::asio::buffer(write_msgs_.front().data(), write_msgs_.front().length()), [this](boost::system::error_code ec, std::size_t /*length*/) { if (!ec) { write_msgs_.pop_front(); if (!write_msgs_.empty()) { do_write(); } } else { socket_.close(); } }); } boost::asio::io_service& io_service_; boost::asio::ip::tcp::socket socket_; Rtcm_Message read_msg_; std::deque write_msgs_; }; class Queue_Reader { public: Queue_Reader(boost::asio::io_service& io_service, std::shared_ptr< concurrent_queue > & queue, int port) : queue_(queue) { boost::asio::ip::tcp::resolver resolver(io_service); std::string host("localhost"); std::string port_str = std::to_string(port); auto queue_endpoint_iterator = resolver.resolve({ host.c_str(), port_str.c_str() }); c = std::make_shared(io_service, queue_endpoint_iterator); } inline void do_read_queue() { for(;;) { std::string message; Rtcm_Message msg; queue_->wait_and_pop(message); //message += '\n'; if(message.compare("Goodbye") == 0) break; const char *char_msg = message.c_str(); msg.body_length(message.length()); std::memcpy(msg.body(), char_msg, msg.body_length()); msg.encode_header(); c->write(msg); } } private: std::shared_ptr c; std::shared_ptr< concurrent_queue > & queue_; }; class Tcp_Server { public: Tcp_Server(boost::asio::io_service& io_service, const boost::asio::ip::tcp::endpoint& endpoint) : io_service_(io_service), acceptor_(io_service), socket_(io_service) { acceptor_.open(endpoint.protocol()); acceptor_.set_option(boost::asio::ip::tcp::acceptor::reuse_address(true)); acceptor_.bind(endpoint); acceptor_.listen(); do_accept(); } inline void close_server() { socket_.close(); acceptor_.close(); } private: inline void do_accept() { acceptor_.async_accept(socket_, [this](boost::system::error_code ec) { if (!ec) { if(first_client) { std::cout << "The TCP Server is up and running. Accepting connections ..." << std::endl; first_client = false; } else { std::cout << "Starting RTCM TCP server session..." << std::endl; std::cout << "Serving client from " << socket_.remote_endpoint().address() << std::endl; } std::make_shared(std::move(socket_), room_)->start(); } else { std::cout << "Error when invoking a RTCM session. " << ec << std::endl; } do_accept(); }); } boost::asio::io_service& io_service_; boost::asio::ip::tcp::acceptor acceptor_; boost::asio::ip::tcp::socket socket_; Rtcm_Listener_Room room_; bool first_client = true; }; boost::asio::io_service io_service; std::shared_ptr< concurrent_queue > rtcm_message_queue; std::thread t; std::thread tq; std::list servers; bool server_is_running; void stop_service(); // // Transport Layer // std::bitset<8> preamble; std::bitset<6> reserved_field; std::string add_CRC(const std::string & m) const; std::string build_message(const std::string & data) const; // adds 0s to complete a byte and adds the CRC // // Data Fields // std::bitset<12> DF002; int set_DF002(unsigned int message_number); std::bitset<12> DF003; int set_DF003(unsigned int ref_station_ID); std::bitset<30> DF004; int set_DF004(double obs_time); std::bitset<1> DF005; int set_DF005(bool sync_flag); std::bitset<5> DF006; int set_DF006(const std::map & observables); std::bitset<1> DF007; int set_DF007(bool divergence_free_smoothing_indicator); // 0 - Divergence-free smoothing not used 1 - Divergence-free smoothing used std::bitset<3> DF008; int set_DF008(short int smoothing_interval); std::bitset<6> DF009; int set_DF009(const Gnss_Synchro & gnss_synchro); int set_DF009(const Gps_Ephemeris & gps_eph); std::bitset<1> DF010; int set_DF010(bool code_indicator); std::bitset<24> DF011; int set_DF011(const Gnss_Synchro & gnss_synchro); std::bitset<20> DF012; int set_DF012(const Gnss_Synchro & gnss_synchro); std::bitset<7> DF013; int set_DF013(const Gps_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<8> DF014; int set_DF014(const Gnss_Synchro & gnss_synchro); std::bitset<8> DF015; int set_DF015(const Gnss_Synchro & gnss_synchro); std::bitset<14> DF017; int set_DF017(const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::bitset<20> DF018; int set_DF018(const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::bitset<7> DF019; int set_DF019(const Gps_CNAV_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<8> DF020; int set_DF020(const Gnss_Synchro & gnss_synchro); std::bitset<6> DF021; int set_DF021(); std::bitset<1> DF022; int set_DF022(bool gps_indicator); std::bitset<1> DF023; int set_DF023(bool glonass_indicator); std::bitset<1> DF024; int set_DF024(bool galileo_indicator); std::bitset<38> DF025; int set_DF025(double antenna_ECEF_X_m); std::bitset<38> DF026; int set_DF026(double antenna_ECEF_Y_m); std::bitset<38> DF027; int set_DF027(double antenna_ECEF_Z_m); std::bitset<16> DF028; int set_DF028(double height); std::bitset<8> DF029; std::bitset<8> DF031; int set_DF031(unsigned int antenna_setup_id); std::bitset<8> DF032; std::bitset<27> DF034; //!< GLONASS Epoch Time (tk) int set_DF034(double obs_time); std::bitset<5> DF035; //!< No. of GLONASS Satellite Signals Processed int set_DF035(const std::map & observables); std::bitset<1> DF036; //!< GLONASS Divergence-free Smoothing Indicator int set_DF036(bool divergence_free_smoothing_indicator); std::bitset<3> DF037; //!< GLONASS Smoothing Interval int set_DF037(short int smoothing_interval); std::bitset<6> DF038; //!< GLONASS Satellite ID (Satellite Slot Number) int set_DF038(const Gnss_Synchro & gnss_synchro); int set_DF038(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF039; //!< GLONASS L1 Code Indicator int set_DF039(bool code_indicator); std::bitset<5> DF040; //!< GLONASS Satellite Frequency Number int set_DF040(unsigned int frequency_channel_number); int set_DF040(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<25> DF041; //!< GLONASS L1 Pseudorange int set_DF041(const Gnss_Synchro & gnss_synchro); std::bitset<20> DF042; //!< GLONASS L1 PhaseRange - L1 Pseudorange int set_DF042(const Gnss_Synchro & gnss_synchro); std::bitset<7> DF043; //!< GLONASS L1 Lock Time Indicator int set_DF043(const Glonass_Gnav_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<7> DF044; //!< GLONASS Integer L1 Pseudorange Modulus Ambiguity int set_DF044(const Gnss_Synchro & gnss_synchro); std::bitset<8> DF045; //!< GLONASS L1 CNR int set_DF045(const Gnss_Synchro & gnss_synchro); std::bitset<2> DF046; //!< GLONASS L2 code indicator int set_DF046(unsigned short code_indicator); std::bitset<14> DF047; //!< GLONASS L2 - L1 Pseudorange Difference int set_DF047(const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::bitset<20> DF048; //!< GLONASS L2 PhaseRange - L1 Pseudorange int set_DF048(const Gnss_Synchro & gnss_synchroL1, const Gnss_Synchro & gnss_synchroL2); std::bitset<7> DF049; //!< GLONASS L2 Lock Time Indicator int set_DF049(const Glonass_Gnav_Ephemeris & eph, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<8> DF050; //!< GLONASS L2 CNR int set_DF050(const Gnss_Synchro & gnss_synchro); std::bitset<16> DF051; int set_DF051(const Gps_Ephemeris & gps_eph, double obs_time); std::bitset<17> DF052; int set_DF052(const Gps_Ephemeris & gps_eph, double obs_time); // Contents of GPS Satellite Ephemeris Data, Message Type 1019 std::bitset<8> DF071; int set_DF071(const Gps_Ephemeris & gps_eph); std::bitset<10> DF076; int set_DF076(const Gps_Ephemeris & gps_eph); std::bitset<4> DF077; int set_DF077(const Gps_Ephemeris & gps_eph); std::bitset<2> DF078; int set_DF078(const Gps_Ephemeris & gps_eph); std::bitset<14> DF079; int set_DF079(const Gps_Ephemeris & gps_eph); std::bitset<8> DF080; int set_DF080(const Gps_Ephemeris & gps_eph); std::bitset<16> DF081; int set_DF081(const Gps_Ephemeris & gps_eph); std::bitset<8> DF082; int set_DF082(const Gps_Ephemeris & gps_eph); std::bitset<16> DF083; int set_DF083(const Gps_Ephemeris & gps_eph); std::bitset<22> DF084; int set_DF084(const Gps_Ephemeris & gps_eph); std::bitset<10> DF085; int set_DF085(const Gps_Ephemeris & gps_eph); std::bitset<16> DF086; int set_DF086(const Gps_Ephemeris & gps_eph); std::bitset<16> DF087; int set_DF087(const Gps_Ephemeris & gps_eph); std::bitset<32> DF088; int set_DF088(const Gps_Ephemeris & gps_eph); std::bitset<16> DF089; int set_DF089(const Gps_Ephemeris & gps_eph); std::bitset<32> DF090; int set_DF090(const Gps_Ephemeris & gps_eph); std::bitset<16> DF091; int set_DF091(const Gps_Ephemeris & gps_eph); std::bitset<32> DF092; int set_DF092(const Gps_Ephemeris & gps_eph); std::bitset<16> DF093; int set_DF093(const Gps_Ephemeris & gps_eph); std::bitset<16> DF094; int set_DF094(const Gps_Ephemeris & gps_eph); std::bitset<32> DF095; int set_DF095(const Gps_Ephemeris & gps_eph); std::bitset<16> DF096; int set_DF096(const Gps_Ephemeris & gps_eph); std::bitset<32> DF097; int set_DF097(const Gps_Ephemeris & gps_eph); std::bitset<16> DF098; int set_DF098(const Gps_Ephemeris & gps_eph); std::bitset<32> DF099; int set_DF099(const Gps_Ephemeris & gps_eph); std::bitset<24> DF100; int set_DF100(const Gps_Ephemeris & gps_eph); std::bitset<8> DF101; int set_DF101(const Gps_Ephemeris & gps_eph); std::bitset<6> DF102; int set_DF102(const Gps_Ephemeris & gps_eph); std::bitset<1> DF103; int set_DF103(const Gps_Ephemeris & gps_eph); std::bitset<1> DF104; //!< GLONASS Almanac Health int set_DF104(unsigned int glonass_gnav_alm_health); std::bitset<1> DF105; //!< GLONASS Almanac Health Availability Indicator int set_DF105(unsigned int glonass_gnav_alm_health_ind); std::bitset<2> DF106; //!< GLONASS P1 Word int set_DF106(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<12> DF107; //!< GLONASS Epoch (tk) int set_DF107(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF108; //!< GLONASS MSB of Bn Word int set_DF108(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF109; //!< GLONASS P2 Word int set_DF109(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<7> DF110; //!< GLONASS Ephmeris Epoch (tb) int set_DF110(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<24> DF111; //!< GLONASS Xn first derivative int set_DF111(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<27> DF112; //!< GLONASS Xn int set_DF112(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<5> DF113; //!< GLONASS Xn second derivative int set_DF113(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<24> DF114; //!< GLONASS Yn first derivative int set_DF114(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<27> DF115; //!< GLONASS Yn int set_DF115(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<5> DF116; //!< GLONASS Yn second derivative int set_DF116(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<24> DF117; //!< GLONASS Zn first derivative int set_DF117(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<27> DF118; //!< GLONASS Zn int set_DF118(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<5> DF119; //!< GLONASS Zn second derivative int set_DF119(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF120; //!< GLONASS P3 int set_DF120(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<11> DF121; //!< GLONASS GAMMA_N int set_DF121(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<2> DF122; //!< GLONASS P int set_DF122(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF123; //!< GLONASS ln (third string) int set_DF123(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<22> DF124; //!< GLONASS TAU_N int set_DF124(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<5> DF125; //!< GLONASS DELTA_TAU_N int set_DF125(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<5> DF126; //!< GLONASS Eccentricity int set_DF126(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF127; //!< GLONASS P4 int set_DF127(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<4> DF128; //!< GLONASS F_T int set_DF128(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<11> DF129; //!< GLONASS N_T int set_DF129(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<2> DF130; //!< GLONASS M int set_DF130(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF131; //!< GLONASS Availability of additional data int set_DF131(unsigned int fifth_str_additional_data_ind); std::bitset<11> DF132; //!< GLONASS N_A int set_DF132(const Glonass_Gnav_Utc_Model & glonass_gnav_utc_model); std::bitset<32> DF133; //!< GLONASS TAU_C int set_DF133(const Glonass_Gnav_Utc_Model & glonass_gnav_utc_model); std::bitset<5> DF134; //!< GLONASS N_4 int set_DF134(const Glonass_Gnav_Utc_Model & glonass_gnav_utc_model); std::bitset<22> DF135; //!< GLONASS TAU_GPS int set_DF135(const Glonass_Gnav_Utc_Model & glonass_gnav_utc_model); std::bitset<1> DF136; //!< GLONASS L_N (FIFTH STRING) int set_DF136(const Glonass_Gnav_Ephemeris & glonass_gnav_eph); std::bitset<1> DF137; int set_DF137(const Gps_Ephemeris & gps_eph); std::bitset<1> DF141; int set_DF141(const Gps_Ephemeris & gps_eph); std::bitset<1> DF142; int set_DF142(const Gps_Ephemeris & gps_eph); std::bitset<30> DF248; int set_DF248(double obs_time); // Contents of Galileo F/NAV Satellite Ephemeris Data, Message Type 1045 std::bitset<6> DF252; int set_DF252(const Galileo_Ephemeris & gal_eph); std::bitset<12> DF289; int set_DF289(const Galileo_Ephemeris & gal_eph); std::bitset<10> DF290; int set_DF290(const Galileo_Ephemeris & gal_eph); std::bitset<8> DF291; int set_DF291(const Galileo_Ephemeris & gal_eph); std::bitset<14> DF292; int set_DF292(const Galileo_Ephemeris & gal_eph); std::bitset<14> DF293; int set_DF293(const Galileo_Ephemeris & gal_eph); std::bitset<6> DF294; int set_DF294(const Galileo_Ephemeris & gal_eph); std::bitset<21> DF295; int set_DF295(const Galileo_Ephemeris & gal_eph); std::bitset<31> DF296; int set_DF296(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF297; int set_DF297(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF298; int set_DF298(const Galileo_Ephemeris & gal_eph); std::bitset<32> DF299; int set_DF299(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF300; int set_DF300(const Galileo_Ephemeris & gal_eph); std::bitset<32> DF301; int set_DF301(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF302; int set_DF302(const Galileo_Ephemeris & gal_eph); std::bitset<32> DF303; int set_DF303(const Galileo_Ephemeris & gal_eph); std::bitset<14> DF304; int set_DF304(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF305; int set_DF305(const Galileo_Ephemeris & gal_eph); std::bitset<32> DF306; int set_DF306(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF307; int set_DF307(const Galileo_Ephemeris & gal_eph); std::bitset<32> DF308; int set_DF308(const Galileo_Ephemeris & gal_eph); std::bitset<16> DF309; int set_DF309(const Galileo_Ephemeris & gal_eph); std::bitset<32> DF310; int set_DF310(const Galileo_Ephemeris & gal_eph); std::bitset<24> DF311; int set_DF311(const Galileo_Ephemeris & gal_eph); std::bitset<10> DF312; int set_DF312(const Galileo_Ephemeris & gal_eph); std::bitset<10> DF313; int set_DF313(const Galileo_Ephemeris & gal_eph); std::bitset<2> DF314; int set_DF314(const Galileo_Ephemeris & gal_eph); std::bitset<1> DF315; int set_DF315(const Galileo_Ephemeris & gal_eph); std::bitset<2> DF364; // Content of message header for MSM1, MSM2, MSM3, MSM4, MSM5, MSM6 and MSM7 std::bitset<1> DF393; int set_DF393(bool more_messages); //1 indicates that more MSMs follow for given physical time and reference station ID std::bitset<64> DF394; int set_DF394(const std::map & observables); std::bitset<32> DF395; int set_DF395(const std::map & observables); std::string set_DF396(const std::map & observables); std::bitset<8> DF397; int set_DF397(const Gnss_Synchro & gnss_synchro); std::bitset<10> DF398; int set_DF398(const Gnss_Synchro & gnss_synchro); std::bitset<14> DF399; int set_DF399(const Gnss_Synchro & gnss_synchro); std::bitset<15> DF400; int set_DF400(const Gnss_Synchro & gnss_synchro); std::bitset<22> DF401; int set_DF401(const Gnss_Synchro & gnss_synchro); std::bitset<4> DF402; int set_DF402(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<6> DF403; int set_DF403(const Gnss_Synchro & gnss_synchro); std::bitset<15> DF404; int set_DF404(const Gnss_Synchro & gnss_synchro); std::bitset<20> DF405; int set_DF405(const Gnss_Synchro & gnss_synchro); std::bitset<24> DF406; int set_DF406(const Gnss_Synchro & gnss_synchro); std::bitset<10> DF407; int set_DF407(const Gps_Ephemeris & ephNAV, const Gps_CNAV_Ephemeris & ephCNAV, const Galileo_Ephemeris & ephFNAV, const Glonass_Gnav_Ephemeris & ephGNAV, double obs_time, const Gnss_Synchro & gnss_synchro); std::bitset<10> DF408; int set_DF408(const Gnss_Synchro & gnss_synchro); std::bitset<3> DF409; int set_DF409(unsigned int iods); std::bitset<2> DF411; int set_DF411(unsigned int clock_steering_indicator); std::bitset<2> DF412; int set_DF412(unsigned int external_clock_indicator); std::bitset<1> DF417; int set_DF417(bool using_divergence_free_smoothing); std::bitset<3> DF418; int set_DF418(int carrier_smoothing_interval_s); std::bitset<1> DF420; int set_DF420(const Gnss_Synchro & gnss_synchro); }; #endif