//
// Copyright 2019 Ettus Research, a National Instruments brand
//
// SPDX-License-Identifier: GPL-3.0-or-later
//

#include <uhdlib/transport/dpdk/common.hpp>
#include <uhdlib/transport/dpdk/service_queue.hpp>
#include <uhdlib/transport/dpdk_io_service.hpp>
#include <uhdlib/transport/udp_dpdk_link.hpp>
#include <boost/program_options.hpp>
#include <iostream>
#include <memory>
#include <thread>

namespace po = boost::program_options;
namespace dpdk = uhd::transport::dpdk;

void requester(dpdk::service_queue* queue)
{
    uint32_t count = 0;
    std::chrono::seconds block(-1);
    auto req = dpdk::wait_req_alloc(
        dpdk::wait_type::WAIT_TYPE_COUNT, &count
    );
    std::cout << "Requesting count increment" << std::endl;
    queue->submit(req, block);
    if (count == 1) {
        std::cout << "PASS: Count=1" << std::endl;
    }
    wait_req_put(req);

    std::cout << "Requesting termination" << std::endl;
    req = dpdk::wait_req_alloc(
        dpdk::wait_type::WAIT_FLOW_CLOSE, NULL
    );
    queue->submit(req, block);
    wait_req_put(req);
}

void servicer(uhd::transport::dpdk::service_queue* queue)
{
    bool running = true;
    while (running) {
        auto req = queue->pop();
        if (!req) {
            std::this_thread::yield();
            continue;
        }
        switch (req->reason) {
        case dpdk::wait_type::WAIT_TYPE_COUNT:
            (*(uint32_t *) req->data)++;
            break;
        case dpdk::wait_type::WAIT_FLOW_CLOSE:
            running = false;
            break;
        case dpdk::wait_type::WAIT_SIMPLE:
            break;
        default:
            std::cout << "ERROR: Received unexpected service request type" << std::endl;
            throw uhd::runtime_error("Unexpected service request type");
        }
        if (queue->complete(req) == -ENOBUFS) {
            req->reason = dpdk::wait_type::WAIT_SIMPLE;
            while (queue->requeue(req) == -ENOBUFS);
        }
    }
}

int main(int argc, char **argv)
{
    po::options_description desc("Allowed options");
    int status = 0;
    std::string args;
    desc.add_options()
        ("help", "help message")
        ("args", po::value<std::string>(&args)->default_value(""), "UHD-DPDK args")
    ;
    po::variables_map vm;
    po::store(po::parse_command_line(argc, argv, desc), vm);
    po::notify(vm);

    if (vm.count("help")) {
        std::cout << desc << std::endl;
        return 0;
    }

    auto dpdk_args = uhd::device_addr_t(args);
    auto ctx = uhd::transport::dpdk::dpdk_ctx::get();
    ctx->init(args);

    uhd::transport::dpdk::dpdk_port* port = ctx->get_port(0);
    std::cout << "Port 0 MTU: " << port->get_mtu() << std::endl;
    status = ctx->get_port_link_status(0);
    std::cout << "Port 0 Link up: " << status << std::endl;

    std::cout << std::endl << "Now testing the service queue..." << std::endl;
    // Technically this isn't correct, since the lcore ID would need to be the
    // service thread's, but we didn't use a DPDK lcore for this...
    auto queue = new uhd::transport::dpdk::service_queue(8, rte_lcore_id());
    std::thread service_thread(servicer, queue);
    requester(queue);
    service_thread.join();
    std::cout << "PASS: Service thread terminated" << std::endl;
    delete queue;

    std::cout << "Starting up ARP thread..." << std::endl;
    std::vector<uhd::transport::dpdk::dpdk_port*> ports;
    ports.push_back(port);
    //auto io_srv = uhd::transport::dpdk_io_service::make(1, ports, 16);
    auto io_srv = ctx->get_io_service(1);

    // Create link
    std::cout << "Creating UDP link..." << std::endl;
    uhd::transport::link_params_t params;
    params.recv_frame_size = 8000;
    params.send_frame_size = 8000;
    params.num_recv_frames = 511;
    params.num_send_frames = 511;
    params.recv_buff_size = params.recv_frame_size*params.num_recv_frames;
    params.send_buff_size = params.send_frame_size*params.num_send_frames;
    auto link = uhd::transport::udp_dpdk_link::make("192.168.10.2", "49600", params);

    // Attach link
    std::cout << "Attaching UDP send link..." << std::endl;
    io_srv->attach_send_link(link);
    struct ether_addr dest_mac;
    link->get_remote_mac(dest_mac);
    char mac_str[20];
    ether_format_addr(mac_str, 20, &dest_mac);
    std::cout << "Remote MAC address is " << mac_str << std::endl;
    std::cout << std::endl;
    std::cout << "Attaching UDP recv link..." << std::endl;
    io_srv->attach_recv_link(link);
    std::cout << "Press any key to quit..." << std::endl;
    std::cin.get();

    // Shut down
    std::cout << "Detaching UDP send link..." << std::endl;
    io_srv->detach_send_link(link);
    std::cout << "Detaching UDP recv link..." << std::endl;
    io_srv->detach_recv_link(link);
    std::cout << "Shutting down I/O service..." << std::endl;
    io_srv.reset();
    std::cout << "Shutting down context..." << std::endl;
    ctx.reset();
    return 0;
}