#include #include #include #include "main.hpp" #include "message_handler.hpp" #include "sd_event_loop.hpp" namespace eventloop { using namespace phosphor::logging; static int udp623Handler(sd_event_source* es, int fd, uint32_t revents, void* userdata) { std::shared_ptr channelPtr; struct timeval timeout; timeout.tv_sec = SELECT_CALL_TIMEOUT; timeout.tv_usec = 0; try { channelPtr.reset(new udpsocket::Channel(fd, timeout)); // Initialize the Message Handler with the socket channel message::Handler msgHandler(channelPtr); std::unique_ptr inMessage; // Read the incoming IPMI packet inMessage = msgHandler.receive(); if (inMessage == nullptr) { return 0; } // Execute the Command auto outMessage = msgHandler.executeCommand(*(inMessage.get())); if (outMessage == nullptr) { return 0; } // Send the response IPMI Message msgHandler.send(*(outMessage.get())); } catch (std::exception& e) { log("Executing the IPMI message failed"); log(e.what()); } return 0; } static int consoleInputHandler(sd_event_source* es, int fd, uint32_t revents, void* userdata) { try { int readSize = 0; if (ioctl(fd, FIONREAD, &readSize) < 0) { log("ioctl failed for FIONREAD:", entry("errno = %d", errno)); return 0; } std::vector buffer(readSize); auto bufferSize = buffer.size(); ssize_t readDataLen = 0; readDataLen = read(fd, buffer.data(), bufferSize); // Update the Console buffer with data read from the socket if (readDataLen > 0) { buffer.resize(readDataLen); std::get(singletonPool).dataBuffer.write(buffer); } else if (readDataLen == 0) { log("Connection Closed for host console socket"); } else if (readDataLen < 0) // Error { log("Reading from host console socket failed:", entry("ERRNO=%d", errno)); } } catch (std::exception& e) { log(e.what()); } return 0; } int EventLoop::startEventLoop() { int fd = -1; int r = 0; sigset_t ss; sd_event_source* source = nullptr; r = sd_event_default(&event); if (r < 0) { goto finish; } if (sigemptyset(&ss) < 0 || sigaddset(&ss, SIGTERM) < 0 || sigaddset(&ss, SIGINT) < 0) { r = -errno; goto finish; } /* Block SIGTERM first, so that the event loop can handle it */ if (sigprocmask(SIG_BLOCK, &ss, nullptr) < 0) { r = -errno; goto finish; } /* Let's make use of the default handler and "floating" reference features * of sd_event_add_signal() */ r = sd_event_add_signal(event, nullptr, SIGTERM, nullptr, nullptr); if (r < 0) { goto finish; } r = sd_event_add_signal(event, nullptr, SIGINT, nullptr, nullptr); if (r < 0) { goto finish; } if (sd_listen_fds(0) != 1) { log("No or too many file descriptors received"); goto finish; } fd = SD_LISTEN_FDS_START; r = sd_event_add_io(event, &source, fd, EPOLLIN, udp623Handler, nullptr); if (r < 0) { goto finish; } udpIPMI.reset(source); source = nullptr; r = sd_event_loop(event); finish: event = sd_event_unref(event); if (fd >= 0) { (void) close(fd); } if (r < 0) { log("Event Loop Failure:", entry("FAILURE=%s", strerror(-r))); } return r < 0 ? EXIT_FAILURE : EXIT_SUCCESS; } void EventLoop::startHostConsole(const sol::CustomFD& fd) { int rc = 0; if((fd() == -1) || hostConsole.get()) { throw std::runtime_error("Console descriptor already added"); } sd_event_source* source = nullptr; // Add the fd to the event loop for EPOLLIN rc = sd_event_add_io( event, &source, fd(), EPOLLIN, consoleInputHandler, nullptr); if (rc < 0) { throw std::runtime_error("Failed to add socket descriptor"); } hostConsole.reset(source); source=nullptr; } void EventLoop::stopHostConsole() { int rc = 0; if (hostConsole.get()) { // Disable the host console payload rc = sd_event_source_set_enabled(hostConsole.get(), SD_EVENT_OFF); if (rc < 0) { log("Failed to disable the host console socket", entry("RC=%d", rc)); hostConsole.reset(); throw std::runtime_error("Failed to disable socket descriptor"); } hostConsole.reset(); } } void EventLoop::switchTimer(uint8_t payloadInst, Timers type, bool status) { auto iter = payloadInfo.find(payloadInst); if (iter == payloadInfo.end()) { log("SOL Payload instance not found", entry("payloadInst=%d", payloadInst)); throw std::runtime_error("SOL Payload instance not found"); } int rc = 0; auto source = (std::get<0>(iter->second.at(type))).get(); auto interval = std::get<1>(iter->second.at(type)); // Turn OFF the timer if (!status) { rc = sd_event_source_set_enabled(source, SD_EVENT_OFF); if (rc < 0) { log("Failed to disable the timer", entry("RC=%d", rc)); throw std::runtime_error("Failed to disable timer"); } return; } // Turn ON the timer uint64_t currentTime = 0; rc = sd_event_now(event, CLOCK_MONOTONIC, ¤tTime); if (rc < 0) { log("Failed to get the current timestamp", entry("RC=%d", rc)); throw std::runtime_error("Failed to get current timestamp"); } rc = sd_event_source_set_time(source, currentTime + interval.count()); if (rc < 0) { log("sd_event_source_set_time function failed", entry("RC=%d", rc)); throw std::runtime_error("sd_event_source_set_time function failed"); } rc = sd_event_source_set_enabled(source, SD_EVENT_ONESHOT); if (rc < 0) { log("Failed to enable the timer", entry("RC=%d",rc)); throw std::runtime_error("Failed to enable timer"); } } } // namespace eventloop