mirror of https://github.com/ArduPilot/ardupilot
89 lines
2.8 KiB
C#
89 lines
2.8 KiB
C#
using System;
|
|
using System.Collections.Generic;
|
|
using System.Text;
|
|
using System.IO.Ports;
|
|
using System.IO;
|
|
using System.Linq;
|
|
|
|
namespace ArdupilotMega
|
|
{
|
|
class SerialPort : System.IO.Ports.SerialPort,ICommsSerial
|
|
{
|
|
public new void Open()
|
|
{
|
|
if (base.IsOpen)
|
|
return;
|
|
|
|
base.Open();
|
|
}
|
|
|
|
public void toggleDTR()
|
|
{
|
|
bool open = this.IsOpen;
|
|
|
|
if (!open)
|
|
this.Open();
|
|
|
|
base.DtrEnable = false;
|
|
base.RtsEnable = false;
|
|
|
|
System.Threading.Thread.Sleep(50);
|
|
|
|
base.DtrEnable = true;
|
|
base.RtsEnable = true;
|
|
|
|
System.Threading.Thread.Sleep(50);
|
|
|
|
if (!open)
|
|
this.Close();
|
|
}
|
|
|
|
public new static string[] GetPortNames()
|
|
{
|
|
string[] monoDevs = new string[0];
|
|
|
|
if (Directory.Exists("/dev/"))
|
|
{
|
|
if (Directory.Exists("/dev/serial/by-id/"))
|
|
monoDevs = Directory.GetFiles("/dev/serial/by-id/", "*");
|
|
monoDevs = Directory.GetFiles("/dev/", "*ACM*");
|
|
monoDevs = Directory.GetFiles("/dev/", "ttyUSB*");
|
|
}
|
|
|
|
string[] ports = System.IO.Ports.SerialPort.GetPortNames()
|
|
.Select(p => p.TrimEnd())
|
|
.Select(FixBlueToothPortNameBug)
|
|
.ToArray();
|
|
|
|
string[] allPorts = new string[monoDevs.Length + ports.Length];
|
|
|
|
monoDevs.CopyTo(allPorts, 0);
|
|
ports.CopyTo(allPorts, monoDevs.Length);
|
|
|
|
return allPorts;
|
|
}
|
|
|
|
|
|
// .NET bug: sometimes bluetooth ports are enumerated with bogus characters
|
|
// eg 'COM10' becomes 'COM10c' - one workaround is to remove the non numeric
|
|
// char. Annoyingly, sometimes a numeric char is added, which means this
|
|
// does not work in all cases.
|
|
// See http://connect.microsoft.com/VisualStudio/feedback/details/236183/system-io-ports-serialport-getportnames-error-with-bluetooth
|
|
private static string FixBlueToothPortNameBug(string portName)
|
|
{
|
|
if (!portName.StartsWith("COM"))
|
|
return portName;
|
|
var newPortName = "COM"; // Start over with "COM"
|
|
foreach (var portChar in portName.Substring(3).ToCharArray()) // Remove "COM", put the rest in a character array
|
|
{
|
|
if (char.IsDigit(portChar))
|
|
newPortName += portChar.ToString(); // Good character, append to portName
|
|
// else
|
|
//log.WarnFormat("Bad (Non Numeric) character in port name '{0}' - removing", portName);
|
|
}
|
|
|
|
return newPortName;
|
|
}
|
|
}
|
|
}
|