DissolveMoveOperate.cs 4.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110
  1. using System;
  2. using SHJX.Service.Model.Control;
  3. using SHJX.Service.Control.Modules;
  4. using SHJX.Service.Control.Interface;
  5. using System.Threading.Tasks;
  6. using SHJX.Service.Common.ReadXML;
  7. using System.Collections.Generic;
  8. namespace SHJX.Service.Control.Route.RouteController
  9. {
  10. /// <summary>
  11. /// 消解位移动
  12. /// </summary>
  13. public class DissolveMoveOperate : FlowControlOperateImp
  14. {
  15. private const string Name = "DissolvePosition";
  16. private const string OpName = "Dissolve";
  17. public virtual bool Operate(ReadConfigUtil config, DataEventArgs data)
  18. {
  19. var clearPos = Name.GetEquipmentState();
  20. var portArgs = new PortArgs
  21. {
  22. ManualOrAuto = "Auto",
  23. TypeName = OpName,
  24. Distance = -DataCentre.GetConfig.GetPositionDistance("Dissolve")
  25. };
  26. switch (data.Task.RouteStep)
  27. {
  28. case "Clear_In":
  29. MotorSpeed itemSpeed = config.GetSpeed[0];
  30. itemSpeed.Speed = 6;
  31. SetSpeed(itemSpeed);
  32. itemSpeed = config.GetSpeed[1];
  33. itemSpeed.Speed = 6;
  34. SetSpeed(itemSpeed);
  35. List<string> names = new() { "MotorZ", "MotorX", "MotorY" };
  36. names.ForEach(async item =>
  37. {
  38. var res = await XYZGoBack(item);
  39. });
  40. itemSpeed = config.GetSpeed[0];
  41. SetSpeed(itemSpeed);
  42. itemSpeed = config.GetSpeed[1];
  43. SetSpeed(itemSpeed);
  44. portArgs.WriteWay = WriteWay.Normotopia;
  45. if (clearPos.EquipmentState.Equals(EquipmentEnum.Normotopia))
  46. {
  47. clearPos.EquipmentState = EquipmentEnum.Antiposition;
  48. }
  49. break;
  50. case "Clear_Out":
  51. MotorSpeed itemSpeed1 = config.GetSpeed[0];
  52. itemSpeed1.Speed = 6;
  53. SetSpeed(itemSpeed1);
  54. itemSpeed1 = config.GetSpeed[1];
  55. itemSpeed1.Speed = 6;
  56. SetSpeed(itemSpeed1);
  57. List<string> names1 = new() { "MotorZ", "MotorX", "MotorY" };
  58. names1.ForEach(async item =>
  59. {
  60. var res = await XYZGoBack(item);
  61. });
  62. itemSpeed1 = config.GetSpeed[0];
  63. SetSpeed(itemSpeed1);
  64. itemSpeed1 = config.GetSpeed[1];
  65. SetSpeed(itemSpeed1);
  66. portArgs.WriteWay = WriteWay.Antiposition;
  67. if (clearPos.EquipmentState.Equals(EquipmentEnum.Antiposition))
  68. {
  69. clearPos.EquipmentState = EquipmentEnum.Normotopia;
  70. }
  71. break;
  72. default:
  73. throw new ArgumentNullException(data.Task.RouteStep);
  74. }
  75. var res = data.Client.Factory(OpName).Write(portArgs);
  76. data.DataManager.Update(clearPos);
  77. return res;
  78. }
  79. private async Task<bool> XYZGoBack(string name)
  80. {
  81. var portArgs = new PortArgs()
  82. {
  83. ReadWay = "OriginalPosition",
  84. TypeName = name,
  85. WriteWay = WriteWay.GoBack
  86. };
  87. var res= (bool)DataCentre.GetClient.Factory(name).Read(portArgs) || DataCentre.GetClient.Factory(name).Write(portArgs);
  88. name.UpdateMotorPoint();
  89. return res;
  90. }
  91. public bool SetSpeed(MotorSpeed speed)
  92. {
  93. #region 速度
  94. PortArgs speedArgs = new PortArgs()
  95. {
  96. TypeName = speed.NodeName,
  97. Distance = speed.Speed,
  98. WriteWay = WriteWay.Speed
  99. };
  100. var res = DataCentre.GetClient.Factory(speed.NodeName).Write(speedArgs);
  101. #endregion
  102. return res;
  103. }
  104. }
  105. }