using System; using System.Collections; using System.ComponentModel; using System.Drawing; using System.IO; using System.Text; using System.Windows.Forms; using ArdupilotMega.Utilities; using log4net; using ArdupilotMega.Controls.BackstageView; namespace ArdupilotMega.GCSViews.ConfigurationView { public partial class ConfigRawParams : BackStageViewContentPanel { private static readonly ILog log = LogManager.GetLogger(System.Reflection.MethodBase.GetCurrentMethod().DeclaringType); private readonly ParameterMetaDataRepository _parameterMetaDataRepository; // Changes made to the params between writing to the copter readonly Hashtable _changes = new Hashtable(); static Hashtable tooltips = new Hashtable(); // ? internal bool startup = true; public struct paramsettings // hk's { public string name; public float minvalue; public float maxvalue; public float normalvalue; public float scale; public string desc; } public ConfigRawParams() { InitializeComponent(); _parameterMetaDataRepository = new ParameterMetaDataRepository(); } Hashtable loadParamFile(string Filename) { Hashtable param = new Hashtable(); StreamReader sr = new StreamReader(Filename); while (!sr.EndOfStream) { string line = sr.ReadLine(); if (line.Contains("NOTE:")) { CustomMessageBox.Show(line, "Saved Note"); continue; } if (line.StartsWith("#")) continue; string[] items = line.Split(new char[] { ' ', ',', '\t' }, StringSplitOptions.RemoveEmptyEntries); if (items.Length != 2) continue; string name = items[0]; float value = 0; try { value = float.Parse(items[1], System.Globalization.CultureInfo.InvariantCulture);// new System.Globalization.CultureInfo("en-US")); } catch (Exception ex) { log.Error(ex); throw new FormatException("Invalid number on param " + name + " : " + items[1].ToString()); } MAVLink.modifyParamForDisplay(true, name, ref value); if (name == "SYSID_SW_MREV") continue; if (name == "WP_TOTAL") continue; if (name == "CMD_TOTAL") continue; if (name == "FENCE_TOTAL") continue; if (name == "SYS_NUM_RESETS") continue; if (name == "ARSPD_OFFSET") continue; if (name == "GND_ABS_PRESS") continue; if (name == "GND_TEMP") continue; if (name == "CMD_INDEX") continue; if (name == "LOG_LASTFILE") continue; if (name == "FORMAT_VERSION") continue; param[name] = value; } sr.Close(); return param; } private void BUT_load_Click(object sender, EventArgs e) { var ofd = new OpenFileDialog { AddExtension = true, DefaultExt = ".param", RestoreDirectory = true, Filter = "Param List|*.param;*.parm" }; var dr = ofd.ShowDialog(); if (dr == DialogResult.OK) { Hashtable param2 = loadParamFile(ofd.FileName); foreach (string name in param2.Keys) { string value = param2[name].ToString(); // set param table as well foreach (DataGridViewRow row in Params.Rows) { if (name == "SYSID_SW_MREV") continue; if (name == "WP_TOTAL") continue; if (name == "CMD_TOTAL") continue; if (name == "FENCE_TOTAL") continue; if (name == "SYS_NUM_RESETS") continue; if (name == "ARSPD_OFFSET") continue; if (name == "GND_ABS_PRESS") continue; if (name == "GND_TEMP") continue; if (name == "CMD_INDEX") continue; if (name == "LOG_LASTFILE") continue; if (name == "FORMAT_VERSION") continue; if (row.Cells[0].Value.ToString() == name) { if (row.Cells[1].Value.ToString() != value.ToString()) row.Cells[1].Value = value; break; } } } } } private void BUT_save_Click(object sender, EventArgs e) { var sfd = new SaveFileDialog { AddExtension = true, DefaultExt = ".param", RestoreDirectory = true, Filter = "Param List|*.param;*.parm" }; var dr = sfd.ShowDialog(); if (dr == DialogResult.OK) { StreamWriter sw = new StreamWriter(sfd.OpenFile()); string input = DateTime.Now + " Frame : "; if (MainV2.cs.firmware == MainV2.Firmwares.ArduPlane) { input = DateTime.Now + " Plane: Skywalker"; } Common.InputBox("Custom Note", "Enter your Notes/Frame Type etc", ref input); if (input != "") sw.WriteLine("#NOTE: " + input.Replace(',', '|')); foreach (DataGridViewRow row in Params.Rows) { float value = float.Parse(row.Cells[1].Value.ToString()); MAVLink.modifyParamForDisplay(false, row.Cells[0].Value.ToString(), ref value); sw.WriteLine(row.Cells[0].Value.ToString() + "," + value.ToString(new System.Globalization.CultureInfo("en-US"))); } sw.Close(); } } private void BUT_writePIDS_Click(object sender, EventArgs e) { var temp = (Hashtable)_changes.Clone(); foreach (string value in temp.Keys) { try { MainV2.comPort.setParam(value, (float)_changes[value]); try { // set control as well var textControls = this.Controls.Find(value, true); if (textControls.Length > 0) { textControls[0].BackColor = Color.FromArgb(0x43, 0x44, 0x45); } } catch { } try { // set param table as well foreach (DataGridViewRow row in Params.Rows) { if (row.Cells[0].Value.ToString() == value) { row.Cells[1].Style.BackColor = Color.FromArgb(0x43, 0x44, 0x45); _changes.Remove(value); break; } } } catch { } } catch { CustomMessageBox.Show("Set " + value + " Failed"); } } } private void BUT_compare_Click(object sender, EventArgs e) { Hashtable param2 = new Hashtable(); var ofd = new OpenFileDialog { AddExtension = true, DefaultExt = ".param", RestoreDirectory = true, Filter = "Param List|*.param;*.parm" }; var dr = ofd.ShowDialog(); if (dr == DialogResult.OK) { param2 = loadParamFile(ofd.FileName); Form paramCompareForm = new ParamCompare(Params, MainV2.comPort.param, param2); ThemeManager.ApplyThemeTo(paramCompareForm); paramCompareForm.ShowDialog(); } } private void BUT_rerequestparams_Click(object sender, EventArgs e) { if (!MainV2.comPort.BaseStream.IsOpen) return; ((Control)sender).Enabled = false; try { MainV2.comPort.getParamList(); } catch (Exception ex) { log.Error("Exception getting param list", ex); CustomMessageBox.Show("Error: getting param list"); } ((Control)sender).Enabled = true; startup = true; processToScreen(); startup = false; // Todo: this populates or the combos etc and what not. This shoudl prob be a bsv button } void Params_CellValueChanged(object sender, DataGridViewCellEventArgs e) { if (e.RowIndex == -1 || e.ColumnIndex == -1 || startup == true || e.ColumnIndex != 1) return; try { if (Params[Command.Index, e.RowIndex].Value.ToString().EndsWith("_REV") && (Params[Command.Index, e.RowIndex].Value.ToString().StartsWith("RC") || Params[Command.Index, e.RowIndex].Value.ToString().StartsWith("HS"))) { if (Params[e.ColumnIndex, e.RowIndex].Value.ToString() == "0") Params[e.ColumnIndex, e.RowIndex].Value = "-1"; } Params[e.ColumnIndex, e.RowIndex].Style.BackColor = Color.Green; _changes[Params[0, e.RowIndex].Value] = float.Parse(Params[e.ColumnIndex, e.RowIndex].Value.ToString()); } catch (Exception) { Params[e.ColumnIndex, e.RowIndex].Style.BackColor = Color.Red; } Params.Focus(); } void readToolTips() { string data = global::ArdupilotMega.Properties.Resources.MAVParam; string[] tips = data.Split(new char[] { '\r', '\n' }, StringSplitOptions.RemoveEmptyEntries); foreach (var tip in tips) { if (!tip.StartsWith("||")) continue; string[] cols = tip.Split(new string[] { "||" }, 9, StringSplitOptions.None); if (cols.Length >= 8) { paramsettings param = new paramsettings(); try { param.name = cols[1]; param.desc = AddNewLinesForTooltip(cols[7]); param.scale = float.Parse(cols[5]); param.minvalue = float.Parse(cols[2]); param.maxvalue = float.Parse(cols[3]); param.normalvalue = float.Parse(cols[4]); } catch { } tooltips[cols[1]] = param; } } } // from http://stackoverflow.com/questions/2512781/winforms-big-paragraph-tooltip/2512895#2512895 private const int maximumSingleLineTooltipLength = 50; private static string AddNewLinesForTooltip(string text) { if (text.Length < maximumSingleLineTooltipLength) return text; int lineLength = (int)Math.Sqrt((double)text.Length) * 2; StringBuilder sb = new StringBuilder(); int currentLinePosition = 0; for (int textIndex = 0; textIndex < text.Length; textIndex++) { // If we have reached the target line length and the next // character is whitespace then begin a new line. if (currentLinePosition >= lineLength && char.IsWhiteSpace(text[textIndex])) { sb.Append(Environment.NewLine); currentLinePosition = 0; } // If we have just started a new line, skip all the whitespace. if (currentLinePosition == 0) while (textIndex < text.Length && char.IsWhiteSpace(text[textIndex])) textIndex++; // Append the next character. if (textIndex < text.Length) sb.Append(text[textIndex]); currentLinePosition++; } return sb.ToString(); } internal void processToScreen() { toolTip1.RemoveAll(); Params.Rows.Clear(); // process hashdefines and update display foreach (string value in MainV2.comPort.param.Keys) { if (value == null || value == "") continue; //System.Diagnostics.Debug.WriteLine("Doing: " + value); Params.Rows.Add(); Params.Rows[Params.RowCount - 1].Cells[Command.Index].Value = value; Params.Rows[Params.RowCount - 1].Cells[Value.Index].Value = ((float)MainV2.comPort.param[value]).ToString("0.###"); try { string metaDataDescription = _parameterMetaDataRepository.GetParameterMetaData(value, ParameterMetaDataConstants.Description); if(!String.IsNullOrEmpty(metaDataDescription)) { Params.Rows[Params.RowCount - 1].Cells[Command.Index].ToolTipText = metaDataDescription; Params.Rows[Params.RowCount - 1].Cells[Value.Index].ToolTipText = metaDataDescription; } else if (tooltips[value] != null) { Params.Rows[Params.RowCount - 1].Cells[Command.Index].ToolTipText = ((paramsettings)tooltips[value]).desc; //Params.Rows[Params.RowCount - 1].Cells[RawValue.Index].ToolTipText = ((paramsettings)tooltips[value]).desc; Params.Rows[Params.RowCount - 1].Cells[Value.Index].ToolTipText = ((paramsettings)tooltips[value]).desc; //Params.Rows[Params.RowCount - 1].Cells[Default.Index].Value = ((paramsettings)tooltips[value]).normalvalue; //Params.Rows[Params.RowCount - 1].Cells[mavScale.Index].Value = ((paramsettings)tooltips[value]).scale; //Params.Rows[Params.RowCount - 1].Cells[Value.Index].Value = float.Parse(Params.Rows[Params.RowCount - 1].Cells[RawValue.Index].Value.ToString()) / float.Parse(Params.Rows[Params.RowCount - 1].Cells[mavScale.Index].Value.ToString()); } } catch { } } Params.Sort(Params.Columns[0], ListSortDirection.Ascending); } private void ConfigRawParams_Load(object sender, EventArgs e) { // read tooltips if (tooltips.Count == 0) readToolTips(); startup = true; processToScreen(); startup = false; } } }