| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690 |
- using Newtonsoft.Json.Linq;
- using System;
- using System.Collections.Generic;
- using System.ComponentModel.Design;
- using System.Linq;
- using System.Reflection;
- using System.Text;
- using System.Threading.Tasks;
- using System.Windows.Input;
- using Team.FFFeederService.Enums;
- using Team.FFFeederService.Interfaces;
- using Team.FFFeederService.Models;
- using TouchSocket.Core;
- using TouchSocket.Sockets;
- namespace Team.FFFeederService
- {
- /// <summary>
- /// Feeder 参数读写控制
- /// </summary>
- public class TeamFeeder : IVoiceCoilMotorFeeder
- {
- #region 字段
- /// <summary>
- /// 背光打开命令
- /// </summary>
- private const string LightOpenCommand = "{K1}";
- /// <summary>
- /// 背光关闭命令
- /// </summary>
- private const string LightCloseCommand = "{K0}";
- /// <summary>
- /// 查询背光状态命令
- /// </summary>
- private const string QueryLightStateCommand = "{K?}";
- /// <summary>
- /// 平台振动参数起始地址
- /// </summary>
- private const int ShakeParamStartAddress = 300;
- /// <summary>
- /// 料斗振动参数起始地址
- /// </summary>
- private const int HopperParamStartAddress = 742;
- /// <summary>
- /// 序列参数起始地址
- /// </summary>
- private const int SequenceParamStartAddress = 950;
- private IWaitingClient<ITcpClient, IReceiverResult> WaitClient;
- private bool isFirstConnect = true;
- private Task bgConnectTask;
- #endregion
- #region 属性
- public FeederBrand FeederBrand { get => FeederBrand.TEAM; }
- public FeederModel FeederModel { get; private set; } = FeederModel.Unknown;
- public Guid Id { get; set; }
- /// <summary>
- /// Feeder连接状态
- /// </summary>
- public bool IsConnected => TcpClient.Online;
- /// <summary>
- /// Feeder是否首次连接成功
- /// </summary>
- public bool IsInit { get; private set; }
- /// <summary>
- /// Feeder IP地址
- /// </summary>
- public string FeederIp => TcpClient.IP;
- /// <summary>
- /// Feeder 端口
- /// </summary>
- public int FeederPort => TcpClient.Port;
- /// <summary>
- /// 接收数据的超时时间
- /// </summary>
- public int MillisecondsTimeout = 5000; //接收数据超时时间
- /// <summary>
- /// TCP客户端通讯
- /// </summary>
- public TcpClient TcpClient { get; }
- #endregion
- // private const string SelectOneShakeCommand = "{UV1}\r\n";
- #region 事件
- /// <summary>
- /// Feeder连接上时
- /// </summary>
- public event Action<Guid, ITcpClient, ConnectedEventArgs> FeederConnectedEvent;
- /// <summary>
- /// Feeder断开连接上时
- /// </summary>
- public event Action<Guid, ITcpClient, ClosedEventArgs> FeederDisconnectedEvent;
- #endregion
- public TeamFeeder(TcpClient tcpClient)
- {
- TcpClient = tcpClient;
- //调用CreateWaitingClient获取到IWaitingClient的对象。
- WaitClient = tcpClient.CreateWaitingClient(new WaitingOptions()
- {
- FilterFunc = response => //设置用于筛选的fun委托,当返回为true时,才会响应返回
- {
- return true;
- //if (response.Data.Length == 1)
- //{
- // return true;
- //}
- //return false;
- }
- });
- TcpClient.Connected = ConnectedVoid;
- TcpClient.Closed = DisconnectedVoid;
- }
- #region 方法
- #region Feeder 连接
- /// <summary>
- /// 连接Feeder
- /// </summary>
- public void Connect()
- {
- try
- {
- TcpClient.Connect();
- IsInit = true;
- isFirstConnect = false;
- }
- catch (Exception)
- {
- IsInit = false;
- if (bgConnectTask == null)
- {
- bgConnectTask = Task.Run(async () =>
- {
- while (true)
- {
- try
- {
- TcpClient.Connect();
- isFirstConnect = false;
- return;
- }
- catch (Exception)
- {
- await Task.Delay(1000);
- }
- }
- });
- }
- throw;
- }
- }
- /// <summary>
- /// 连接Feeder
- /// </summary>
- /// <returns></returns>
- public async Task ConnectAsync()
- {
- try
- {
- await TcpClient.ConnectAsync();
- IsInit = true;
- isFirstConnect = false;
- }
- catch (Exception)
- {
- IsInit = false;
- if (bgConnectTask == null)
- {
- bgConnectTask = Task.Run(async () =>
- {
- while (true)
- {
- try
- {
- TcpClient.Connect();
- isFirstConnect = false;
- return;
- }
- catch (Exception)
- {
- await Task.Delay(1000);
- }
- }
- });
- }
- throw;
- }
- }
- #endregion
- public void Reset()
- {
- }
- public Task ResetAsync()
- {
- return Task.CompletedTask;
- }
- #region 振动集
- /// <summary>
- /// 选择使用振动集
- /// </summary>
- /// <param name="id"></param>
- /// <exception cref="FeederResponseException"></exception>
- public void SelectShakeParam(int id)
- {
- var sendCommand = "{UV" + id + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- if (result.TrimEnd() != sendCommand.TrimEnd())
- {
- throw new Exception("FFFeeder响应不正确");
- }
- }
- /// <summary>
- /// 选择使用振动集
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- /// <exception cref="FeederResponseException"></exception>
- public async Task SelectShakeParamAsync(int id)
- {
- var sendCommand = "{UV" + id + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- if (result.TrimEnd() != sendCommand.TrimEnd())
- {
- throw new Exception("FFFeeder响应不正确");
- }
- }
- /// <summary>
- /// 将振动集参数存储至非易失内存中
- /// </summary>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public async Task SaveShakeSetAsync()
- {
- string sendCommand = "{DV}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- if (result.TrimEnd() != sendCommand.TrimEnd())
- {
- throw new Exception("FFFeeder响应不正确");
- }
- }
- /// <summary>
- /// 查询当前选择的振动集
- /// </summary>
- /// <returns></returns>
- public int GetSelectedShakeParam()
- {
- const string sendCommand = "{UV?}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return int.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 查询当前选择的振动集
- /// </summary>
- /// <returns></returns>
- public async Task<int> GetSelectedShakeParamAsync()
- {
- const string sendCommand = "{UV?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return int.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- #endregion
- #region 平台振动参数
- //300~741
- //300 A 平台振动 A 振幅 1
- //301 A 平台振动 A 频率 1
- //302 A 平台振动 A 相位 1
- //303 A 平台振动 A 波形 1
- //304 A 平台振动 A 振幅 2
- //305 A 平台振动 A 频率 2
- //306 A 平台振动 A 相位 2
- //307 A 平台振动 A 波形 2
- //308 A 平台振动 A 振幅 3
- //309 A 平台振动 A 频率 3
- //310 A 平台振动 A 相位 3
- //311 A 平台振动 A 波形 3
- //312 A 平台振动 A 振幅 4
- //313 A 平台振动 A 频率 4
- //314 A 平台振动 A 相位 4
- //315 A 平台振动 A 波形 4
- //316 A 平台振动 A 持续时间
- //300+17*n
- /// <summary>
- /// 选择要使用的振动集(1~26)
- /// </summary>
- /// <param name="v"></param>
- /// <returns></returns>
- public bool LoadShakeSet(int v)
- {
- var command = "{UV" + v + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- return result == command;
- }
- /// <summary>
- /// 选择要使用的振动集(1~26)
- /// </summary>
- /// <param name="v"></param>
- /// <returns></returns>
- public async Task<bool> LoadShakeSetAsync(int v)
- {
- var command = "{UV" + v + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- return result == command;
- }
- /// <summary>
- /// 执行平台振动
- /// </summary>
- /// <param name="index"></param>
- /// <param name="timespan"></param>
- public async Task<int> StartAction(int index, int? timespan = null)
- {
- if (index < 0 || index > 25)
- {
- index = 0;
- }
- char chn = (char)('A' + index);
- string actionCommand = $"C{chn}";
- return await RunFromCommand(actionCommand, timespan);
- }
- /// <summary>
- /// 停止平台振动
- /// </summary>
- public void Stop()
- {
- WaitClient.SendThenReturn(Encoding.ASCII.GetBytes("{HC}"), MillisecondsTimeout);
- }
- /// <summary>
- /// 停止平台振动
- /// </summary>
- /// <returns></returns>
- public Task StopAsync()
- {
- return WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes("{HC}"), MillisecondsTimeout);
- }
- /// <summary>
- /// 向前
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToLeftAsync(int? timespan = null)
- {
- var command = "{CA" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CA", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 左前
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToBottomLeftAsync(int? timespan = null)
- {
- var command = "{CB" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CB", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 右前
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToTopLeftAsync(int? timespan = null)
- {
- var command = "{CC" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CC", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 向左
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToBottomAsync(int? timespan = null)
- {
- var command = "{CD" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CD", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 向右
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToTopAsync(int? timespan = null)
- {
- var command = "{CE" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CE", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 向后
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToRightAsync(int? timespan = null)
- {
- var command = "{CF" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CF", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 左后
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToBottomRightAsync(int? timespan = null)
- {
- var command = "{CG" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CG", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 右后
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToTopRightAsync(int? timespan = null)
- {
- var command = "{CH" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CH", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 散开
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToFlipAsync(int? timespan = null)
- {
- var command = "{CI" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CI", "");
- return string.IsNullOrEmpty(timeSpan) ? 0 : int.Parse(timeSpan);
- }
- /// <summary>
- /// 横向聚中
- /// </summary>
- /// <param name="timespan">持续时间</param>
- /// <returns></returns>
- public async Task<int> RunToInnerVerticalAsync(int? timespan = null)
- {
- var command = "{CJ" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CJ", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 纵向聚中
- /// </summary>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunToInnerHorizonAsync(int? timespan = null)
- {
- var command = "{CK" + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("CK", "");
- if (string.IsNullOrEmpty(timeSpan))
- {
- return 0;
- }
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 读一个振动动作值
- /// </summary>
- /// <param name="v"></param>
- /// <returns></returns>
- public SingleActionParam GetShakeGroupValue(int index)
- {
- if (index < 0 || index > 25)
- {
- index = 0;
- }
- return GetShakeGroupValueAsync(index).GetAwaiter().GetResult();
- }
- /// <summary>
- /// 读一个振动动作值
- /// </summary>
- /// <param name="index"></param>
- /// <returns></returns>
- public async Task<SingleActionParam> GetShakeGroupValueAsync(int index)
- {
- var results = new string[17];
- for (var j = 0; j < 17; j++)
- {
- var id = index * 17 + ShakeParamStartAddress + j;
- var command = "{RP" + id + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- results[j] = result.TrimEnd().Replace("{RP", "").Replace("}", "").Split(":")[1];
- }
- int i = 0;
- SingleActionParam actionParam=new SingleActionParam();
- actionParam.Motor1 = new VoiceMotorParam() { Amplitude = ushort.Parse(results[i]), Frequency= ushort.Parse(results[i+1]), Phase = ushort.Parse(results[i + 2]), WaveShape= (WaveShape)ushort.Parse(results[i + 3]) };
- i = 4;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(results[i]), Frequency = ushort.Parse(results[i + 1]), Phase = ushort.Parse(results[i + 2]), WaveShape = (WaveShape)ushort.Parse(results[i + 3]) };
- i = 8;
- actionParam.Motor3 = new VoiceMotorParam() { Amplitude = ushort.Parse(results[i]), Frequency = ushort.Parse(results[i + 1]), Phase = ushort.Parse(results[i + 2]), WaveShape = (WaveShape)ushort.Parse(results[i + 3]) };
- i = 12;
- actionParam.Motor4 = new VoiceMotorParam() { Amplitude = ushort.Parse(results[i]), Frequency = ushort.Parse(results[i + 1]), Phase = ushort.Parse(results[i + 2]), WaveShape = (WaveShape)ushort.Parse(results[i + 3]) };
- actionParam.DurationValue = int.Parse(results[16]);
- return actionParam;
- }
- /// <summary>
- /// 获取单个动作持续时间
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- public int GetDuration(int id)
- {
- var idInServer = id * 17 + 316;
- var command = "{RP" + idInServer + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var value = result.TrimEnd().Replace("{RP", "").Replace("}", "").Split(':')[1];
- return int.Parse(value);
- }
- /// <summary>
- /// 获取单个动作持续时间
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- public async Task<int> GetDurationAsync(int id)
- {
- var idInServer = id * 17 + 316;
- var command = "{RP" + idInServer + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var value = result.TrimEnd().Replace("{RP", "").Replace("}", "").Split(':')[1];
- return int.Parse(value);
- }
- /// <summary>
- /// 写入振动单个参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <param name="id"></param>
- /// <param name="value"></param>
- /// <returns></returns>
- public async Task SetShakeParametersAsync(int selectedShakeMotion, int id, string value)
- {
- var commandId = 300 + selectedShakeMotion * 17 + id;
- var command = "{WP" + $"{commandId}={value}" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- //string result = Encoding.ASCII.GetString(returnData);
- }
- /// <summary>
- /// 写入振动单个参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <param name="id"></param>
- /// <param name="value"></param>
- public void SetShakeParameters(int selectedShakeMotion, int id, string value)
- {
- var commandId = 300 + selectedShakeMotion * 17 + id;
- var command = "{WP" + $"{commandId}={value}" + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- }
- /// <summary>
- /// 写入平台振动完成参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <param name="value"></param>
- /// <returns></returns>
- public async Task SetShakeParametersAsync(int selectedShakeMotion, string value)
- {
- if (selectedShakeMotion < 0 || selectedShakeMotion > 15)
- selectedShakeMotion = 0;
- char chn = (char)('A' + selectedShakeMotion);
- var command = "{SC" + $"{chn}=" + $"({value})" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- }
- /// <summary>
- /// 写入平台振动完成参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <param name="value"></param>
- public void SetShakeParameters(int selectedShakeMotion, string value)
- {
- if (selectedShakeMotion < 0 || selectedShakeMotion > 15)
- selectedShakeMotion = 0;
- char chn = (char)('A' + selectedShakeMotion);
- var command = "{SC" + $"{chn}=" + $"({value})" + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- }
- /// <summary>
- /// 写入完整的平台振动参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <param name="value"></param>
- public void SetShakeParameters(int selectedShakeMotion, SingleActionParam value)
- {
- StringBuilder sb = new StringBuilder();
- sb.Append($"{value.Motor1.Amplitude};{value.Motor1.Frequency};{value.Motor1.Phase};{(int)value.Motor1.WaveShape};");
- sb.Append($"{value.Motor2.Amplitude};{value.Motor2.Frequency};{value.Motor2.Phase};{(int)value.Motor2.WaveShape};");
- sb.Append($"{value.Motor3.Amplitude};{value.Motor3.Frequency};{value.Motor3.Phase};{(int)value.Motor3.WaveShape};");
- sb.Append($"{value.Motor4.Amplitude};{value.Motor4.Frequency};{value.Motor4.Phase};{(int)value.Motor4.WaveShape};");
- sb.Append($"{value.DurationValue}");
- SetShakeParameters(selectedShakeMotion, sb.ToString());
- }
- /// <summary>
- /// 写入完整的平台振动参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <param name="value"></param>
- /// <returns></returns>
- public async Task SetShakeParametersAsync(int selectedShakeMotion, SingleActionParam value)
- {
- StringBuilder sb = new StringBuilder();
- sb.Append($"{value.Motor1.Amplitude};{value.Motor1.Frequency};{value.Motor1.Phase};{(int)value.Motor1.WaveShape};");
- sb.Append($"{value.Motor2.Amplitude};{value.Motor2.Frequency};{value.Motor2.Phase};{(int)value.Motor2.WaveShape};");
- sb.Append($"{value.Motor3.Amplitude};{value.Motor3.Frequency};{value.Motor3.Phase};{(int)value.Motor3.WaveShape};");
- sb.Append($"{value.Motor4.Amplitude};{value.Motor4.Frequency};{value.Motor4.Phase};{(int)value.Motor4.WaveShape};");
- sb.Append($"{value.DurationValue}");
- await SetShakeParametersAsync(selectedShakeMotion, sb.ToString());
- }
- /// <summary>
- /// 获取完整的平台振动参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <returns></returns>
- public SingleActionParam GetShakeParameters(int selectedShakeMotion)
- {
- if (selectedShakeMotion < 0 || selectedShakeMotion > 15)
- selectedShakeMotion = 0;
- char chn = (char)('A' + selectedShakeMotion);
- var command = "{LC" + $"{chn}" + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace($"LC{chn}", "").Replace("(", "").Replace(")", "").Replace(":", "").Split(";");
- int i = 0;
- SingleActionParam actionParam = new SingleActionParam();
- actionParam.Motor1 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- i = 4;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- i = 8;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- i = 12;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- actionParam.DurationValue = int.Parse(timeSpan[16]);
- return actionParam;
- }
- /// <summary>
- /// 获取完整的平台振动参数
- /// </summary>
- /// <param name="selectedShakeMotion"></param>
- /// <returns></returns>
- public async Task<SingleActionParam> GetShakeParametersAsync(int selectedShakeMotion)
- {
- if (selectedShakeMotion < 0 || selectedShakeMotion > 15)
- selectedShakeMotion = 0;
- char chn = (char)('A' + selectedShakeMotion);
- var command = "{LC" + $"{chn}" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace($"LC{chn}", "").Replace("(", "").Replace(")", "").Replace(":", "").Split(";");
- int i = 0;
- SingleActionParam actionParam = new SingleActionParam();
- actionParam.Motor1 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- i = 4;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- i = 8;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- i = 12;
- actionParam.Motor2 = new VoiceMotorParam() { Amplitude = ushort.Parse(timeSpan[i]), Frequency = ushort.Parse(timeSpan[i + 1]), Phase = ushort.Parse(timeSpan[i + 2]), WaveShape = (WaveShape)ushort.Parse(timeSpan[i + 3]) };
- actionParam.DurationValue = int.Parse(timeSpan[16]);
- return actionParam;
- }
- /// <summary>
- /// 获取平台震动超时时间
- /// </summary>
- /// <returns></returns>
- public async Task<ushort> GetPlatShakeTimeoutAsync()
- {
- const string sendCommand = "{RP65?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return ushort.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 设置平台震动超时时间
- /// </summary>
- /// <param name="upperFeederShakeTimeout"></param>
- /// <returns></returns>
- public async Task SetPlatShakeTimeoutAsync(ushort upperFeederShakeTimeout)
- {
- const int commandId = 65;
- var command = "{WP" + $"{commandId}={upperFeederShakeTimeout}" + "}";
- var result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- //const string saveCommand = "{DG}";
- //var result1 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- }
- #endregion
- #region 料斗振动输出参数
- //742~949
- //742+8*n n 料斗动作 n 数字量输出 1
- //743+8*n n 料斗动作 n 模拟量输出 1
- //744+8*n n 料斗动作 n 数字量输出 2
- //745+8*n n 料斗动作 n 模拟量输出 2
- //746+8*n n 备用
- //747+8*n n 备用
- //748+8*n n 备用
- //749+8*n n 料斗振动 n 持续时间
- /// <summary>
- /// 执行料斗供料
- /// </summary>
- /// <returns></returns>
- public async Task<int> ShakeUpAsync()
- {
- const string sendCommand = "{EF:(A;55;110)}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return ushort.Parse(result.TrimEnd().Split(';')[1].Replace("}", "").Replace(")", ""));
- }
- /// <summary>
- /// 执行供料
- /// </summary>
- /// <returns></returns>
- public int ShakeUp()
- {
- const string sendCommand = "{EF:(A;55;110)}";
- var result = Encoding.ASCII.GetString(WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(sendCommand)));
- return ushort.Parse(result.TrimEnd().Split(';')[1].Replace("}", "").Replace(")", ""));
- }
- /// <summary>
- /// 停止料斗振动
- /// </summary>
- /// <returns></returns>
- public Task StopOutputAsync()
- {
- const string command = "{HB}";
- return WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- }
- /// <summary>
- /// 停止料斗振动
- /// </summary>
- public void StopOutput()
- {
- const string command = "{HB}";
- WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- }
- /// <summary>
- /// 获取料斗参数
- /// </summary>
- /// <param name="selectedSequence"></param>
- /// <returns></returns>
- public async Task<HopperFeederParam> GetUpperParamAsync(int selectedSequence)
- {
- var param = new HopperFeederParam();
- var startIndex = 742 + selectedSequence * 8;
- var collections = new string[8];
- for (var i = 0; i < 8; i++)
- {
- var id = startIndex + i;
- var result = await GetSingleParamValueAsync(id);
- collections[i] = result.Replace("{", "").Replace("}", "").Split(':')[1];
- }
- param.HopperDigitalOutput1 = int.Parse(collections[0]) == 1;
- param.HopperAnalogOutput1 = int.Parse(collections[1]);
- param.HopperDigitalOutput2 = int.Parse(collections[2]) == 1;
- param.HopperAnalogOutput2 = int.Parse(collections[3]);
- param.HopperVibrationAmpl = int.Parse(collections[4]);
- param.HopperVibrationFreq = int.Parse(collections[5]);
- param.HopperVibrationWaveform = int.Parse(collections[6]);
- param.HopperDuration = int.Parse(collections[7]);
- return param;
- //return ushort.Parse(result.Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 写入输出参数
- /// </summary>
- /// <param name="groupId"></param>
- /// <param name="param"></param>
- /// <returns></returns>
- public async Task WriteOutputParamAsync(int groupId, HopperFeederParam param)
- {
- const int startId = 742;
- var id1 = startId + groupId * 8;
- var id2 = startId + groupId * 8 + 1;
- var id3 = startId + groupId * 8 + 2;
- var id4 = startId + groupId * 8 + 3;
- var id5 = startId + groupId * 8 + 7;
- var command1 = "{WP" + $"{id1}={Convert.ToInt32(param.HopperDigitalOutput1)}" + "}";
- var command2 = "{WP" + $"{id2}={Convert.ToInt32(param.HopperAnalogOutput1)}" + "}";
- var command3 = "{WP" + $"{id3}={Convert.ToInt32(param.HopperDigitalOutput2)}" + "}";
- var command4 = "{WP" + $"{id4}={Convert.ToInt32(param.HopperAnalogOutput2)}" + "}";
- var command5 = "{WP" + $"{id5}={Convert.ToInt32(param.HopperDuration)}" + "}";
- var result1 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command1));
- var result2 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command2));
- var result3 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command3));
- var result4 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command4));
- var result5 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command5));
- await SaveShakeSetAsync();
- }
- /// <summary>
- /// 获取料斗震动超时时间
- /// </summary>
- /// <returns></returns>
- public async Task<ushort> GetUpperFeederShakeTimeoutAsync()
- {
- const string sendCommand = "{RP66?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return ushort.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 设置料斗震动超时时间
- /// </summary>
- /// <param name="upperFeederShakeTimeout"></param>
- /// <returns></returns>
- public async Task SetUpperFeederShakeTimeoutAsync(ushort upperFeederShakeTimeout)
- {
- const int commandId = 66;
- var command = "{WP" + $"{commandId}={upperFeederShakeTimeout}" + "}";
- var result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- //const string saveCommand = "{DG}";
- //var result1 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- }
- /// <summary>
- /// 执行料斗动作
- /// </summary>
- /// <param name="id"></param>
- /// <param name="timespan"></param>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public async Task<int> OutputAsync(int id, int? timespan = null)
- {
- if (id < 1 || id > 26)
- {
- throw new Exception("输入参数不正确");
- }
- var enumerable = Enumerable.Range('A', 26).ToArray();
- //var split = new[] { "A", "B" };
- var outPut = "B" + (char)enumerable[id - 1];
- var command = "{" + outPut + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace(outPut, "");
- return string.IsNullOrWhiteSpace(timeSpan) ? 0 : int.Parse(timeSpan);
- }
- /// <summary>
- /// 执行料斗动作
- /// </summary>
- /// <param name="id"></param>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public int Output(int id, int? timespan = null)
- {
- var enumerable = Enumerable.Range('A', 26).ToArray();
- //var split = new[] { "A", "B" };
- var outPut = "B" + (char)enumerable[id - 1];
- var command = "{" + outPut + timespan + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace(outPut, "");
- return int.Parse(timeSpan);
- }
- /// <summary>
- /// 获取取料斗动作状态
- /// </summary>
- /// <returns></returns>
- public bool GetOutputStatus()
- {
- const string sendCommand = "{RP97?}";
- var result = Encoding.ASCII.GetString(WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(sendCommand)));
- return result.Split(':')[1].Replace("}", "") == "0" ? false : true;
- }
- /// <summary>
- ///获取取料斗动作状态
- /// </summary>
- /// <returns></returns>
- public async Task<bool> GetOutputStatusAsync()
- {
- const string sendCommand = "{RP97?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return result.Split(':')[1].Replace("}", "") == "0" ? false : true;
- }
- #endregion
- #region 序列动作参数
- //950~1703
- //950+29*n n 动作 1 类型
- //951+29*n n 动作 1 震动
- //952+29*n n 动作 1 持续模式
- //953+29*n n 动作 1 持续时间值
- //954+29*n n 动作 2 类型
- //955+29*n n 动作 2 震动
- //956+29*n n 动作 2 持续模式
- //957+29*n n 动作 2 持续时间值
- //958+29*n n 动作 3 类型
- //959+29*n n 动作 3 震动
- //960+29*n n 动作 3 持续模式
- //961+29*n n 动作 3 持续时间值
- //962+29*n n 动作 4 类型
- //963+29*n n 动作 4 震动
- //964+29*n n 动作 4 持续模式
- //965+29*n n 动作 4 持续时间值
- //966+29*n n 动作 5 类型
- //967+29*n n 动作 5 震动
- //968+29*n n 动作 5 持续模式
- //969+29*n n 动作 5 持续时间值
- //970+29*n n 动作 6 类型
- //971+29*n n 动作 6 震动
- //972+29*n n 动作 6 持续模式
- //973+29*n n 动作 6 持续时间值
- //974+29*n n 动作 7 类型
- //975+29*n n 动作 7 震动
- //976+29*n n 动作 7 持续模式
- //977+29*n n 动作 7 持续时间值
- //978+29*n n 震动平台零件极限值
- /// <summary>
- /// 停止序列
- /// </summary>
- /// <returns></returns>
- public async Task StopOneSequenceAsync()
- {
- var sendCommand = "{HS}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- //string result = Encoding.ASCII.GetString(returnData);
- }
- /// <summary>
- /// 执行一个序列
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- public async Task<int> StartOneSequenceAsync(int id)
- {
- var sendCommand = "{ES:(0;0;0;0;" + id + ")}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- var replaced = result.TrimEnd().Replace("{", "").Replace("}", "").Replace("(", "").Replace(")", "");
- var splits = replaced.Split(';');
- return int.Parse(splits[5]);
- //#if NETCOREAPP
- // var time = int.Parse(splits[^1]);
- // return time;
- //#elif NET472||NETSTANDARD
- // var time = int.Parse(splits[splits.Length - 1]);
- // return time;
- //#endif
- }
- /// <summary>
- /// 获取单个序列集
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- public async Task<SingleSequenceActionGroup> GetSequenceGroupAsync(int id)
- {
- const int startId = SequenceParamStartAddress;
- var singleSequenceActionGroup = new SingleSequenceActionGroup();
- singleSequenceActionGroup.SingleSequenceActions = new System.Collections.ObjectModel.ObservableCollection<SingleSequenceAction>();
- for (var i = 0; i < 7; i++)
- {
- var singleSequenceAction = new SingleSequenceAction();
- var value1 = await GetSingleParamValueAsync(startId + id * 29 + i * 4);
- var value2 = await GetSingleParamValueAsync(startId + id * 29 + i * 4 + 1);
- var value3 = await GetSingleParamValueAsync(startId + id * 29 + i * 4 + 2);
- var value4 = await GetSingleParamValueAsync(startId + id * 29 + i * 4 + 3);
- value1 = value1.Replace("{", "");
- value1 = value1.Replace("}", "").Split(':')[1];
- value2 = value2.Replace("{", "");
- value2 = value2.Replace("}", "").Split(':')[1];
- value3 = value3.Replace("{", "");
- value3 = value3.Replace("}", "").Split(':')[1];
- value4 = value4.Replace("{", "");
- value4 = value4.Replace("}", "").Split(':')[1];
- singleSequenceAction.Type = (ActionType)int.Parse(value1);
- singleSequenceAction.ShakeId = int.Parse(value2) > 0 ? int.Parse(value2) : 0;
- singleSequenceAction.DurationMode = (DurationMode)int.Parse(value3);
- singleSequenceAction.DurationValue = int.Parse(value4);
- singleSequenceActionGroup.SingleSequenceActions.Add(singleSequenceAction);
- }
- var value5 = await GetSingleParamValueAsync(startId + id * 29 + 28);
- value5 = value5.Replace("{", "");
- value5 = value5.Replace("}", "").Split(':')[1];
- singleSequenceActionGroup.PartCntMax = int.Parse(value5);
- return singleSequenceActionGroup;
- }
- /// <summary>
- /// 写入序列参数
- /// </summary>
- /// <param name="groupId"></param>
- /// <param name="singleSequenceAction"></param>
- public void SetSequence(int groupId, int actionId, SingleSequenceAction singleSequenceAction)
- {
- const int startId = SequenceParamStartAddress;
- var id1 = startId + groupId * 29 + actionId * 4;
- var id2 = startId + groupId * 29 + actionId * 4 + 1;
- var id3 = startId + groupId * 29 + actionId * 4 + 2;
- var id4 = startId + groupId * 29 + actionId * 4 + 3;
- var command1 = "{WP" + $"{id1}={(int)singleSequenceAction.Type}" + "}";
- var command2 = "{WP" + $"{id1}={singleSequenceAction.ShakeId}" + "}";
- var command3 = "{WP" + $"{id1}={(int)singleSequenceAction.DurationMode}" + "}";
- var command4 = "{WP" + $"{id1}={(int)singleSequenceAction.DurationValue}" + "}";
- var result = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command1));
- result = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command2));
- result = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command3));
- result = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command4));
- }
- /// <summary>
- /// 写入序列参数
- /// </summary>
- /// <param name="groupId"></param>
- /// <param name="actionId"></param>
- /// <param name="singleSequenceAction"></param>
- /// <returns></returns>
- public async Task SetSequenceAsync(int groupId, int actionId, SingleSequenceAction singleSequenceAction)
- {
- const int startId = 950;
- var id1 = startId + groupId * 29 + actionId * 4;
- var id2 = startId + groupId * 29 + actionId * 4 + 1;
- var id3 = startId + groupId * 29 + actionId * 4 + 2;
- var id4 = startId + groupId * 29 + actionId * 4 + 3;
- var command1 = "{WP" + $"{id1}={(int)singleSequenceAction.Type}" + "}";
- var command2 = "{WP" + $"{id2}={singleSequenceAction.ShakeId}" + "}";
- var command3 = "{WP" + $"{id3}={(int)singleSequenceAction.DurationMode}" + "}";
- var command4 = "{WP" + $"{id4}={singleSequenceAction.DurationValue}" + "}";
- var result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command1));
- result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command2));
- result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command3));
- result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command4));
- }
- /// <summary>
- /// 将序列参数存储至非易失内存中
- /// </summary>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public async Task SaveSequenceAsync()
- {
- const string sendCommand = "{DS}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- if (result.TrimEnd() != sendCommand.TrimEnd())
- {
- throw new Exception("FFFeeder响应不正确");
- }
- }
- /// <summary>
- /// 查询当前选择的序列
- /// </summary>
- /// <returns></returns>
- public int GetSelectedSequence()
- {
- const string sendCommand = "{US?}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return int.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 查询当前选择的序列
- /// </summary>
- /// <returns></returns>
- public async Task<int> GetSelectedSequenceAsync()
- {
- const string sendCommand = "{US?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return int.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- #endregion
- #region 背光灯操作
- /// <summary>
- /// 背光灯打开
- /// </summary>
- public void OpenLight()
- {
- WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(LightOpenCommand), MillisecondsTimeout);
- }
- /// <summary>
- /// 背光灯打开
- /// </summary>
- /// <returns></returns>
- public Task OpenLightAsync()
- {
- return WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(LightOpenCommand), MillisecondsTimeout);
- }
- /// <summary>
- /// 背光关闭
- /// </summary>
- public void CloseLight()
- {
- WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(LightCloseCommand), MillisecondsTimeout);
- }
- /// <summary>
- /// 背光关闭
- /// </summary>
- /// <returns></returns>
- public Task CloseLightAsync()
- {
- return WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(LightCloseCommand), MillisecondsTimeout);
- }
- /// <summary>
- /// 设置背光打开超时时间
- /// </summary>
- /// <param name="timeout"></param>
- public void SetLightTimeOut(ushort timeout)
- {
- var commandId = 44;
- var command = "{WP" + $"{commandId}={timeout}" + "}";
- var result = Encoding.ASCII.GetString(WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command)));
- //var saveCommand = "{DG}";
- //var result1 = Encoding.ASCII.GetString(WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(saveCommand)));
- }
- /// <summary>
- /// 设置背光打开超时时间
- /// </summary>
- /// <param name="timeout"></param>
- /// <returns></returns>
- public async Task SetLightTimeOutAsync(ushort timeout)
- {
- var commandId = 44;
- var command = "{WP" + $"{commandId}={timeout}" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- //var saveCommand = "{DG}";
- //returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- }
- /// <summary>
- /// 获取背光打开超时时间
- /// </summary>
- /// <returns></returns>
- public ushort GetLightTimeout()
- {
- const string sendCommand = "{RP44?}";
- var result = Encoding.ASCII.GetString(WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(sendCommand)));
- return ushort.Parse(result.Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 获取背光打开超时时间
- /// </summary>
- /// <returns></returns>
- public async Task<ushort> GetLightTimeoutAsync()
- {
- const string sendCommand = "{RP44?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return ushort.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 设置背光亮度
- /// </summary>
- /// <param name="lightValue"></param>
- /// <returns></returns>
- public async Task SetLightValueAsync(ushort lightValue)
- {
- const int commandId = 34;
- var command = "{WP" + $"{commandId}={lightValue}" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- //const string saveCommand = "{DG}";
- //returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- //result = Encoding.ASCII.GetString(returnData);
- }
- /// <summary>
- /// 设置背光亮度
- /// </summary>
- /// <param name="lightValue"></param>
- /// <returns></returns>
- public async Task SetLightValueToBufferAsync(ushort lightValue)
- {
- const int commandId = 34;
- var command = "{WP" + $"{commandId}={lightValue}" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- //string result = Encoding.ASCII.GetString(returnData);
- }
- /// <summary>
- /// 设置背光闪烁时间
- /// </summary>
- /// <param name="backLightFlash"></param>
- /// <returns></returns>
- public async Task SetBackLightFlashTimeAsync(ushort backLightFlash)
- {
- const int commandId = 33;
- var command = "{WP" + $"{commandId}={backLightFlash}" + "}";
- var result = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- //const string saveCommand = "{DG}";
- //var result1 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- }
- /// <summary>
- /// 获取背光状态
- /// </summary>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public bool QueryLightState()
- {
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(QueryLightStateCommand));
- string result = Encoding.ASCII.GetString(returnData);
- result = result.Trim().Replace("{", "").Replace("}", "");
- var splitsStrings = result.Split(':');
- if (splitsStrings.Length <= 1)
- {
- throw new Exception("RECEIVED DATA NOT CORRECT");
- }
- return splitsStrings[1] == "1";
- }
- /// <summary>
- /// 获取背光状态
- /// </summary>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public async Task<bool> QueryLightStateAsync()
- {
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(QueryLightStateCommand));
- string result = Encoding.ASCII.GetString(returnData);
- result = result.Trim().Replace("{", "").Replace("}", "");
- var splitsStrings = result.Split(':');
- if (splitsStrings.Length <= 1)
- {
- throw new Exception("RECEIVED DATA NOT CORRECT");
- }
- return splitsStrings[1] == "1";
- }
- /// <summary>
- /// 获取背光亮度
- /// </summary>
- /// <returns></returns>
- public async Task<ushort> GetLightBrightnessAsync()
- {
- const string sendCommand = "{RP34?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return ushort.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- /// <summary>
- /// 获取背光闪烁时间
- /// </summary>
- /// <returns></returns>
- public async Task<ushort> GetBackLightFlashTimeAsync()
- {
- const string sendCommand = "{RP33?}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- return ushort.Parse(result.TrimEnd().Split(':')[1].Replace("}", ""));
- }
- #endregion
- /// <summary>
- /// 执行命令
- /// </summary>
- /// <param name="command"></param>
- /// <param name="timespan"></param>
- /// <returns></returns>
- public async Task<int> RunFromCommand(string command, int? timespan = null)
- {
- var exeCommand = "{" + command + timespan + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(exeCommand));
- string result = Encoding.ASCII.GetString(returnData);
- var timeSpan = result.TrimEnd().Replace("{", "").Replace("}", "").Replace(command, "");
- return string.IsNullOrEmpty(timeSpan) ? 0 : int.Parse(timeSpan);
- }
- /// <summary>
- /// 读单个参数值
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- public string GetSingleParamValue(int id)
- {
- var command = "{RP" + id + "}";
- var returnData = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- return result;
- }
- /// <summary>
- /// 读单个参数值
- /// </summary>
- /// <param name="id"></param>
- /// <returns></returns>
- public async Task<string> GetSingleParamValueAsync(int id)
- {
- var command = "{RP" + id + "}";
- var returnData =await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- return result.TrimEnd();
- }
- /// <summary>
- /// 设置IP地址
- /// </summary>
- /// <param name="ip"></param>
- /// <param name="subNetMask"></param>
- /// <param name="port"></param>
- /// <returns></returns>
- public async Task SetIpAddressAsync(string ip, string subNetMask, int port)
- {
- var ipSplits = ip.Split('.');
- var subNetMaskSplits = subNetMask.Split('.');
- var list = ipSplits.ToList();
- list.AddRange(subNetMaskSplits);
- list.Add(port.ToString());
- var commandId = 13;
- foreach (var command in list.Select(item => "{WP" + $"{commandId}={item}" + "}"))
- {
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- string result = Encoding.ASCII.GetString(returnData);
- commandId++;
- }
- string saveCommand = "{DF}";
- var returnData1 = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- string result1 = Encoding.ASCII.GetString(returnData1);
- saveCommand = "{DG}";
- returnData1 = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(saveCommand));
- result1 = Encoding.ASCII.GetString(returnData1);
- }
- /// <summary>
- /// 设置IP地址
- /// </summary>
- /// <param name="ip"></param>
- /// <param name="subNetMask"></param>
- /// <param name="port"></param>
- public void SetIpAddress(string ip, string subNetMask, int port)
- {
- var ipSplits = ip.Split('.');
- var subNetMaskSplits = subNetMask.Split('.');
- var list = ipSplits.ToList();
- list.AddRange(subNetMaskSplits);
- list.Add(port.ToString());
- var commandId = 13;
- foreach (var result in list.Select(item => "{WP" + $"{commandId}={item}" + "}")
- .Select(command => Encoding.ASCII.GetString(WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(command)))))
- {
- commandId++;
- }
- const string saveCommand = "{DG}";
- var result1 = WaitClient.SendThenReturn(Encoding.ASCII.GetBytes(saveCommand));
- }
- /// <summary>
- /// 获取输入触发参数
- /// </summary>
- /// <param name="i"></param>
- /// <returns></returns>
- /// <exception cref="IndexOutOfRangeException"></exception>
- public async Task<int> GetInputTrigger(int i)
- {
- if (i > 2 || i < 0)
- {
- throw new IndexOutOfRangeException("输入的参数id{i}超出了索引");
- }
- var param = await GetSingleParamValueAsync(40 + i - 1);
- var value1 = param.Replace("{", "");
- value1 = value1.Replace("}", "").Split(':')[1];
- return int.Parse(value1);
- }
- /// <summary>
- /// 设置输入触发参数
- /// </summary>
- /// <param name="id"></param>
- /// <param name="value"></param>
- /// <returns></returns>
- /// <exception cref="IndexOutOfRangeException"></exception>
- public async Task SetInputTrigger(int id, int value)
- {
- if (id > 2 || id < 0)
- {
- throw new IndexOutOfRangeException("输入的参数id{i}超出了索引");
- }
- var commandId = 39 + id;
- var command = "{WP" + $"{commandId}={value}" + "}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(command));
- //const string saveCommand = "{DG}";
- //returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(saveCommand));
- }
- /// <summary>
- /// 将所有参数存储至非易失内存中
- /// </summary>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public async Task SaveAllSetAsync()
- {
- string sendCommand = "{DF}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- if (result.TrimEnd() != sendCommand.TrimEnd())
- {
- throw new Exception("FFFeeder响应不正确");
- }
- }
- /// <summary>
- /// 将全局参数存储至非易失内存中
- /// </summary>
- /// <returns></returns>
- /// <exception cref="Exception"></exception>
- public async Task SaveGlobalSetAsync()
- {
- string sendCommand = "{DG}";
- var returnData = await WaitClient.SendThenReturnAsync(Encoding.ASCII.GetBytes(sendCommand));
- string result = Encoding.ASCII.GetString(returnData);
- if (result.TrimEnd() != sendCommand.TrimEnd())
- {
- throw new Exception("FFFeeder响应不正确");
- }
- }
- #endregion
- /// <summary>
- /// 断开连接,释放资源
- /// </summary>
- public void Dispose()
- {
- TcpClient.Close();
- TcpClient.Dispose();
- }
- /// <summary>
- /// 成功连接到服务器
- /// </summary>
- /// <param name="client"></param>
- /// <param name="e"></param>
- /// <returns></returns>
- private Task ConnectedVoid(ITcpClient client, ConnectedEventArgs e)
- {
- FeederConnectedEvent?.Invoke(this.Id, client,e);
- FeederModel = GetFeederModel();
- //Console.WriteLine($"{client.RemoteIPHost.EndPoint.ToString()}已连接!");
- return EasyTask.CompletedTask;
- }
- /// <summary>
- /// 从服务器断开连接,当连接不成功时不会触发。
- /// </summary>
- /// <param name="client"></param>
- /// <param name="e"></param>
- /// <returns></returns>
- private Task DisconnectedVoid(ITcpClient client, ClosedEventArgs e)
- {
- FeederDisconnectedEvent?.Invoke(this.Id, client,e);
- //Console.WriteLine($"{client.IP}断开连接!");
- return EasyTask.CompletedTask;
- }
- /// <summary>
- /// 获取Feeder型号
- /// </summary>
- /// <returns></returns>
- public FeederModel GetFeederModel()
- {
- try
- {
- string res = GetSingleParamValue(30);
- if (int.TryParse(res,out int model))
- {
- switch (model)
- {
- case 120:
- return FeederModel.FF120;
- case 240:
- return FeederModel.FF240;
- case 380:
- return FeederModel.FF380;
- case 530:
- return FeederModel.FF530;
- default:
- return FeederModel.Unknown;
- }
- }
- else
- {
- return FeederModel.Unknown;
- }
- }
- catch (Exception)
- {
- return FeederModel.Unknown;
- }
- }
- /// <summary>
- /// 获取Feeder型号
- /// </summary>
- /// <returns></returns>
- public async Task<FeederModel> GetFeederModelAsync()
- {
- try
- {
- string res =await GetSingleParamValueAsync(30);
- if (int.TryParse(res, out int model))
- {
- switch (model)
- {
- case 120:
- return FeederModel.FF120;
- case 240:
- return FeederModel.FF240;
- case 380:
- return FeederModel.FF380;
- case 530:
- return FeederModel.FF530;
- default:
- return FeederModel.Unknown;
- }
- }
- else
- {
- return FeederModel.Unknown;
- }
- }
- catch (Exception)
- {
- return FeederModel.Unknown;
- }
- }
- }
- }
|