1. 增加拦车器锁定功能。

common/utils.hpp

@@ -0,0 +1,14 @@
+#pragma once
+
+#include <filesystem>
+#include <fstream>
+#include <iostream>
+#include <limits.h>
+#include <unistd.h>
+
+std::filesystem::path getExeDir()
+{
+    char buf[PATH_MAX] = {0};
+    ssize_t len = readlink("/proc/self/exe", buf, sizeof(buf)-1);
+    return std::filesystem::path(std::string(buf, len)).parent_path();
+}

gatectrl/Subscriber.cxx

@@ -36,6 +36,7 @@
 
 #include "msg.hpp"
 #include "DEBUG.hpp"
+#include "utils.hpp"
 
 using namespace eprosima::fastdds::dds;
 
@@ -215,6 +216,8 @@ void SubscriberApp::run(std::shared_ptr<MsgHandler> handler)
                 MsgData::BarCommandUpdate_queue_.pop();
                 lock.unlock();
                 std::vector<std::string> port;
+                if (!std::filesystem::exists(getExeDir() / "frontbar.lock"))
+                {
                     if (cmd.FrontBarEnable() == true)
                     {
                         if (cmd.FrontBarSignalUp() == 1)
@@ -228,6 +231,9 @@ void SubscriberApp::run(std::shared_ptr<MsgHandler> handler)
                             handler->new_bar_state.FrontBarState = 2;
                         }
                     }
+                }
+                if (!std::filesystem::exists(getExeDir() / "backbar.lock"))
+                {
                     if (cmd.BackBarEnable() == true)
                     {
                         if (cmd.BackBarSignalUp() == 1)
@@ -241,8 +247,12 @@ void SubscriberApp::run(std::shared_ptr<MsgHandler> handler)
                             handler->new_bar_state.BackBarState = 2;
                         }
                     }
+                }
+                if (!port.empty())
+                {
                     handler->CtrlBar(port);
                 }
+            }
             else if(!MsgData::LightsCommandUpdate_queue_.empty())
             {
                 WeighingSystem::LightsCommandUpdate cmd = std::move(MsgData::LightsCommandUpdate_queue_.front());

mqttdds/Publisher.cxx

@@ -37,6 +37,7 @@
 #include "json.hpp"
 #include "msg.hpp"
 #include "DEBUG.hpp"
+#include "utils.hpp"
 
 using namespace eprosima::fastdds::dds;
 using json = nlohmann::json;
@@ -463,6 +464,17 @@ void PublisherApp::run(std::shared_ptr<mqtt::async_client> dev)
                         bar_ctrl(ctrl);
                     }
                 }
+                else if (topic.find("barrier/frontlock") != std::string::npos)
+                {
+                    if (cmd["value"] == 1)
+                    {
+                        std::ofstream(getExeDir() / "frontbar.lock") << getpid();
+                    }
+                    else
+                    {
+                        std::filesystem::remove(getExeDir() / "frontbar.lock");
+                    }
+                }
                 else if (topic.find("light/frontsignal") != std::string::npos)
                 {
                     if (cmd["value"] == 1)