private async Task Send()
{
SendHighPriorityItems();
if (!_isOnHold)
{
if (Mode == OperatingMode.SendingGCodeFile &&
_toSend.Count == 0 &&
Settings.ControllerBufferSize - Math.Max(0, UnacknowledgedBytesSent) > 24)
{
var nextCommand = GCodeFileManager.GetNextJobItem();
if (nextCommand != null)
{
TransmitJobItem(nextCommand);
}
}
else if (ShouldSendNormalPriorityItems())
{
SendNormalPriorityItems();
}
else
{
await QueryStatus();
}
}
}
public void ShouldNotSendNextLineIfBufferSpaceNotAvailable()
{
var mgr = new GCodeFileManager(_machine.Object, _logger.Object, _toolChangeManager.Object);
mgr.SetGCode(GCodeSampleFile.GCODE_FILE);
_machine.Setup(mac => mac.HasBufferSpaceAvailableForByteCount(It.IsAny <int>())).Returns(false);
mgr.GetNextJobItem();
_machine.Verify(mac => mac.SendJobCommand(It.IsAny <GCodeCommand>()), Times.Never);
}
public void SetFile(GCodeFile file)
{
GCodeFileManager.SetFile(file);
}
private void ParseMessage(string fullMessageLine)
{
fullMessageLine = fullMessageLine.ToLower();
Debug.WriteLine(fullMessageLine);
if (fullMessageLine.StartsWith("ok") ||
fullMessageLine.StartsWith("<ok:"))
{
if (GCodeFileManager.HasValidFile && Mode == OperatingMode.SendingGCodeFile)
{
lock (this)
{
GCodeFileManager.CommandAcknowledged();
lock (_queueAccessLocker)
{
if (_sentQueue.Any())
{
var sentLine = _sentQueue.Dequeue();
UnacknowledgedBytesSent -= (sentLine.Length + 1);
}
}
if (GCodeFileManager.IsCompleted)
{
Mode = OperatingMode.Manual;
}
}
}
else
{
lock (_queueAccessLocker)
{
if (PendingQueue.Count > 0)
{
if (Settings.MachineType == FirmwareTypes.Repeteir_PnP)
{
Services.DispatcherServices.Invoke(() =>
{
PendingQueue.RemoveAt(0);
});
}
else
{
var responseRegEx = new Regex("<ok:(?'CODE'[A-Za-z0-9]+).*>");
var responseGCode = responseRegEx.Match(fullMessageLine);
if (responseGCode.Success)
{
var code = responseGCode.Groups["CODE"].Value;
if (PendingQueue[0].StartsWith(code.ToUpper()))
{
Debug.WriteLine($"MATCH =D -> TOP ITEM {PendingQueue[0]} - {code} ");
Services.DispatcherServices.Invoke(() =>
{
PendingQueue.RemoveAt(0);
});
}
else
{
Debug.WriteLine($"MISMATCH :( -> TOP ITEM {PendingQueue[0]} - {code} ");
}
}
}
}
if (_sentQueue.Any())
{
var sentLine = _sentQueue.Dequeue();
UnacknowledgedBytesSent -= (sentLine.Length + 1);
return;
}
}
LagoVista.Core.PlatformSupport.Services.Logger.Log(LagoVista.Core.PlatformSupport.LogLevel.Warning, "Machine_Work", "Received OK without anything in the Sent Buffer");
UnacknowledgedBytesSent = 0;
}
}
else if (fullMessageLine != null)
{
if (fullMessageLine == "wait")
{
if (_isOnHold)
{
Debug.WriteLine("RECOVERREDDD!");
}
_isOnHold = false;
}
else if (fullMessageLine.StartsWith("error:"))
{
var errorline = _sentQueue.Any() ? _sentQueue.Dequeue() : "?????";
var errNumbRegEx = new Regex("error:(?'ErrorCode'-?[0-9\\.]*)?");
var errMatch = errNumbRegEx.Match(fullMessageLine);
if (errMatch.Success)
{
var strErrorCode = errMatch.Groups["ErrorCode"].Value;
var err = GrblErrorProvider.Instance.GetErrorMessage(Convert.ToInt32(strErrorCode));
AddStatusMessage(StatusMessageTypes.Warning, err, MessageVerbosityLevels.Normal);
}
else
{
AddStatusMessage(StatusMessageTypes.Warning, $"{fullMessageLine}: {errorline}", MessageVerbosityLevels.Normal);
}
if (_sentQueue.Count != 0)
{
var sentLine = _sentQueue.Dequeue();
UnacknowledgedBytesSent -= sentLine.Length + 1;
}
else
{
if ((DateTime.Now - _connectTime).TotalMilliseconds > 200)
{
AddStatusMessage(StatusMessageTypes.Warning, $"Received <{fullMessageLine}> without anything in the Sent Buffer", MessageVerbosityLevels.Normal);
}
UnacknowledgedBytesSent = 0;
}
Mode = OperatingMode.Manual;
}
else if (fullMessageLine.StartsWith("<"))
{
if (Settings.MachineType == FirmwareTypes.LagoVista || Settings.MachineType == FirmwareTypes.LagoVista_PnP)
{
if (ParseLagoVistaLine(fullMessageLine))
{
AddStatusMessage(StatusMessageTypes.ReceivedLine, fullMessageLine, MessageVerbosityLevels.Diagnostics);
}
}
else if (ParseStatus(fullMessageLine))
{
AddStatusMessage(StatusMessageTypes.ReceivedLine, fullMessageLine, MessageVerbosityLevels.Diagnostics);
}
else if (ParseLine(fullMessageLine))
{
AddStatusMessage(StatusMessageTypes.ReceivedLine, fullMessageLine, MessageVerbosityLevels.Diagnostics);
}
else
{
AddStatusMessage(StatusMessageTypes.ReceivedLine, fullMessageLine);
}
}
else if (fullMessageLine.StartsWith("[prb:"))
{
var probeResult = ProbingManager.ParseProbeLine(fullMessageLine);
if (probeResult != null)
{
switch (Mode)
{
case OperatingMode.ProbingHeight:
ProbingManager.ProbeCompleted(probeResult.Value);
break;
case OperatingMode.ProbingHeightMap:
HeightMapManager.ProbeCompleted(probeResult.Value);
break;
default:
AddStatusMessage(StatusMessageTypes.Warning, "Unexpected PRB return message.");
break;
}
}
}
else if (fullMessageLine.StartsWith("["))
{
UpdateStatus(fullMessageLine);
AddStatusMessage(StatusMessageTypes.ReceivedLine, fullMessageLine);
}
else if (fullMessageLine.StartsWith("ALARM"))
{
AddStatusMessage(StatusMessageTypes.FatalError, fullMessageLine);
Mode = OperatingMode.Manual;
}
else if (fullMessageLine.Length > 0)
{
if (!ParseLine(fullMessageLine))
{
AddStatusMessage(StatusMessageTypes.ReceivedLine, fullMessageLine);
}
/*
* Not sure why we would dequeue if we couldn't parse the line...may need to revisit *
* lock (_queueAccessLocker)
* {
* if (_sentQueue.Any())
* {
* var sentLine = _sentQueue.Dequeue();
* UnacknowledgedBytesSent -= (sentLine.Length + 1);
* }
* }*/
}
}
else
{
AddStatusMessage(StatusMessageTypes.Warning, $"Empty Response From Machine.", MessageVerbosityLevels.Normal);
}
}
