#include "Data_Source_Handler.h" #include "Data_Source.h" #include "Local_Server/server/Global.h" using namespace Psc; std::shared_ptr ds(Data_Source_Handler* dsh) { return dynamic_cast(dsh)->that(); } std::shared_ptr Data_Source_Handler::create_msg( const std::string &packet) { auto source = ds(this); if (packet[0] != 0x1a) { std::cout << "first:" << mem2hex(packet) << std::endl; return nullptr; } std::string error_len = source->key + " " + LOG_POS_SIMPLE + std::string(" ") + "mode_s_error_length"; if (packet.size() < 2) return nullptr; auto mt = packet[1]; if (mt == SSR::Msg::AC) { if (packet.size() != SSR::Msg::AC_len) { SSR::mode_s_logger->c_debug(error_len, {}, std::to_string(mt) + " size:" + std::to_string(packet.size()) + " hex:" + mem2hex(packet) + " should:" + std::to_string(SSR::Msg::AC_len)); mode_ac_statistic.add_length_error(); return nullptr; } mode_ac_statistic.add(); return std::make_shared(source, packet); } if (mt == SSR::Msg::S7) { if (packet.size() != SSR::Mode_S_Msg::S7_len) { SSR::mode_s_logger->c_debug(error_len, {}, std::to_string(mt) + " size:" + std::to_string(packet.size()) + " hex:" + mem2hex(packet) + " should:" + std::to_string(SSR::Msg::S7_len)); mode_s_statistic.add_length_error("[length error] Msg::S7 handle_mode_s_source"); return nullptr; } return std::make_shared(source, packet); } if (mt == SSR::Msg::S14) { if (packet.size() != SSR::Msg::S14_len) { SSR::mode_s_logger->c_debug(error_len, {}, std::to_string(mt) + " size:" + std::to_string(packet.size()) + " hex:" + mem2hex(packet) + " should:" + std::to_string(SSR::Msg::S14_len)); mode_s_statistic.add_length_error("[length error] Msg::S14 handle_mode_s_source"); return nullptr; } return std::make_shared(source, packet); } if (mt == SSR::Msg::Radarcape_status) { return nullptr; // 不知道如何解析跳过 if (packet.size() != SSR::Msg::Radarcape_status_len) { SSR::mode_s_logger->c_debug(error_len, {}, std::to_string(mt) + " size:" + std::to_string(packet.size()) + " hex:" + mem2hex(packet) + " should:" + std::to_string(SSR::Msg::Radarcape_status_len)); mode_s_statistic.add_length_error("[length error] Msg::Radarcape_status_len handle_mode_s_source"); return nullptr; } return std::make_shared(source, packet); } if (mt == SSR::Msg::HULC_Status) { if (packet.size() != SSR::Msg::HULC_len) { // 找不到协议 size:23 hex:1A34195F0000001500B502FF06F423CE50000090000000 should:5 SSR::mode_s_logger->c_debug(error_len, {}, Psc::to_string(source->type) + " HULC size:" + std::to_string(packet.size()) + " hex:" + mem2hex(packet)); return nullptr; } return std::make_shared(source, packet); } // std::cout << "unknown_type:" << memory2hex(packet); rotating_log("unknown_type", mem2hex(packet)); return nullptr; } void Data_Source_Handler::process_mode_acs_data(const std::string& mode_data) { auto source = ds(this); auto size = mode_data.size(); read_speed.update(size); value_statistics.update(size); // 预处理数据 static bool mode_s_console = Global::instance()->console_config.mode_s_console; static bool record_playback = Global::instance()->console_config.record_playback; if (mode_data.empty()) return; if (record_playback) { pure_log(get_exe_dir() + "/playback/" + source->key + "_playback.dat", mem2hex(mode_data, true, " ") + "\n"); } if (mode_s_console) { std::cout << source->key + " read:[mode_s_serial]:" << mem2hex(mode_data) << std::endl; } SSR::Binary_Format_handle_buffer(source->buffer, mode_data, [this, source](std::string& packet) { auto msg = create_msg(packet); if (!msg) return; source->push_to_feed(msg); auto mt = msg->type; bool mode_s = mt == SSR::Msg::S7 || mt == SSR::Msg::S14; if (mt == SSR::Msg::HULC_Status) { source->handle_HULC(packet); } else if (mt == SSR::Msg::Radarcape_status) { auto radarcape_msg = SSR::create_Radarcape_STATUS_Message(packet); std::cout << radarcape_msg.toJson().to_json_string() << std::endl; SSR::mode_s_logger->debug("Radarcape_status/radarcape", {}, radarcape_msg.toJson().to_json_string()); } else if (mode_s) { // 拓展点 handle_mode_s(std::dynamic_pointer_cast(msg)); } }); } void Data_Source_Handler::handle_mode_s(std::shared_ptr mode_s_msg) { auto source = ds(this); std::string t = mode_s_msg->mlat_timestamp.to_memory() + mode_s_msg->signal_level + Psc::hex2mem(mode_s_msg->msg_hex); auto p = mode_s_msg->packet.substr(2); if (t != p) { std::cout << mem2hex(t, true, " ") << std::endl; std::cout << mem2hex(mode_s_msg->packet, true, " ") << std::endl; std::cout << VAR_STR_2(t, mode_s_msg->packet) << std::endl; } // TODO: 可能不需要push_to_feed source->push_to_feed(mode_s_msg); auto& cfg = Global::instance()->mode_acs; SSR::parse_mode_s_bin(source.get(), mode_s_msg, source->base_station.get_pos(),cfg.max_speed_m_s, cfg.air_pos_timeout, cfg.surface_pos_timeout); auto base = source->get_aircraft(mode_s_msg->icao); if (base) { auto derived = std::dynamic_pointer_cast(base); derived->refresh_external_database_info(); } if (Global::instance()->mlat.merge) { auto& mh = Global::instance()->mlat_handler; mh.push(mode_s_msg); auto tt = mh.get_all(); if (!tt.empty()) { pure_log("@/logs/mlat.log", "receive[" + std::to_string(tt.size()) + "]:\n"); for (Mlat_MSG& t : tt) { std::ostringstream oss; oss << std::fixed << std::setprecision(10); oss << "===================================================\n"; int n = static_cast(t.size()); auto icao = t.icao().value_or("null"); oss << "\tmlat_msg:" << n; oss << "\ticao:" << icao; oss << "\thex:" << t.msg_hex() << std::endl; bool have_pos = false; if (icao != "null") { auto air = source->get_aircraft(icao); if (air != nullptr) { auto callsign = air->bds20_call_sign(); oss << "\tcall_sign：" << callsign.value_or("null") << std::endl; auto o_pos = air->pos(); auto o_alt = air->altitude_meter(); if (o_pos.has_value() && o_alt.has_value()) { have_pos = true; auto pos = o_pos.value(); source->alt = o_alt.value(); double x, y, z; SSR::CPR::WGS84_LBH_to_XYZ(pos.lon, pos.lat, source->alt, x, y, z); oss << "\tpos：[" << pos.lon << "," << pos.lat << "," << source->alt << "]" << std::endl; oss << "\tXYZ：[" << x << "," << y << "," << z << "]" << std::endl; } } } for (int i = 0; i < t.size(); i++) { auto& msg = t.list[i]; oss << "\t\tds:" << msg->source->get_key(); oss << "\ttime:" << msg->mlat_timestamp.to_string() << std::endl; } // if (have_pos) { //std::cout << oss.str() << std::endl; pure_log("@/logs/mlat.log", oss.str()); // } // if (t.size() > 3 && have_pos && icao == "78139F") { // size_t i = 1; // auto range = hex_mlat_map.equal_range(t.msg_hex()); // // 遍历与key_to_find对应的所有元素 // for (auto it = range.first; it != range.second; ++it) { // oss << "\t" << i++ << " " << it->second.msg << std::endl; // } // oss << "===================================================\n"; // std::cout << oss.str() << std::endl; // pure_log("@/logs/icao/" + icao + "_mlat.log", oss.str(), true); // } } } } } void Data_Source_Handler::handle_HULC(const std::string& packet) { std::uint8_t len = SSR::get_len(packet); std::uint8_t id = SSR::get_id(packet); auto msg = mem2hex(packet); if (len != packet.size() - 4) { SSR::mode_s_logger->debug("HULC/error_length", {}, "需要: " + std::to_string(len) + " 当前: " + std::to_string(packet.size()) + " hex: " + mem2hex(packet)); return; } if (id == 1) { // 状态消息 auto status_msg = SSR::create_HULC_Status_Message(packet); bool gps_ok = status_msg.GPS_device_detected() && status_msg.GPS_valid() && status_msg.GPS_has_valid_fix(); if (gps_ok) { } auto g = Global::instance(); base_station.set_msg(status_msg); Log_Type type({}, {{"msg", msg}}); SSR::mode_s_logger->debug("HULC/status", type, status_msg.toJson().to_json_string()); if (gps_ok) { } } else if (id == 24) { SSR::mode_s_logger->debug("HULC/reply", {}, msg); } else { SSR::mode_s_logger->debug("HULC/unknown_id", {}, msg); } }