150 lines
6.6 KiB
C++
150 lines
6.6 KiB
C++
#include "VisionIpcServer.h"
|
|||
|
|
#include <QLocalServer>
|
||
|
|
#include <QLocalSocket>
|
||
|
|
#include <QJsonDocument>
|
||
|
|
#include <QJsonParseError>
|
||
|
|
#include <QUuid>
|
||
|
|
#include <QtEndian>
|
||
|
|
#include <QCoreApplication>
|
||
|
|
|
||
|
|
namespace { const quint32 MaxMessage = 1024 * 1024; }
|
||
|
|
|
||
|
|
VisionIpcServer::VisionIpcServer(QObject* parent) : QObject(parent),
|
||
|
|
m_session(QUuid::createUuid().toString(QUuid::WithoutBraces))
|
||
|
|
{
|
||
|
|
m_state = {{"ready",false},{"resource_busy",false}};
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::listen(const QString& name)
|
||
|
|
{
|
||
|
|
if(m_server)return;
|
||
|
|
m_server = new QLocalServer(this);
|
||
|
|
m_server->setSocketOptions(QLocalServer::UserAccessOption);
|
||
|
|
connect(m_server,&QLocalServer::newConnection,this,[this]{
|
||
|
|
while(m_server->hasPendingConnections()){
|
||
|
|
auto socket=m_server->nextPendingConnection();
|
||
|
|
if(m_socket){socket->disconnectFromServer();socket->deleteLater();continue;}
|
||
|
|
m_socket=socket;socket->setReadBufferSize(MaxMessage+4);m_buffer.clear();
|
||
|
|
connect(socket,&QLocalSocket::readyRead,this,&VisionIpcServer::read);
|
||
|
|
connect(socket,&QLocalSocket::disconnected,this,[this,socket]{
|
||
|
|
if(m_socket!=socket)return;
|
||
|
|
m_socket=nullptr;m_buffer.clear();socket->deleteLater();
|
||
|
|
if(!m_active.isEmpty()&&!m_terminal){
|
||
|
|
m_terminal=true;
|
||
|
|
auto cancelled=reply(m_active,"cancelled","DISCONNECTED","Controller disconnected");
|
||
|
|
send(cancelled);
|
||
|
|
emit commandReceived(QJsonObject{{"type","cancel"},{"target_request_id",m_active["request_id"]}});
|
||
|
|
}
|
||
|
|
emit controllerChanged(false);
|
||
|
|
});
|
||
|
|
emit controllerChanged(true);
|
||
|
|
}
|
||
|
|
});
|
||
|
|
// Do not remove another instance's endpoint to make a duplicate launch succeed.
|
||
|
|
if(!m_server->listen(name))emit fatalError(m_server->errorString());
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::close()
|
||
|
|
{
|
||
|
|
if(m_socket){m_socket->disconnect(this);m_socket->abort();delete m_socket;m_socket=nullptr;}
|
||
|
|
if(m_server){m_server->close();delete m_server;m_server=nullptr;}
|
||
|
|
}
|
||
|
|
|
||
|
|
QJsonObject VisionIpcServer::reply(const QJsonObject& request,const QString& status,
|
||
|
|
const QString& code,const QString& message) const
|
||
|
|
{
|
||
|
|
auto out=m_state;
|
||
|
|
out["protocol_version"]=1;out["type"]=request["type"];out["request_id"]=request["request_id"];
|
||
|
|
out["server_session_id"]=m_session;out["status"]=status;
|
||
|
|
out["server_process_id"]=QString::number(QCoreApplication::applicationPid());
|
||
|
|
out["resource_busy"]=m_state["resource_busy"].toBool()||!m_active.isEmpty();
|
||
|
|
if(request.contains("context"))out["context"]=request["context"];
|
||
|
|
if(!code.isEmpty())out["error_code"]=code;
|
||
|
|
if(!message.isEmpty())out["message"]=message;
|
||
|
|
return out;
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::send(QJsonObject out,bool remember)
|
||
|
|
{
|
||
|
|
const auto id=out["request_id"].toString();
|
||
|
|
if(remember&&!id.isEmpty()){
|
||
|
|
m_seen.insert(id);
|
||
|
|
if(!m_replies.contains(id))m_replyOrder.enqueue(id);
|
||
|
|
m_replies.insert(id,out);
|
||
|
|
while(m_replyOrder.size()>64)m_replies.remove(m_replyOrder.dequeue());
|
||
|
|
}
|
||
|
|
if(!m_socket)return;
|
||
|
|
const auto payload=QJsonDocument(out).toJson(QJsonDocument::Compact);
|
||
|
|
QByteArray frame(4,'\0');qToBigEndian<quint32>(quint32(payload.size()),reinterpret_cast<uchar*>(frame.data()));
|
||
|
|
frame.append(payload);m_socket->write(frame);
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::read()
|
||
|
|
{
|
||
|
|
if(!m_socket)return;
|
||
|
|
m_buffer+=m_socket->readAll();
|
||
|
|
while(m_buffer.size()>=4){
|
||
|
|
const auto size=qFromBigEndian<quint32>(reinterpret_cast<const uchar*>(m_buffer.constData()));
|
||
|
|
if(size==0||size>MaxMessage){m_socket->abort();return;}
|
||
|
|
if(m_buffer.size()<int(size)+4)return;
|
||
|
|
const auto data=m_buffer.mid(4,int(size));m_buffer.remove(0,int(size)+4);
|
||
|
|
QJsonParseError error;const auto document=QJsonDocument::fromJson(data,&error);
|
||
|
|
if(error.error!=QJsonParseError::NoError||!document.isObject()){m_socket->abort();return;}
|
||
|
|
dispatch(document.object());
|
||
|
|
if(!m_socket)return;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::dispatch(const QJsonObject& request)
|
||
|
|
{
|
||
|
|
const auto id=request["request_id"].toString(),type=request["type"].toString();
|
||
|
|
if(id.isEmpty()||id.size()>128||request["protocol_version"].toDouble()!=1){
|
||
|
|
send(reply(request,"error","PROTOCOL","Expected protocol 1 and a request ID"),false);return;
|
||
|
|
}
|
||
|
|
if(type!="hello"&&request["server_session_id"].toString()!=m_session){
|
||
|
|
send(reply(request,"error","SESSION","Server session changed"),false);return;
|
||
|
|
}
|
||
|
|
if(m_replies.contains(id)){send(m_replies.value(id),false);return;}
|
||
|
|
// Keep only recent payloads, but never execute a request ID again in this process session.
|
||
|
|
if(m_seen.contains(id)){send(reply(request,"error","DUPLICATE_EXPIRED","Request already handled; cached response expired"),false);return;}
|
||
|
|
if(type=="hello"||type=="get_status"){send(reply(request,"ok"),false);return;}
|
||
|
|
if(type=="cancel"){
|
||
|
|
if(request["target_request_id"]!=m_active["request_id"]||m_active.isEmpty()){
|
||
|
|
send(reply(request,"error","NOT_ACTIVE","Target request is not active"));return;
|
||
|
|
}
|
||
|
|
send(reply(request,"ok"));
|
||
|
|
if(!m_terminal){m_terminal=true;send(reply(m_active,"cancelled","CANCELLED","Request invalidated; resource remains busy until the operation exits"));emit commandReceived(request);}
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
if(type=="show_window"){send(reply(request,"ok"));emit commandReceived(request);return;}
|
||
|
|
if(type!="initialize"&&type!="measure"&&type!="shutdown"){
|
||
|
|
send(reply(request,"error","COMMAND","Unknown command"));return;
|
||
|
|
}
|
||
|
|
if(m_state["resource_busy"].toBool()||!m_active.isEmpty()){
|
||
|
|
send(reply(request,"error","BUSY","Vision resource is busy"));return;
|
||
|
|
}
|
||
|
|
m_active=request;m_terminal=false;m_dispatchPending=true;
|
||
|
|
send(reply(request,"accepted"));emit commandReceived(request);
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::setBackendState(const QJsonObject& state)
|
||
|
|
{
|
||
|
|
m_state=state;
|
||
|
|
if(!m_state["resource_busy"].toBool()&&m_terminal&&!m_dispatchPending)m_active={};
|
||
|
|
send(reply(QJsonObject{{"type","status"},{"request_id",""}},"ok"),false);
|
||
|
|
}
|
||
|
|
|
||
|
|
void VisionIpcServer::finish(const QJsonObject& result)
|
||
|
|
{
|
||
|
|
if(m_active.isEmpty()||result["request_id"]!=m_active["request_id"])return;
|
||
|
|
m_dispatchPending=false;
|
||
|
|
if(!m_terminal){
|
||
|
|
auto out=reply(m_active,result["status"].toString("error"));
|
||
|
|
for(auto it=result.begin();it!=result.end();++it)out[it.key()]=it.value();
|
||
|
|
out["server_session_id"]=m_session;out["protocol_version"]=1;
|
||
|
|
out["resource_busy"]=m_state["resource_busy"];
|
||
|
|
m_terminal=true;send(out);
|
||
|
|
}
|
||
|
|
if(!m_state["resource_busy"].toBool())m_active={};
|
||
|
|
}
|