fix problem in returning to home
This commit is contained in:
+23
-33
@@ -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);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user