sweeper_video/src/rtmp_manager.cpp

// rtsp_manager.cpp
#include "rtmp_manager.hpp"
#include "logger.hpp"
#include <chrono>
#include <thread>
#include <iostream>
#include <algorithm>

std::unordered_map<std::string, RTMPManager::StreamContext> RTMPManager::streams;
std::mutex RTMPManager::streams_mutex;
RTMPManager::StreamCallback RTMPManager::status_callback = nullptr;

static inline std::string stream_type_suffix(StreamType type)
{
    return (type == StreamType::MAIN) ? "_main" : "_sub";
}

std::string RTMPManager::make_stream_key(const std::string &cam_name, StreamType type)
{
    return cam_name + stream_type_suffix(type);
}

void RTMPManager::init()
{
    gst_init(nullptr, nullptr);
    LOG_INFO("[RTMP] GStreamer initialized.");
}

void RTMPManager::set_status_callback(StreamCallback cb)
{
    status_callback = std::move(cb);
}

void RTMPManager::update_status(const std::string &key, const StreamStatus &status)
{
    std::lock_guard<std::mutex> lock(streams_mutex);
    auto it = streams.find(key);
    if (it != streams.end())
        it->second.status = status;
    if (status_callback)
        status_callback(key, status);
}

GstElement *RTMPManager::create_pipeline(const Camera &cam, StreamType type)
{
    int width = cam.width;
    int height = cam.height;
    int fps = cam.fps;
    int bitrate = cam.bitrate;

    if (type == StreamType::SUB)
    {
        width = std::max(160, width / 2);
        height = std::max(120, height / 2);
        fps = std::max(10, fps / 2);
        bitrate = std::max(300000, bitrate / 2);
    }

    std::string stream_name = cam.name + stream_type_suffix(type);
    std::string pipeline_str =
        "v4l2src device=" + cam.device +
        " ! video/x-raw,format=NV12,width=" + std::to_string(width) +
        ",height=" + std::to_string(height) +
        ",framerate=" + std::to_string(fps) +
        "/1 ! queue max-size-buffers=1 leaky=downstream "
        "! mpph264enc bps=" +
        std::to_string(bitrate) +
        " gop=" + std::to_string(fps) +
        " ! h264parse ! flvmux streamable=true name=mux "
        "! rtmpsink location=\"rtmp://127.0.0.1/live/" +
        stream_name + " live=1\" sync=false";

    LOG_INFO("[RTMP] Creating pipeline for '" + stream_name + "': " + pipeline_str);

    GError *error = nullptr;
    GstElement *pipeline = gst_parse_launch(pipeline_str.c_str(), &error);
    if (error)
    {
        LOG_ERROR("[RTMP] Pipeline parse error: " + std::string(error->message));
        g_error_free(error);
        return nullptr;
    }
    return pipeline;
}

