public bool translateMode(byte sysid,byte compid, string modein, ref MAVLink.mavlink_set_mode_t mode)
{
mode.target_system = sysid;
if (modein == null || modein == "")
return false;
try
{
List<KeyValuePair<int, string>> modelist = Common.getModesList(MAVlist[sysid,compid].cs);
foreach (KeyValuePair<int, string> pair in modelist)
{
if (pair.Value.ToLower() == modein.ToLower())
{
mode.base_mode = (byte) MAVLink.MAV_MODE_FLAG.CUSTOM_MODE_ENABLED;
mode.custom_mode = (uint) pair.Key;
}
}
if (mode.base_mode == 0)
{
MessageBox.Show("No Mode Changed " + modein);
return false;
}
}
catch
{
System.Windows.Forms.MessageBox.Show("Failed to find Mode");
return false;
}
return true;
}