private void BUT_savesettings_Click(object sender, EventArgs e)
{
ICommsSerial comPort = new SerialPort();
try
{
comPort.PortName = MainV2.comPort.BaseStream.PortName;
comPort.BaudRate = MainV2.comPort.BaseStream.BaudRate;
comPort.ReadTimeout = 4000;
comPort.Open();
}
catch { CustomMessageBox.Show("Invalid ComPort or in use"); return; }
lbl_status.Text = "Connecting";
if (doConnect(comPort))
{
// cleanup
doCommand(comPort, "AT&T");
comPort.DiscardInBuffer();
lbl_status.Text = "Doing Command";
if (RTI.Text != "")
{
// remote
string answer = doCommand(comPort, "RTI5");
string[] items = answer.Split('\n');
foreach (string item in items)
{
if (item.StartsWith("S"))
{
string[] values = item.Split(':', '=');
if (values.Length == 3)
{
Control[] controls = this.Controls.Find("R" + values[0].Trim(), true);
if (controls.Length > 0)
{
if (controls[0].GetType() == typeof(CheckBox))
{
string value = ((CheckBox)controls[0]).Checked ? "1" : "0";
if (value != values[2].Trim())
{
string cmdanswer = doCommand(comPort, "RT" + values[0].Trim() + "=" + value + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else
{
if (controls[0] is TextBox)
{
}
else
{
if (((ComboBox)controls[0]).SelectedValue != null)
{
if (((ComboBox)controls[0]).SelectedValue.ToString() != values[2].Trim())
{
string cmdanswer = doCommand(comPort, "RT" + values[0].Trim() + "=" + ((ComboBox)controls[0]).SelectedValue + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else if (controls[0].Text != values[2].Trim() && controls[0].Text != "")
{
string cmdanswer = doCommand(comPort, "RT" + values[0].Trim() + "=" + controls[0].Text + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
}
}
}
else
{
// bad ?ti5 line
}
}
}
// write it
doCommand(comPort, "RT&W");
// return to normal mode
doCommand(comPort, "RTZ");
Sleep(100);
}
comPort.DiscardInBuffer();
{
//local
string answer = doCommand(comPort, "ATI5");
string[] items = answer.Split('\n');
foreach (string item in items)
{
if (item.StartsWith("S"))
{
string[] values = item.Split(':', '=');
if (values.Length == 3)
{
Control[] controls = this.Controls.Find(values[0].Trim(), true);
if (controls.Length > 0)
{
if (controls[0].GetType() == typeof(CheckBox))
{
string value = ((CheckBox)controls[0]).Checked ? "1" : "0";
if (value != values[2].Trim())
{
string cmdanswer = doCommand(comPort, "AT" + values[0].Trim() + "=" + value + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else
{
if (controls[0] is TextBox)
{
}
else
{
if (((ComboBox)controls[0]).SelectedValue != null)
{
if (((ComboBox)controls[0]).SelectedValue.ToString() != values[2].Trim())
{
string cmdanswer = doCommand(comPort, "AT" + values[0].Trim() + "=" + ((ComboBox)controls[0]).SelectedValue + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else if (controls[0].Text != values[2].Trim() && controls[0].Text != "")
{
string cmdanswer = doCommand(comPort, "AT" + values[0].Trim() + "=" + controls[0].Text + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
}
}
}
}
}
// write it
doCommand(comPort, "AT&W");
// return to normal mode
doCommand(comPort, "ATZ");
}
lbl_status.Text = "Done";
}
else
{
// return to normal mode
doCommand(comPort, "ATZ");
lbl_status.Text = "Fail";
CustomMessageBox.Show("Failed to enter command mode");
}
comPort.Close();
}
private void BUT_getcurrent_Click(object sender, EventArgs e)
{
ICommsSerial comPort = new SerialPort();
try
{
comPort.PortName = MainV2.comPort.BaseStream.PortName;
comPort.BaudRate = MainV2.comPort.BaseStream.BaudRate;
comPort.ReadTimeout = 4000;
comPort.Open();
}
catch { CustomMessageBox.Show("Invalid ComPort or in use"); return; }
lbl_status.Text = "Connecting";
if (doConnect(comPort))
{
// cleanup
doCommand(comPort, "AT&T");
comPort.DiscardInBuffer();
lbl_status.Text = "Doing Command ATI & RTI";
ATI.Text = doCommand(comPort, "ATI");
RTI.Text = doCommand(comPort, "RTI");
uploader.Uploader.Frequency freq = (uploader.Uploader.Frequency)Enum.Parse(typeof(uploader.Uploader.Frequency), doCommand(comPort, "ATI3"));
uploader.Uploader.Board board = (uploader.Uploader.Board)Enum.Parse(typeof(uploader.Uploader.Board), doCommand(comPort, "ATI2"));
ATI3.Text = freq.ToString();
ATI2.Text = board.ToString();
try
{
RTI2.Text = ((uploader.Uploader.Board)Enum.Parse(typeof(uploader.Uploader.Board), doCommand(comPort, "RTI2"))).ToString();
}
catch { }
// 8 and 9
if (freq == uploader.Uploader.Frequency.FREQ_915)
{
S8.DataSource = Range(895000, 1000, 935000);
RS8.DataSource = Range(895000, 1000, 935000);
S9.DataSource = Range(895000, 1000, 935000);
RS9.DataSource = Range(895000, 1000, 935000);
}
else if (freq == uploader.Uploader.Frequency.FREQ_433)
{
S8.DataSource = Range(414000, 100, 454000);
RS8.DataSource = Range(414000, 100, 454000);
S9.DataSource = Range(414000, 100, 454000);
RS9.DataSource = Range(414000, 100, 454000);
}
else if (freq == uploader.Uploader.Frequency.FREQ_868)
{
S8.DataSource = Range(849000, 1000, 889000);
RS8.DataSource = Range(849000, 1000, 889000);
S9.DataSource = Range(849000, 1000, 889000);
RS9.DataSource = Range(849000, 1000, 889000);
}
if (board == uploader.Uploader.Board.DEVICE_ID_RFD900 || board == uploader.Uploader.Board.DEVICE_ID_RFD900A)
{
S4.DataSource = Range(1, 1, 30);
RS4.DataSource = Range(1, 1, 30);
}
RSSI.Text = doCommand(comPort, "ATI7").Trim();
lbl_status.Text = "Doing Command ATI5";
string answer = doCommand(comPort, "ATI5");
string[] items = answer.Split('\n');
foreach (string item in items)
{
if (item.StartsWith("S"))
{
string[] values = item.Split(':', '=');
if (values.Length == 3)
{
Control[] controls = this.Controls.Find(values[0].Trim(), true);
if (controls.Length > 0)
{
controls[0].Enabled = true;
if (controls[0] is CheckBox)
{
((CheckBox)controls[0]).Checked = values[2].Trim() == "1";
}
else if (controls[0] is TextBox)
{
((TextBox)controls[0]).Text = values[2].Trim();
}
else if (controls[0].Name.Contains("S6")) //
{
var ans = Enum.Parse(typeof(mavlink_option), values[2].Trim());
((ComboBox)controls[0]).Text = ans.ToString();
}
else if (controls[0] is ComboBox)
{
((ComboBox)controls[0]).Text = values[2].Trim();
}
}
}
}
}
// remote
foreach (Control ctl in groupBox2.Controls)
{
if (ctl.Name.StartsWith("RS") && ctl.Name != "RSSI")
ctl.ResetText();
}
comPort.DiscardInBuffer();
lbl_status.Text = "Doing Command RTI5";
answer = doCommand(comPort, "RTI5");
items = answer.Split('\n');
foreach (string item in items)
{
if (item.StartsWith("S"))
{
string[] values = item.Split(':', '=');
if (values.Length == 3)
{
Control[] controls = this.Controls.Find("R" + values[0].Trim(), true);
if (controls.Length == 0)
continue;
controls[0].Enabled = true;
if (controls[0] is CheckBox)
{
((CheckBox)controls[0]).Checked = values[2].Trim() == "1";
}
else if (controls[0] is TextBox)
{
((TextBox)controls[0]).Text = values[2].Trim();
}
else if (controls[0].Name.Contains("S6")) //
{
var ans = Enum.Parse(typeof(mavlink_option), values[2].Trim());
((ComboBox)controls[0]).Text = ans.ToString();
}
else if (controls[0] is ComboBox)
{
((ComboBox)controls[0]).Text = values[2].Trim();
}
}
else
{
/*
if (item.Contains("S15"))
{
answer = doCommand(comPort, "RTS15?");
int rts15 = 0;
if (int.TryParse(answer, out rts15))
{
RS15.Enabled = true;
RS15.Text = rts15.ToString();
}
}
*/
log.Info("Odd config line :" + item);
}
}
}
// off hook
doCommand(comPort, "ATO");
lbl_status.Text = "Done";
}
else
{
// off hook
doCommand(comPort, "ATO");
lbl_status.Text = "Fail";
CustomMessageBox.Show("Failed to enter command mode");
}
comPort.Close();
BUT_Syncoptions.Enabled = true;
BUT_savesettings.Enabled = true;
}
private void BUT_resettodefault_Click(object sender, EventArgs e)
{
ICommsSerial comPort = new SerialPort();
try
{
comPort.PortName = MainV2.comPort.BaseStream.PortName;
comPort.BaudRate = MainV2.comPort.BaseStream.BaudRate;
comPort.ReadTimeout = 4000;
comPort.Open();
}
catch { CustomMessageBox.Show("Invalid ComPort or in use"); return; }
lbl_status.Text = "Connecting";
if (doConnect(comPort))
{
// cleanup
doCommand(comPort, "AT&T");
comPort.DiscardInBuffer();
lbl_status.Text = "Doing Command ATI & AT&F";
doCommand(comPort, "AT&F");
doCommand(comPort, "AT&W");
lbl_status.Text = "Reset";
doCommand(comPort, "ATZ");
comPort.Close();
BUT_getcurrent_Click(sender, e);
}
else
{
// off hook
doCommand(comPort, "ATO");
lbl_status.Text = "Fail";
CustomMessageBox.Show("Failed to enter command mode");
}
if (comPort.IsOpen)
comPort.Close();
}
/// <summary>
/// Detects APM board version
/// </summary>
/// <param name="port"></param>
/// <returns> (1280/2560/2560-2/px4/px4v2)</returns>
public static boards DetectBoard(string port)
{
SerialPort serialPort = new SerialPort();
serialPort.PortName = port;
if (!MainV2.MONO)
{
ObjectQuery query = new ObjectQuery("SELECT * FROM Win32_SerialPort"); // Win32_USBControllerDevice
ManagementObjectSearcher searcher = new ManagementObjectSearcher(query);
foreach (ManagementObject obj2 in searcher.Get())
{
Console.WriteLine("PNPID: " + obj2.Properties["PNPDeviceID"].Value.ToString());
// check vid and pid
if (obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_2341&PID_0010"))
{
// check port name as well
if (obj2.Properties["Name"].Value.ToString().ToUpper().Contains(serialPort.PortName.ToUpper()))
{
log.Info("is a 2560-2");
return boards.b2560v2;
}
}
if (obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0010"))
{
// check port name as well
//if (obj2.Properties["Name"].Value.ToString().ToUpper().Contains(serialPort.PortName.ToUpper()))
{
log.Info("is a px4");
return boards.px4;
}
}
if (obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0011"))
{
log.Info("is a px4v2");
return boards.px4v2;
}
if (obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0001"))
{
log.Info("is a px4v2 bootloader");
return boards.px4v2;
}
if (obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0016"))
{
log.Info("is a px4v2 bootloader");
CustomMessageBox.Show("You appear to have a bootloader with a bad PID value, please update your bootloader.");
return boards.px4v2;
}
//|| obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0012") || obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0013") || obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0014") || obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0015") || obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_26AC&PID_0016")
}
}
else
{
// if its mono
if (DialogResult.Yes == CustomMessageBox.Show("Is this a APM 2+?", "APM 2+", MessageBoxButtons.YesNo))
{
return boards.b2560v2;
}
else
{
if (DialogResult.Yes == CustomMessageBox.Show("Is this a PX4/PIXHAWK?", "PX4/PIXHAWK", MessageBoxButtons.YesNo))
{
if (DialogResult.Yes == CustomMessageBox.Show("Is this a PIXHAWK?", "PIXHAWK", MessageBoxButtons.YesNo))
{
return boards.px4v2;
}
return boards.px4;
}
else
{
return boards.b2560;
}
}
}
if (serialPort.IsOpen)
serialPort.Close();
serialPort.DtrEnable = true;
serialPort.BaudRate = 57600;
serialPort.Open();
Thread.Sleep(100);
int a = 0;
while (a < 20) // 20 * 50 = 1 sec
{
//Console.WriteLine("write " + DateTime.Now.Millisecond);
serialPort.DiscardInBuffer();
serialPort.Write(new byte[] { (byte)'0', (byte)' ' }, 0, 2);
a++;
Thread.Sleep(50);
//Console.WriteLine("btr {0}", serialPort.BytesToRead);
if (serialPort.BytesToRead >= 2)
{
byte b1 = (byte)serialPort.ReadByte();
byte b2 = (byte)serialPort.ReadByte();
if (b1 == 0x14 && b2 == 0x10)
{
serialPort.Close();
log.Info("is a 1280");
return boards.b1280;
}
}
}
serialPort.Close();
log.Warn("Not a 1280");
Thread.Sleep(500);
serialPort.DtrEnable = true;
serialPort.BaudRate = 115200;
serialPort.Open();
Thread.Sleep(100);
a = 0;
while (a < 4)
{
byte[] temp = new byte[] { 0x6, 0, 0, 0, 0 };
temp = BoardDetect.genstkv2packet(serialPort, temp);
a++;
Thread.Sleep(50);
try
{
if (temp[0] == 6 && temp[1] == 0 && temp.Length == 2)
{
serialPort.Close();
//HKEY_LOCAL_MACHINE\SYSTEM\CurrentControlSet\Enum\USB\VID_2341&PID_0010\640333439373519060F0\Device Parameters
if (!MainV2.MONO && !Thread.CurrentThread.CurrentCulture.IsChildOf(CultureInfoEx.GetCultureInfo("zh-Hans")))
{
ObjectQuery query = new ObjectQuery("SELECT * FROM Win32_SerialPort"); // Win32_USBControllerDevice
ManagementObjectSearcher searcher = new ManagementObjectSearcher(query);
foreach (ManagementObject obj2 in searcher.Get())
{
//Console.WriteLine("Dependant : " + obj2["Dependent"]);
// all apm 1-1.4 use a ftdi on the imu board.
/* obj2.Properties.ForEach(x =>
{
try
{
log.Info(((PropertyData)x).Name.ToString() + " = " + ((PropertyData)x).Value.ToString());
}
catch { }
});
*/
// check vid and pid
if (obj2.Properties["PNPDeviceID"].Value.ToString().Contains(@"USB\VID_2341&PID_0010"))
{
// check port name as well
if (obj2.Properties["Name"].Value.ToString().ToUpper().Contains(serialPort.PortName.ToUpper()))
{
log.Info("is a 2560-2");
return boards.b2560v2;
}
}
}
log.Info("is a 2560");
return boards.b2560;
}
}
}
catch { }
}
serialPort.Close();
log.Warn("Not a 2560");
if (DialogResult.Yes == CustomMessageBox.Show("Is this a APM 2+?", "APM 2+", MessageBoxButtons.YesNo))
{
return boards.b2560v2;
}
else
{
if (DialogResult.Yes == CustomMessageBox.Show("Is this a PX4/PIXHAWK?", "PX4/PIXHAWK", MessageBoxButtons.YesNo))
{
if (DialogResult.Yes == CustomMessageBox.Show("Is this a PIXHAWK?", "PIXHAWK", MessageBoxButtons.YesNo))
{
return boards.px4v2;
}
return boards.px4;
}
else
{
return boards.b2560;
}
}
}
/// <summary>
/// Upload the specified image_data.
/// </summary>
/// <param name='image_data'>
/// Image_data to be uploaded.
/// </param>
public void upload(SerialPort on_port, IHex image_data)
{
progress (0);
port = on_port;
try {
connect_and_sync ();
upload_and_verify (image_data);
cmdReboot ();
} catch {
if (port.IsOpen)
port.Close ();
throw;
}
}
private void BUT_getcurrent_Click(object sender, EventArgs e)
{
ICommsSerial comPort = new SerialPort();
try
{
if (MainV2.comPort.BaseStream.IsOpen)
{
getTelemPortWithRadio(ref comPort);
}
else
{
comPort.PortName = MainV2.comPort.BaseStream.PortName;
comPort.BaudRate = MainV2.comPort.BaseStream.BaudRate;
}
comPort.ReadTimeout = 4000;
comPort.Open();
}
catch
{
CustomMessageBox.Show("Invalid ComPort or in use");
return;
}
lbl_status.Text = "Connecting";
try
{
if (doConnect(comPort))
{
// cleanup
doCommand(comPort, "AT&T");
comPort.DiscardInBuffer();
lbl_status.Text = "Doing Command ATI & RTI";
ATI.Text = doCommand(comPort, "ATI");
var freq =
(Uploader.Frequency)
Enum.Parse(typeof (Uploader.Frequency), doCommand(comPort, "ATI3"));
var board =
(Uploader.Board)
Enum.Parse(typeof (Uploader.Board), doCommand(comPort, "ATI2"));
ATI3.Text = freq.ToString();
ATI2.Text = board.ToString();
// 8 and 9
if (freq == Uploader.Frequency.FREQ_915)
{
MIN_FREQ.DataSource = Range(895000, 1000, 935000);
RMIN_FREQ.DataSource = Range(895000, 1000, 935000);
MAX_FREQ.DataSource = Range(895000, 1000, 935000);
RMAX_FREQ.DataSource = Range(895000, 1000, 935000);
}
else if (freq == Uploader.Frequency.FREQ_433)
{
MIN_FREQ.DataSource = Range(414000, 50, 460000);
RMIN_FREQ.DataSource = Range(414000, 50, 460000);
MAX_FREQ.DataSource = Range(414000, 50, 460000);
RMAX_FREQ.DataSource = Range(414000, 50, 460000);
}
else if (freq == Uploader.Frequency.FREQ_868)
{
MIN_FREQ.DataSource = Range(849000, 1000, 889000);
RMIN_FREQ.DataSource = Range(849000, 1000, 889000);
MAX_FREQ.DataSource = Range(849000, 1000, 889000);
RMAX_FREQ.DataSource = Range(849000, 1000, 889000);
}
if (board == Uploader.Board.DEVICE_ID_RFD900 ||
board == Uploader.Board.DEVICE_ID_RFD900A
|| board == Uploader.Board.DEVICE_ID_RFD900P ||
board == Uploader.Board.DEVICE_ID_RFD900U ||
board == Uploader.Board.DEVICE_ID_RFD900Plus)
{
TXPOWER.DataSource = Range(1, 1, 30);
RTXPOWER.DataSource = Range(1, 1, 30);
}
txt_aeskey.Text = doCommand(comPort, "AT&E?").Trim();
RSSI.Text = doCommand(comPort, "ATI7").Trim();
lbl_status.Text = "Doing Command ATI5";
var answer = doCommand(comPort, "ATI5", true);
var items = answer.Split('\n');
foreach (var item in items)
{
if (item.StartsWith("S"))
{
var values = item.Split(':', '=');
if (values.Length == 3)
{
values[1] = values[1].Replace("/", "_");
var controls = groupBoxLocal.Controls.Find(values[1].Trim(), true);
if (controls.Length > 0)
{
controls[0].Enabled = true;
if (controls[0] is CheckBox)
{
((CheckBox) controls[0]).Checked = values[2].Trim() == "1";
}
else if (controls[0] is TextBox)
{
((TextBox) controls[0]).Text = values[2].Trim();
}
else if (controls[0].Name.Contains("MAVLINK")) //
{
var ans = Enum.Parse(typeof (mavlink_option), values[2].Trim());
((ComboBox) controls[0]).Text = ans.ToString();
}
else if (controls[0] is ComboBox)
{
((ComboBox) controls[0]).Text = values[2].Trim();
}
}
}
}
}
// remote
foreach (Control ctl in groupBoxRemote.Controls)
{
if (ctl.Name != "RSSI")
ctl.ResetText();
}
comPort.DiscardInBuffer();
RTI.Text = doCommand(comPort, "RTI");
try
{
var resp = doCommand(comPort, "RTI2");
if (resp.Trim() != "")
RTI2.Text =
((Uploader.Board)Enum.Parse(typeof(Uploader.Board), resp)).ToString();
}
catch
{
}
txt_Raeskey.Text = doCommand(comPort, "RT&E?").Trim();
lbl_status.Text = "Doing Command RTI5";
answer = doCommand(comPort, "RTI5", true);
items = answer.Split('\n');
foreach (var item in items)
{
if (item.StartsWith("S"))
{
var values = item.Split(':', '=');
if (values.Length == 3)
{
values[1] = values[1].Replace("/", "_");
var controls = groupBoxRemote.Controls.Find("R" + values[1].Trim(), true);
if (controls.Length == 0)
continue;
controls[0].Enabled = true;
if (controls[0] is CheckBox)
{
((CheckBox) controls[0]).Checked = values[2].Trim() == "1";
}
else if (controls[0] is TextBox)
{
((TextBox) controls[0]).Text = values[2].Trim();
}
else if (controls[0].Name.Contains("MAVLINK")) //
{
var ans = Enum.Parse(typeof (mavlink_option), values[2].Trim());
((ComboBox) controls[0]).Text = ans.ToString();
}
else if (controls[0] is ComboBox)
{
((ComboBox) controls[0]).Text = values[2].Trim();
}
}
else
{
/*
if (item.Contains("S15"))
{
answer = doCommand(comPort, "RTS15?");
int rts15 = 0;
if (int.TryParse(answer, out rts15))
{
RS15.Enabled = true;
RS15.Text = rts15.ToString();
}
}
*/
log.Info("Odd config line :" + item);
}
}
}
// off hook
doCommand(comPort, "ATO");
lbl_status.Text = "Done";
}
else
{
// off hook
doCommand(comPort, "ATO");
lbl_status.Text = "Fail";
CustomMessageBox.Show("Failed to enter command mode");
}
comPort.Close();
BUT_Syncoptions.Enabled = true;
BUT_savesettings.Enabled = true;
}
catch (Exception ex)
{
try
{
if (comPort != null)
comPort.Close();
}
catch
{
}
lbl_status.Text = "Error";
CustomMessageBox.Show("Error during read " + ex);
}
}
private void BUT_savesettings_Click(object sender, EventArgs e)
{
ICommsSerial comPort = new SerialPort();
try
{
if (MainV2.comPort.BaseStream.IsOpen)
{
getTelemPortWithRadio(ref comPort);
}
else
{
comPort.PortName = MainV2.comPort.BaseStream.PortName;
comPort.BaudRate = MainV2.comPort.BaseStream.BaudRate;
}
comPort.ReadTimeout = 4000;
comPort.Open();
}
catch
{
CustomMessageBox.Show("Invalid ComPort or in use");
return;
}
lbl_status.Text = "Connecting";
if (doConnect(comPort))
{
// cleanup
doCommand(comPort, "AT&T");
comPort.DiscardInBuffer();
lbl_status.Text = "Doing Command";
// set encryption keys at the same time, so if we are enabled we dont lose comms.
if (RENCRYPTION_LEVEL.Checked)
{
doCommand(comPort, "RT&E=" + txt_Raeskey.Text.PadRight(32, '0'), true);
}
if (ENCRYPTION_LEVEL.Checked)
{
doCommand(comPort, "AT&E=" + txt_aeskey.Text.PadRight(32, '0'), true);
}
if (RTI.Text != "")
{
// remote
var answer = doCommand(comPort, "RTI5", true);
var items = answer.Split(new[] {'\n'}, StringSplitOptions.RemoveEmptyEntries);
foreach (var item in items)
{
if (item.StartsWith("S"))
{
var values = item.Split(':', '=');
if (values.Length == 3)
{
values[1] = values[1].Replace("/", "_");
var controls = groupBoxRemote.Controls.Find("R" + values[1].Trim(), true);
if (controls.Length > 0)
{
if (controls[0].GetType() == typeof (CheckBox))
{
var value = ((CheckBox) controls[0]).Checked ? "1" : "0";
if (value != values[2].Trim())
{
var cmdanswer = doCommand(comPort,
"RT" + values[0].Trim() + "=" + value + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else if (controls[0] is TextBox)
{
}
else if (controls[0].Name.Contains("MAVLINK")) //
{
if (((ComboBox) controls[0]).SelectedValue.ToString() != values[2].Trim())
{
var cmdanswer = doCommand(comPort,
"RT" + values[0].Trim() + "=" + ((ComboBox) controls[0]).SelectedValue +
"\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else if (controls[0] is ComboBox)
{
if (controls[0].Text != values[2].Trim())
{
var cmdanswer = doCommand(comPort,
"RT" + values[0].Trim() + "=" + controls[0].Text + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
}
}
}
}
Sleep(100);
}
comPort.DiscardInBuffer();
{
//local
var answer = doCommand(comPort, "ATI5", true);
var items = answer.Split(new[] {'\n'}, StringSplitOptions.RemoveEmptyEntries);
foreach (var item in items)
{
if (item.StartsWith("S"))
{
var values = item.Split(':', '=');
if (values.Length == 3)
{
values[1] = values[1].Replace("/", "_");
var controls = groupBoxLocal.Controls.Find(values[1].Trim(), true);
if (controls.Length > 0)
{
if (controls[0].GetType() == typeof (CheckBox))
{
var value = ((CheckBox) controls[0]).Checked ? "1" : "0";
if (value != values[2].Trim())
{
var cmdanswer = doCommand(comPort,
"AT" + values[0].Trim() + "=" + value + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else if (controls[0] is TextBox)
{
}
else if (controls[0].Name.Contains("MAVLINK")) //
{
if (((ComboBox) controls[0]).SelectedValue.ToString() != values[2].Trim())
{
var cmdanswer = doCommand(comPort,
"AT" + values[0].Trim() + "=" + ((ComboBox) controls[0]).SelectedValue +
"\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
else if (controls[0] is ComboBox)
{
if (controls[0].Text != values[2].Trim())
{
var cmdanswer = doCommand(comPort,
"AT" + values[0].Trim() + "=" + controls[0].Text + "\r");
if (cmdanswer.Contains("OK"))
{
}
else
{
CustomMessageBox.Show("Set Command error");
}
}
}
}
}
}
}
if (RTI.Text != "")
{
// write it
doCommand(comPort, "RT&W");
// return to normal mode
doCommand(comPort, "RTZ");
}
// write it
doCommand(comPort, "AT&W");
// return to normal mode
doCommand(comPort, "ATZ");
}
lbl_status.Text = "Done";
}
else
{
// return to normal mode
doCommand(comPort, "ATZ");
lbl_status.Text = "Fail";
CustomMessageBox.Show("Failed to enter command mode");
}
comPort.Close();
}
private void UploadFW(bool custom = false)
{
ICommsSerial comPort = new SerialPort();
var uploader = new Uploader();
if (MainV2.comPort.BaseStream.IsOpen)
{
try
{
getTelemPortWithRadio(ref comPort);
uploader.PROG_MULTI_MAX = 64;
}
catch (Exception ex)
{
CustomMessageBox.Show("Error " + ex);
}
}
try
{
comPort.PortName = MainV2.comPort.BaseStream.PortName;
comPort.BaudRate = 115200;
comPort.Open();
}
catch
{
CustomMessageBox.Show("Invalid ComPort or in use");
return;
}
// prep what we are going to upload
var iHex = new IHex();
iHex.LogEvent += iHex_LogEvent;
iHex.ProgressEvent += iHex_ProgressEvent;
var bootloadermode = false;
// attempt bootloader mode
try
{
if (upload_xmodem(comPort))
{
comPort.Close();
return;
}
comPort.BaudRate = 115200;
uploader_ProgressEvent(0);
uploader_LogEvent("Trying Bootloader Mode");
uploader.port = comPort;
uploader.connect_and_sync();
uploader.ProgressEvent += uploader_ProgressEvent;
uploader.LogEvent += uploader_LogEvent;
uploader_LogEvent("In Bootloader Mode");
bootloadermode = true;
}
catch (Exception ex1)
{
log.Error(ex1);
// cleanup bootloader mode fail, and try firmware mode
comPort.Close();
if (MainV2.comPort.BaseStream.IsOpen)
{
// default baud... guess
comPort.BaudRate = 57600;
}
else
{
comPort.BaudRate = MainV2.comPort.BaseStream.BaudRate;
}
try
{
comPort.Open();
}
catch
{
CustomMessageBox.Show("Error opening port", "Error");
return;
}
uploader.ProgressEvent += uploader_ProgressEvent;
uploader.LogEvent += uploader_LogEvent;
uploader_LogEvent("Trying Firmware Mode");
bootloadermode = false;
}
// check for either already bootloadermode, or if we can do a ATI to ID the firmware
if (bootloadermode || doConnect(comPort))
{
// put into bootloader mode/update mode
if (!bootloadermode)
{
try
{
comPort.Write("AT&UPDATE\r\n");
var left = comPort.ReadExisting();
log.Info(left);
Sleep(700);
comPort.BaudRate = 115200;
}
catch
{
}
if (upload_xmodem(comPort))
{
comPort.Close();
return;
}
comPort.BaudRate = 115200;
}
try
{
// force sync after changing baudrate
uploader.connect_and_sync();
}
catch
{
CustomMessageBox.Show("Failed to sync with Radio");
goto exit;
}
var device = Uploader.Board.FAILED;
var freq = Uploader.Frequency.FAILED;
// get the device type and frequency in the bootloader
uploader.getDevice(ref device, ref freq);
// get firmware for this device
if (getFirmware(device, custom))
{
// load the hex
try
{
iHex.load(firmwarefile);
}
catch
{
CustomMessageBox.Show("Bad Firmware File");
goto exit;
}
// upload the hex and verify
try
{
uploader.upload(comPort, iHex);
}
catch (Exception ex)
{
CustomMessageBox.Show("Upload Failed " + ex.Message);
}
}
else
{
CustomMessageBox.Show("Failed to download new firmware");
}
}
else
{
CustomMessageBox.Show("Failed to identify Radio");
}
exit:
if (comPort.IsOpen)
comPort.Close();
}
/// <summary>
/// detects STK version 1 or 2
/// </summary>
/// <param name="port">comportname</param>
/// <returns>string either (1280/2560) or "" for none</returns>
public static string DetectVersion(string port)
{
SerialPort serialPort = new SerialPort();
serialPort.PortName = port;
if (serialPort.IsOpen)
serialPort.Close();
serialPort.DtrEnable = true;
serialPort.BaudRate = 57600;
serialPort.Open();
serialPort.toggleDTR();
Thread.Sleep(100);
int a = 0;
while (a < 20) // 20 * 50 = 1 sec
{
//Console.WriteLine("write " + DateTime.Now.Millisecond);
serialPort.DiscardInBuffer();
serialPort.Write(new byte[] { (byte)'0', (byte)' ' }, 0, 2);
a++;
Thread.Sleep(50);
//Console.WriteLine("btr {0}", serialPort.BytesToRead);
if (serialPort.BytesToRead >= 2)
{
byte b1 = (byte)serialPort.ReadByte();
byte b2 = (byte)serialPort.ReadByte();
if (b1 == 0x14 && b2 == 0x10)
{
serialPort.Close();
log.Info("is a 1280");
return "1280";
}
}
}
serialPort.Close();
log.Warn("Not a 1280");
Thread.Sleep(500);
serialPort.DtrEnable = true;
serialPort.BaudRate = 115200;
serialPort.Open();
serialPort.toggleDTR();
Thread.Sleep(100);
a = 0;
while (a < 4)
{
byte[] temp = new byte[] { 0x6, 0, 0, 0, 0 };
temp = ArduinoDetect.genstkv2packet(serialPort, temp);
a++;
Thread.Sleep(50);
try
{
if (temp[0] == 6 && temp[1] == 0 && temp.Length == 2)
{
serialPort.Close();
log.Info("is a 2560");
return "2560";
}
}
catch
{
}
}
serialPort.Close();
log.Warn("Not a 2560");
return "";
}
static void doread(object o)
{
lock (runlock)
{
running++;
}
var portname = (string)o;
Console.WriteLine("Scanning {0}", portname);
try
{
using (SerialPort port = new SerialPort())
{
port.PortName = portname;
foreach (var baud in bauds)
{
// try default baud
if (baud != 0)
{
port.BaudRate = baud;
}
port.Open();
port.DiscardInBuffer();
// let data flow in
Thread.Sleep(2000);
lock (runlock)
{
if (run == 0)
{
return;
}
}
int available = port.BytesToRead;
var buffer = new byte[available];
int read = port.Read(buffer, 0, available);
Console.WriteLine("{0} {1}", portname, read);
if (read > 0)
{
using (MemoryStream ms = new MemoryStream(buffer, 0, read))
{
MAVLink.MavlinkParse mav = new MAVLink.MavlinkParse();
try
{
again:
var packet = mav.ReadPacket(ms);
if (packet != null && packet.Length > 0)
{
port.Close();
Console.WriteLine("Found Mavlink on port {0} at {1}", port.PortName,
port.BaudRate);
foundport = true;
portinterface = port;
if (connect)
{
MainV2.comPort.BaseStream = port;
doconnect();
}
break;
}
Console.WriteLine(portname + " crc: " + mav.badCRC);
goto again;
}
catch (Exception ex)
{
Console.WriteLine(portname + " " + ex.ToString());
}
}
}
try
{
port.Close();
}
catch (Exception ex)
{
Console.WriteLine(ex.ToString());
}
if (foundport)
{
break;
}
}
}
}
catch (Exception ex)
{
Console.WriteLine(portname + " " + ex.ToString());
}
finally
{
lock (runlock)
{
running--;
if (running == 0)
{
run = 0;
}
}
}
Console.WriteLine("Scan port {0} Finished!!", portname);
}