void RTMPManager::stream_loop(Camera cam, StreamType type)
{
    const std::string key = make_stream_key(cam.name, type);
    LOG_INFO("[RTMP] Stream loop started for " + key);

    const int MAX_RETRIES = 5;
    int retry_count = 0;

    while (true)
    {
        {
            std::lock_guard<std::mutex> lock(streams_mutex);
            if (!streams[key].running)
                break;
        }

        GstElement *pipeline = create_pipeline(cam, type);
        if (!pipeline)
        {
            update_status(key, {false, StreamResult::PIPELINE_ERROR, "Failed to create pipeline"});
            std::this_thread::sleep_for(std::chrono::seconds(3));
            if (++retry_count > MAX_RETRIES)
                break;
            continue;
        }

        GstBus *bus = gst_element_get_bus(pipeline);
        gst_element_set_state(pipeline, GST_STATE_PLAYING);
        update_status(key, {true, StreamResult::OK, ""});
        LOG_INFO("[RTMP] " + key + " is streaming.");

        bool stop_flag = false;
        GstMessage *msg = nullptr;

        while (true)
        {
            msg = gst_bus_timed_pop_filtered(
                bus, GST_CLOCK_TIME_NONE,
                static_cast<GstMessageType>(GST_MESSAGE_ERROR | GST_MESSAGE_EOS));

            {
                std::lock_guard<std::mutex> lock(streams_mutex);
                if (!streams[key].running)
                {
                    stop_flag = true;
                    break;
                }
            }

            if (!msg)
                continue;

            if (GST_MESSAGE_TYPE(msg) == GST_MESSAGE_ERROR)
            {
                GError *err = nullptr;
                gchar *debug = nullptr;
                gst_message_parse_error(msg, &err, &debug);
                std::string err_msg = err ? err->message : "Unknown GStreamer error";
                LOG_ERROR("[RTMP] Error in " + key + ": " + err_msg);
                update_status(key, {false, StreamResult::CONNECTION_FAIL, err_msg});
                g_error_free(err);
                g_free(debug);
                stop_flag = true;
            }
            else if (GST_MESSAGE_TYPE(msg) == GST_MESSAGE_EOS)
            {
                LOG_WARN("[RTMP] EOS on " + key);
                update_status(key, {false, StreamResult::EOS_RECEIVED, "EOS"});
                stop_flag = true;
            }

            gst_message_unref(msg);
            if (stop_flag)
                break;
        }

        gst_element_set_state(pipeline, GST_STATE_NULL);
        gst_object_unref(bus);
        gst_object_unref(pipeline);

        if (!stop_flag)
            break;

        if (++retry_count > MAX_RETRIES)
        {
            LOG_ERROR("[RTMP] " + key + " reached max retries. Giving up.");
            break;
        }

        LOG_WARN("[RTMP] Reconnecting " + key + " in 3s...");
        std::this_thread::sleep_for(std::chrono::seconds(3));
    }

    update_status(key, {false, StreamResult::UNKNOWN, "Stream loop exited"});
    LOG_INFO("[RTMP] Stream loop ended for " + key);
}

void RTMPManager::start_camera(const Camera &cam, StreamType type)
{
    std::string key = make_stream_key(cam.name, type);
    std::lock_guard<std::mutex> lock(streams_mutex);

    auto it = streams.find(key);
    if (it != streams.end() && it->second.running)
    {
        LOG_WARN("[RTMP] " + key + " already streaming.");
        return;
    }

    StreamContext ctx;
    ctx.running = true;
    ctx.thread = std::thread([cam, type]()
                             { stream_loop(cam, type); });
    streams[key] = std::move(ctx);
}

void RTMPManager::stop_camera(const std::string &cam_name, StreamType type)
{
    std::string key = make_stream_key(cam_name, type);
    std::unique_lock<std::mutex> lock(streams_mutex);
    auto it = streams.find(key);
    if (it == streams.end())
    {
        LOG_WARN("[RTMP] " + key + " not found.");
        return;
    }

    it->second.running = false;
    auto th = std::move(it->second.thread);
    streams.erase(it);
    lock.unlock();

    if (th.joinable())
        th.join();

    update_status(key, {false, StreamResult::OK, "Stopped manually"});
}

void RTMPManager::stop_all()
{
    std::vector<std::string> keys;
    {
        std::lock_guard<std::mutex> lock(streams_mutex);
        for (auto &kv : streams)
            keys.push_back(kv.first);
    }
    for (auto &key : keys)
    {
        if (key.find("_main") != std::string::npos)
            stop_camera(key.substr(0, key.size() - 5), StreamType::MAIN);
        else
            stop_camera(key.substr(0, key.size() - 4), StreamType::SUB);
    }
}

bool RTMPManager::is_streaming(const std::string &cam_name, StreamType type)
{
    std::lock_guard<std::mutex> lock(streams_mutex);
    auto key = make_stream_key(cam_name, type);
    auto it = streams.find(key);
    return it != streams.end() && it->second.running;
}

bool RTMPManager::is_any_streaming()
{
    std::lock_guard<std::mutex> lock(streams_mutex);
    for (auto &kv : streams)
        if (kv.second.running)
            return true;
    return false;
}

std::string RTMPManager::get_stream_url(const std::string &cam_name, StreamType type)
{
    return "rtmp://127.0.0.1/live/" + make_stream_key(cam_name, type);
}