fix problem in returning to home

This commit is contained in:
2018-11-15 16:37:54 +01:00
parent bf92632485
commit f2b7d27911
6 changed files with 47 additions and 49 deletions
+23 -33
View File
@@ -29,47 +29,37 @@ public class Serial {
public void send(int start, int a, int b, int c)
{
if (serialPort == null)
{
serialPort = new SerialPort(@"\\.\" + "COM10", 115200);
try
{
serialPort.Open();
serialPort.DiscardOutBuffer();
serialPort.DiscardInBuffer();
enabled = true;
}
catch
{
enabled = false;
}
}
if (enabled)
{
if (serialPort == null)
{
serialPort = new SerialPort(@"\\.\" + "COM10", 115200);
try
{
serialPort.Open();
serialPort.DiscardOutBuffer();
serialPort.DiscardInBuffer();
}
catch
{
enabled = false;
}
}
if (serialPort is SerialPort)
{
serialPort.Write(" #");
serialPort.Write(start.ToString());
serialPort.Write(" P");
serialPort.Write(a.ToString());
string send = " #" + start.ToString() + " P" + a.ToString();
start++;
serialPort.Write(" #");
serialPort.Write(start.ToString());
serialPort.Write(" P");
serialPort.Write(b.ToString());
send = send + " #" + start.ToString() + " P" + b.ToString();
start++;
send = send + " #" + start.ToString() + " P" + c.ToString();
serialPort.Write(" #");
serialPort.Write(start.ToString());
serialPort.Write(" P");
serialPort.Write(c.ToString());
send = send + " \r";
serialPort.Write(" \r");
serialPort.Write(send);
}
}
}