|
|
@@ -4,6 +4,8 @@ using GSG.NET.ObjectBase;
|
|
|
using NetMQ;
|
|
|
using NetMQ.Monitoring;
|
|
|
using NetMQ.Sockets;
|
|
|
+using OHV.Common.Model;
|
|
|
+using OHV.Common.Shareds;
|
|
|
using System;
|
|
|
using System.Collections.Generic;
|
|
|
using System.Linq;
|
|
|
@@ -12,12 +14,13 @@ using System.Threading.Tasks;
|
|
|
|
|
|
namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
{
|
|
|
- public class ZmqManager : SingletonBase<ZmqManager>, IDisposable
|
|
|
+ public class ZmqManager : ControlObjectBase, IDisposable
|
|
|
{
|
|
|
Logger logger = Logger.GetLogger();
|
|
|
|
|
|
SubscriberSocket sub = null;
|
|
|
RequestSocket req = null;
|
|
|
+ ResponseSocket rep = null;
|
|
|
|
|
|
NetMQPoller poller = null;
|
|
|
NetMQMonitor monitor = null;
|
|
|
@@ -32,42 +35,62 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
set { isReqConnected = value; }
|
|
|
}
|
|
|
|
|
|
+ #region Properties
|
|
|
+ private eSteeringState requestSteering;
|
|
|
|
|
|
- private ZmqManager()
|
|
|
+ public eSteeringState RequestSteering
|
|
|
{
|
|
|
- NetMQ.NetMQConfig.Cleanup();
|
|
|
+ get { return requestSteering; }
|
|
|
+ set { SetField(ref this.requestSteering, value); }
|
|
|
}
|
|
|
|
|
|
- public void Init()
|
|
|
+ private bool isDriveMoving;
|
|
|
+
|
|
|
+ public bool IsDriveMoving
|
|
|
{
|
|
|
+ get { return isDriveMoving; }
|
|
|
+ set { SetField(ref isDriveMoving, value); }
|
|
|
+ }
|
|
|
+
|
|
|
+ private eRoadForm currentLoadForm;
|
|
|
+
|
|
|
+ public eRoadForm CurrentLoadForm
|
|
|
+ {
|
|
|
+ get { return currentLoadForm; }
|
|
|
+ set { SetField(ref currentLoadForm, value); }
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+
|
|
|
+ #endregion
|
|
|
|
|
|
+ public ZmqManager()
|
|
|
+ {
|
|
|
+ NetMQ.NetMQConfig.Cleanup();
|
|
|
}
|
|
|
|
|
|
- public void CrateClientSocket()
|
|
|
+ public void Init()
|
|
|
{
|
|
|
- //pub = new PublisherSocket();
|
|
|
- //pub.Bind( "tcp://127.0.0.1:5565" );
|
|
|
+ rep = new ResponseSocket();
|
|
|
+ rep.Bind( "tcp://127.0.0.1:5568" );
|
|
|
+ rep.ReceiveReady += Rep_ReceiveReady;
|
|
|
|
|
|
sub = new SubscriberSocket();
|
|
|
sub.Connect( "tcp://127.0.0.1:5565" );
|
|
|
sub.Connect( "tcp://127.0.0.1:5566" );
|
|
|
sub.Subscribe( "" ); //All
|
|
|
-
|
|
|
sub.ReceiveReady += Sub_ReceiveReady;
|
|
|
|
|
|
req = new RequestSocket();
|
|
|
this.monitor = new NetMQMonitor( req, "inproc://rep.inproc", SocketEvents.Disconnected | SocketEvents.Connected );
|
|
|
this.monitor.Connected += ( s, a ) => { this.IsReqConnected = true; };
|
|
|
this.monitor.Disconnected += ( s, a ) => { this.IsReqConnected = false; };
|
|
|
-
|
|
|
this.monitor.StartAsync();
|
|
|
|
|
|
req.Connect( "tcp://127.0.0.1:5567" );
|
|
|
|
|
|
- this.poller = new NetMQPoller { this.sub };
|
|
|
+ this.poller = new NetMQPoller { this.sub, this.rep };
|
|
|
this.poller.RunAsync();
|
|
|
-
|
|
|
- //this.threadCancel.AddGo( Th_SubPoller );
|
|
|
}
|
|
|
|
|
|
public void Dispose()
|
|
|
@@ -84,9 +107,80 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
this.req.Dispose();
|
|
|
}
|
|
|
|
|
|
+ private void Rep_ReceiveReady( object sender, NetMQSocketEventArgs e )
|
|
|
+ {
|
|
|
+ var ret = e.Socket.ReceiveMultipartStrings();
|
|
|
+ logger.D( $"[rep] - {ret}" );
|
|
|
+
|
|
|
+ if ( ret[0].Equals( "3050" ) )
|
|
|
+ {
|
|
|
+ switch ( ret[1] )
|
|
|
+ {
|
|
|
+ case "1":
|
|
|
+ this.RequestSteering = eSteeringState.Left;
|
|
|
+ break;
|
|
|
+ case "-1":
|
|
|
+ this.RequestSteering = eSteeringState.Right;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ this.RequestSteering = eSteeringState.None;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ rep.SendMoreFrame( "3050" ).SendFrame( "OK" );
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ rep.SendFrameEmpty();
|
|
|
+ }
|
|
|
+
|
|
|
private void Sub_ReceiveReady( object sender, NetMQ.NetMQSocketEventArgs e )
|
|
|
{
|
|
|
- logger.I( e.Socket.ReceiveMultipartStrings() );
|
|
|
+ var ret = e.Socket.ReceiveMultipartStrings();
|
|
|
+ logger.I( ret );
|
|
|
+
|
|
|
+ switch ( ret[0] )
|
|
|
+ {
|
|
|
+ case "3050": //TargetSteering
|
|
|
+ {
|
|
|
+ //switch ( ret[1] )
|
|
|
+ //{
|
|
|
+ // case "1":
|
|
|
+ // this.RequestSteering = eSteeringState.Left;
|
|
|
+ // break;
|
|
|
+ // case "-1":
|
|
|
+ // this.RequestSteering = eSteeringState.Right;
|
|
|
+ // break;
|
|
|
+ // default:
|
|
|
+ // this.RequestSteering = eSteeringState.None;
|
|
|
+ // break;
|
|
|
+ //}
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ case "111": //0=StartUp, 1=DeviceOpened, 2=DiviceOpenFailed, 3=ManualOP, 4=AutomaticOp, 5=DeviceCloseed, 6=Finished
|
|
|
+ break;
|
|
|
+
|
|
|
+ case "3010": //진행중의 길의 모양, 0이면 정지 상태
|
|
|
+ {
|
|
|
+ var v = ret[1].Split( ';' );
|
|
|
+ switch ( v[0] )
|
|
|
+ {
|
|
|
+ case "1":
|
|
|
+ //this.RequestSteering = eSteeringState.Left;
|
|
|
+ break;
|
|
|
+ case "-1":
|
|
|
+ //this.RequestSteering = eSteeringState.Right;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ //this.RequestSteering = eSteeringState.None;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ break;
|
|
|
+
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
void Th_SubPoller()
|
|
|
@@ -105,54 +199,41 @@ namespace VehicleControlSystem.ControlLayer.MQ
|
|
|
}
|
|
|
}
|
|
|
|
|
|
- public string Request( string topic )
|
|
|
+ bool Request( string topic, string value, out string response )
|
|
|
{
|
|
|
- //if ( this.req.TrySendFrame( topic ) )
|
|
|
- //{
|
|
|
- // return string.Empty;
|
|
|
- //}
|
|
|
- if ( this.IsReqConnected )
|
|
|
- {
|
|
|
+ List<string> repll = new List<string>();
|
|
|
+ response = string.Empty;
|
|
|
|
|
|
- }
|
|
|
- if ( this.req.HasOut )
|
|
|
- {
|
|
|
- this.req.SendFrame( topic );
|
|
|
- }
|
|
|
+ if ( !this.IsReqConnected )
|
|
|
+ return false;
|
|
|
|
|
|
- string outStr = string.Empty;
|
|
|
- if ( this.req.TryReceiveFrameString( TimeSpan.FromSeconds( 5 ), out outStr ) )
|
|
|
- {
|
|
|
- var s = outStr;
|
|
|
- }
|
|
|
+ if ( !this.req.HasIn )
|
|
|
+ this.req.SendMoreFrame( topic ).SendFrame( value );
|
|
|
+
|
|
|
+ if ( this.req.TryReceiveMultipartStrings( TimeSpan.FromSeconds( 5 ), ref repll ) )
|
|
|
+ return true;
|
|
|
else
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ internal void SetCurrentSteeringState( eSteeringState state )
|
|
|
+ {
|
|
|
+ string outStr = string.Empty;
|
|
|
+ bool ret = false;
|
|
|
+ switch ( state )
|
|
|
{
|
|
|
- this.req.Disconnect( "tcp://127.0.0.1:5567" );
|
|
|
- this.req.Dispose();
|
|
|
- this.req = null;
|
|
|
- LockUtils.Wait( 100 );
|
|
|
- this.req = new RequestSocket();
|
|
|
- this.req.Connect( "tcp://127.0.0.1:5567" );
|
|
|
- return string.Empty;
|
|
|
+ case eSteeringState.None:
|
|
|
+ ret = this.Request( "set", "3060/0/0", out outStr );
|
|
|
+ break;
|
|
|
+ case eSteeringState.Left:
|
|
|
+ ret = this.Request( "set", "3060/0/1", out outStr );
|
|
|
+ break;
|
|
|
+ case eSteeringState.Right:
|
|
|
+ ret = this.Request( "set", "3060/0/-1", out outStr );
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
}
|
|
|
-
|
|
|
- //var msg = this.req.ReceiveFrameString();
|
|
|
-
|
|
|
- //if ( this.req.HasIn )
|
|
|
- //{
|
|
|
- // if ( this.req.TryReceiveFrameString( TimeSpan.FromSeconds( 5 ), out outStr ) )
|
|
|
- // {
|
|
|
- // var s = outStr;
|
|
|
- // }
|
|
|
- //}
|
|
|
-
|
|
|
- //if ( this.req.Poll( TimeSpan.FromSeconds( 5 ) ) )
|
|
|
- //{
|
|
|
- // return this.req.ReceiveFrameString();
|
|
|
- //}
|
|
|
- //else
|
|
|
- return string.Empty;
|
|
|
}
|
|
|
-
|
|
|
}
|
|
|
}
|