WebSVN - Projects - Diff - Rev 2421 and 2424 - /MKLiveView/v1.0/Source/MainWindow.xaml.cs

         string[] sAnalogLabel = new string[32];
         string[] sAnalogData = new string[32];
         int[] iAnalogData = new int[32];
-        int[] iTimings = new int[] {100,150,200,250,300,350,400,450,500,550,600,650,700,750,800,850,900,950,1000,1100,1200,1300,1400,1500,1600,1700,1800,1900,2000 };
+        int[] iTimings = new int[] { 100, 150, 200, 250, 300, 350, 400, 450, 500, 550, 600, 650, 700, 750, 800, 850, 900, 950, 1000, 1100, 1200, 1300, 1400, 1500, 1600, 1700, 1800, 1900, 2000 };
-        int[] iMotors = new int[] {3,4,5,6,7,8,9,10,11,12 };
+        int[] iMotors = new int[] { 3, 4, 5, 6, 7, 8, 9, 10, 11, 12 };
         string[] sLiPoCells = new string[] { "3s", "4s", "5s", "6s" };
         /// <summary>
         /// interval for sending debugdata (multiplied by 10ms)
         DispatcherTimer timer = new DispatcherTimer();
         /// <summary>
         /// stuff for enabeling touch zoom for the map
         /// </summary>
-        Point pTouch1 = new Point(0,0), pTouch2 = new Point(0,0);
+        Point pTouch1 = new Point(0, 0), pTouch2 = new Point(0, 0);
         int iFirstStylusID = -1;
         public string connectButtonText
+        {
             get
         void _initForm()
+        {
             _readIni();
             if (_bSaveWinStateNormal)
                 _setScaleSliders(false);
             cBoxTimingsDebug.ItemsSource =
                 cBoxTimingsNav.ItemsSource =
                 cBoxTimingsBl.ItemsSource =
                 cBoxTimingsOSD.ItemsSource =
                 iTimings;
             cBoxLiPoCells.ItemsSource = sLiPoCells;
             cBoxLiPoCells.SelectedItem = _LipoCells.ToString() + "s";
             _LipoMinMax();
             sliderThresholdVoltageWarn.Value = _dThresholdVoltageWarn;
                 dtMotors.Columns.Add("Current");
             dtMotors.Columns.Add("Temp");
             dgvMotors1.DataContext = dtMotors.DefaultView;
             _initDTMotors();
-            Setter setter = new Setter(ContentControl.PaddingProperty, new Thickness(5,0,5,0));
+            Setter setter = new Setter(ContentControl.PaddingProperty, new Thickness(5, 0, 5, 0));
             Style style = new Style(typeof(System.Windows.Controls.Primitives.DataGridColumnHeader));
             style.Setters.Add(setter);
             setter = new Setter(ContentControl.BackgroundProperty, new SolidColorBrush(Colors.Transparent));
             style.Setters.Add(setter);
             setter = new Setter(ContentControl.ForegroundProperty, new SolidColorBrush(Colors.White));
             style.Setters.Add(setter);
-            dtWaypoints.Columns.Add("Index",typeof(int));
+            dtWaypoints.Columns.Add("Index", typeof(int));
             dtWaypoints.Columns.Add("Type", typeof(int));
-            dtWaypoints.Columns.Add("Name",typeof(string));
+            dtWaypoints.Columns.Add("Name", typeof(string));
-            dtWaypoints.Columns.Add("Latitude",typeof(double));
+            dtWaypoints.Columns.Add("Latitude", typeof(double));
-            dtWaypoints.Columns.Add("Longitude",typeof(double));
+            dtWaypoints.Columns.Add("Longitude", typeof(double));
-            dtWaypoints.Columns.Add("Altitude",typeof(string));
+            dtWaypoints.Columns.Add("Altitude", typeof(string));
-            dtWaypoints.Columns.Add("Heading",typeof(string));
+            dtWaypoints.Columns.Add("Heading", typeof(string));
-            dtWaypoints.Columns.Add("Speed",typeof(string));
+            dtWaypoints.Columns.Add("Speed", typeof(string));
-            dtWaypoints.Columns.Add("ClimbRate",typeof(string));
+            dtWaypoints.Columns.Add("ClimbRate", typeof(string));
-            dtWaypoints.Columns.Add("Radius",typeof(string));
+            dtWaypoints.Columns.Add("Radius", typeof(string));
-            dtWaypoints.Columns.Add("HoldTime",typeof(string));
+            dtWaypoints.Columns.Add("HoldTime", typeof(string));
-            dtWaypoints.Columns.Add("AutoTrigger",typeof(string));
+            dtWaypoints.Columns.Add("AutoTrigger", typeof(string));
-            dtWaypoints.Columns.Add("CamAngle",typeof(string));
+            dtWaypoints.Columns.Add("CamAngle", typeof(string));
-            dtWaypoints.Columns.Add("Event",typeof(string));
+            dtWaypoints.Columns.Add("Event", typeof(string));
-            dtWaypoints.Columns.Add("Out1Timer",typeof(string));
+            dtWaypoints.Columns.Add("Out1Timer", typeof(string));
-            dtWaypoints.Columns.Add("Status",typeof(string));
+            dtWaypoints.Columns.Add("Status", typeof(string));
             dtWaypoints.PrimaryKey = new DataColumn[] { dtWaypoints.Columns["Index"] };
             dgvWP.ItemsSource = dtWaypoints.DefaultView;
             dgvWP.ColumnHeaderStyle = new Style();
             dgvWP.ColumnHeaderStyle = style;
-            dtGPX.Columns.Add("Index",typeof(int));
+            dtGPX.Columns.Add("Index", typeof(int));
-            dtGPX.Columns.Add("Latitude",typeof(double));
+            dtGPX.Columns.Add("Latitude", typeof(double));
-            dtGPX.Columns.Add("Longitude",typeof(double));
+            dtGPX.Columns.Add("Longitude", typeof(double));
-            dtGPX.Columns.Add("Elevation",typeof(int));
+            dtGPX.Columns.Add("Elevation", typeof(int));
-            dtGPX.Columns.Add("Time",typeof(string));
+            dtGPX.Columns.Add("Time", typeof(string));
             dtGPX.PrimaryKey = new DataColumn[] { dtGPX.Columns["Index"] };
         private void serialPortCtrl_PortOpened()
+        {
             Dispatcher.Invoke(() => imageWiFi.Source = new BitmapImage(new Uri("Images/WiFi_G.png", UriKind.Relative)));
             _getVersion();
             Thread.Sleep(100);
+            _getLic();
             //_OSDMenue(0);
             //Thread.Sleep(200);
             //_sendSerialData();
             _readCont(true);
+        }
                     _OSDMenueAutoRefresh();
+                }
                 if (_iLifeCounter > 0)
+                {
                     Dispatcher.Invoke(() => imageConn.Source = new BitmapImage(new Uri("Images/Data_G.png", UriKind.Relative)));
-                  //  Dispatcher.Invoke((Action)(() => rctConnection.Fill = Brushes.LightGreen));
+                    //  Dispatcher.Invoke((Action)(() => rctConnection.Fill = Brushes.LightGreen));
                     _iLifeCounter = 0;
                     _bConnErr = false;
-                    if(_bAirborne && _bGPXLog)
+                    if (_bAirborne && _bGPXLog)
+                    {
                         drGPX[0] = dtGPX.Rows.Count;
                         dtGPX.Rows.Add(new object[] { drGPX[0], drGPX[1], drGPX[2], drGPX[3], drGPX[4] });
+                    }
                     Dispatcher.Invoke((Action)(() => tbSideBarGPXLog.Background = (_bAirborne && _bGPXLog && _bToggle) ? new SolidColorBrush(Colors.LightSeaGreen) : new SolidColorBrush(Colors.Transparent)));
+                {
                     if (!_bConnErr)
+                    {
                         Log(LogMsgType.Error, "No communication to NC/FC!");
                         Dispatcher.Invoke(() => imageConn.Source = new BitmapImage(new Uri("Images/Data_R.png", UriKind.Relative)));
-                       // Dispatcher.Invoke((Action)(() => rctConnection.Fill = Brushes.Red));
+                        // Dispatcher.Invoke((Action)(() => rctConnection.Fill = Brushes.Red));
                         _bConnErr = true;
+                    }
+                }
+            }
+        }
+        }
         #region thresholds
         private void sliderThresholdVoltageWarn_ValueChanged(object sender, RoutedPropertyChangedEventArgs<double> e)
         {
-            if(!_init)
+            if (!_init)
                 _dThresholdVoltageWarn = sliderThresholdVoltageWarn.Value;
+        }
         private void sliderThresholdVoltageCrit_ValueChanged(object sender, RoutedPropertyChangedEventArgs<double> e)
         {
-            if(!_init)
+            if (!_init)
                 _dThresholdVoltageCrit = sliderThresholdVoltageCrit.Value;
+        }
         private void checkBoxThresholdVoltageVoice_Click(object sender, RoutedEventArgs e)
+        {
             _bVoiceVoltPlay = (bool)checkBoxThresholdVoltageVoice.IsChecked;
+        }
         private void sliderThresholdDistanceWarn_ValueChanged(object sender, RoutedPropertyChangedEventArgs<double> e)
+        {
-            if(!_init)
+            if (!_init)
                 _dThresholdDistanceWarn = sliderThresholdDistanceWarn.Value;
+        }
         private void checkBoxThresholdDistanceVoice_Click(object sender, RoutedEventArgs e)
             _setMotorGridSize();
+        }
         private void Window_Closing(object sender, CancelEventArgs e)
+        {
             _writeIni();
-            if(_bGPXLog && dtGPX.Rows.Count > 0)
+            if (_bGPXLog && dtGPX.Rows.Count > 0)
                 _saveGPXLog();
+        }
         private void Window_Closed(object sender, EventArgs e)
+        {
             Application.Current.Shutdown();
             // acccess mode
             comboBoxMode.ItemsSource = Enum.GetValues(typeof(AccessMode));
             comboBoxMode.SelectedItem = MainMap.Manager.Mode;
         }
         /// <summary>
         /// selection of relevant map providers --> if You need more, You can change the line:
         ///     comboBoxMapType.ItemsSource = providerList;
         /// to:
         private void MainMap_Loaded(object sender, RoutedEventArgs e)
+        {
             MainMap.Manager.Mode = AccessMode.ServerAndCache;
             copter = new GMapMarker(MainMap.Position);
-            copter.Shape = new CustomMarkerCopter(this, copter, MainMap.Position.Lat.ToString("0.#######°") + System.Environment.NewLine + MainMap.Position.Lng.ToString("0.#######°"),"red");
+            copter.Shape = new CustomMarkerCopter(this, copter, MainMap.Position.Lat.ToString("0.#######°") + System.Environment.NewLine + MainMap.Position.Lng.ToString("0.#######°"), "red");
             if (comboBoxCopterColor.SelectionBoxItem != null)
+            {
                 string s = comboBoxCopterColor.SelectionBoxItem.ToString();
                 ((CustomMarkerCopter)(copter.Shape)).setCopterColor(s);
             return null;
+        }
         void _clearWPMarker(string name)
+        {
             GMapMarker p = _findWPMarker(name);
-            if(p != null)
+            if (p != null)
                 MainMap.Markers.Remove(p);
+        }
         void _renameWPMarker(string s1, string s2)
+        {
             GMapMarker p = _findWPMarker(s1);
         void createCircle(PointLatLng center, double distance)
+        {
             GMapMarker it = new GMapMarker(center);
             it.ZIndex = -1;
             cWPBound.Center = center;
             cWPBound.Bound = GMap.NET.PureProjection.GetPointFromDistance(center, distance);
             cWPBound.Tag = it;
             cWPBound.IsHitTestVisible = false;
         private void MainMap_OnMapZoomChanged()
+        {
             if (_bFollowCopter)
                 _setCopterData(MainMap.Position);
-            if((int)sliderMapZoom.Value != MainMap.Zoom)
+            if ((int)sliderMapZoom.Value != MainMap.Zoom)
                 sliderMapZoom.Value = MainMap.Zoom;
-            if(cWPBound != null && cWPBound.Tag != null)
+            if (cWPBound != null && cWPBound.Tag != null)
                 UpdateCircle(cWPBound);
+        }
+            {
                 Dispatcher.Invoke(() => ArtHor.rotateHome = GMapProviders.EmptyProvider.Projection.GetBearing(copter.Position, home.Position));
                 double d = GMapProviders.EmptyProvider.Projection.GetDistance(home.Position, copter.Position);
                 Dispatcher.Invoke(() => tbTopDistanceHP.Text = (d * 1000).ToString("0.0 m"));
-                if(d*1000 < _dThresholdDistanceWarn)
+                if (d * 1000 < _dThresholdDistanceWarn)
+                {
                     _iDistanceJitter = 0; _bVoiceDistanceActive = false;
                     if (stbDistanceWarnAnim != null && _bAnimDistanceActive)
+                    {
         #endregion GMap
         #region settings
         private void cBoxTimingsDebug_DropDownClosed(object sender, EventArgs e)
         {
-            if(! _bCBInit && cBoxTimingsDebug.SelectedIndex > -1)
+            if (!_bCBInit && cBoxTimingsDebug.SelectedIndex > -1)
                 debugInterval = (byte)(Convert.ToInt16(cBoxTimingsDebug.SelectedItem) / 10);
+        }
         private void cBoxTimingsNav_DropDownClosed(object sender, EventArgs e)
         {
-            if(! _bCBInit && cBoxTimingsNav.SelectedIndex > -1)
+            if (!_bCBInit && cBoxTimingsNav.SelectedIndex > -1)
                 navctrlInterval = (byte)(Convert.ToInt16(cBoxTimingsNav.SelectedItem) / 10);
+        }
         private void cBoxTimingsBl_DropDownClosed(object sender, EventArgs e)
+        {
         /// <param name="msg"> The string containing the message to be shown. </param>
         private void Log(LogMsgType msgtype, string msg)
+        {
             Dispatcher.Invoke(() =>
+            {
-               // rtfTerminal.CaretPosition = rtfTerminal.CaretPosition.DocumentEnd;
+                // rtfTerminal.CaretPosition = rtfTerminal.CaretPosition.DocumentEnd;
-               // rtfTerminal.Foreground = new SolidColorBrush(LogMsgTypeColor[(int)msgtype]);
+                // rtfTerminal.Foreground = new SolidColorBrush(LogMsgTypeColor[(int)msgtype]);
-//                rtfTerminal.AppendText(msg + "\r");
+                //                rtfTerminal.AppendText(msg + "\r");
-                TextRange tr = new TextRange(rtfTerminal.Document.ContentEnd,rtfTerminal.Document.ContentEnd);
+                TextRange tr = new TextRange(rtfTerminal.Document.ContentEnd, rtfTerminal.Document.ContentEnd);
                 tr.Text = msg;
                 tr.ApplyPropertyValue(TextElement.ForegroundProperty, new SolidColorBrush(LogMsgTypeColor[(int)msgtype]));
                 rtfTerminal.AppendText("\r");
                 rtfTerminal.ScrollToEnd();
             });
+        }
-        private void ErrorLog(LogMsgType msgtype, string msg , string linkURL, string linkName)
+        private void ErrorLog(LogMsgType msgtype, string msg, string linkURL, string linkName)
+        {
             Dispatcher.Invoke(() =>
+            {
                     int iLength = 0;
                     int iEnd = searchRange.Text.IndexOf('\r', iStart);
                     if (iEnd > 0)
+                    {
                         iLength = iEnd + 1;
                         int iHttp = searchRange.Text.IndexOf("http", iEnd);
                         if (iHttp == iLength)
+                        {
                             int iEnd2 = searchRange.Text.IndexOf('\r', iLength);
                             if (iEnd2 > iLength)
+                            {
                                 iLength = iEnd2 + 1;
-                              //  TextRange result = new TextRange(rtfError.Document.ContentStart.GetPositionAtOffset(iStart), GetTextPositionAtOffset(rtfError.Document.ContentStart.GetPositionAtOffset(iStart), iLength));
+                                //  TextRange result = new TextRange(rtfError.Document.ContentStart.GetPositionAtOffset(iStart), GetTextPositionAtOffset(rtfError.Document.ContentStart.GetPositionAtOffset(iStart), iLength));
                                 rtfError.Selection.Select(rtfError.Document.ContentStart.GetPositionAtOffset(iStart), GetTextPositionAtOffset(rtfError.Document.ContentStart.GetPositionAtOffset(iStart), iLength));
                                 rtfError.Selection.Text = string.Empty;
                                 if (rtfError.Document.ContentEnd.GetTextRunLength(LogicalDirection.Backward) < 2) _bErrorLog = false;
                         _iCtrlAct = adr;
                         switch (adr)
+                        {
                             case 1:
                                 Dispatcher.Invoke(() => tbCtrl.Text = "FC");
-                               // Dispatcher.Invoke(() => buttonSwitchNC.Visibility = Visibility.Visible);
+                                // Dispatcher.Invoke(() => buttonSwitchNC.Visibility = Visibility.Visible);
-                               // Dispatcher.Invoke(() => labelSwitchToNavi.Visibility = Visibility.Visible);
+                                // Dispatcher.Invoke(() => labelSwitchToNavi.Visibility = Visibility.Visible);
-                              //  _setFieldsNA(); //display fields NA for FC
+                                //  _setFieldsNA(); //display fields NA for FC
                                 break;
                             case 2:
                                 Dispatcher.Invoke(() => tbCtrl.Text = "NC");
                                 //Dispatcher.Invoke(() => buttonSwitchNC.Visibility = Visibility.Hidden);
                                 //Dispatcher.Invoke(() => labelSwitchToNavi.Visibility = Visibility.Hidden);
                             //    break;
                             default:
                                 Dispatcher.Invoke(() => tbCtrl.Text = "NA");
                                 break;
+                        }
-                       // _loadLabelNames();
+                        // _loadLabelNames();
+                    }
                     // else
                     //     Debug.Print("Address == 0?");
                             case 'K'://BL-CTRL data
                                 _processBLCtrl(data);
+                                break;
+                            case 'M'://License info
+                                _processLicense(data);
                                 break;
                             case 'O': //NC Data
                                 _processNCData(data);
         /// <param name="data">the received byte array to process</param>
         void _processDebugVals(byte adr, byte[] data)
+        {
             if (data.Length == 66)
+            {
                 double v;
                 int index = 0;
                 Int16 i16 = 0;
                 double dTemp = 0;
                 for (int i = 2; i < 66; i += 2)
+                {
                     i16 = data[i + 1];
                     i16 = (Int16)(i16 << 8);
                     iAnalogData[index] = data[i] + i16;
                     sAnalogData[index] = (data[i] + i16).ToString();
-                   // dtAnalog.Rows[index].SetField(1, sAnalogData[index]);
+                    // dtAnalog.Rows[index].SetField(1, sAnalogData[index]);
                     if (adr == 2) //NC
+                    {
                         switch (index)
                                 Dispatcher.Invoke((Action)(() => tbRoll.Text = ((double)iAnalogData[index] / (double)10).ToString("0.0°")));
                                 break;
                             case 4: //altitude
                                 Dispatcher.Invoke(() => tbAlt.Text = ((double)iAnalogData[index] / (double)10).ToString("0.0 m"));
                                 Dispatcher.Invoke(() => tbTopHeight.Text = ((double)iAnalogData[index] / (double)10).ToString("0.0 m"));
                                 Dispatcher.Invoke(() => { drGPX[3] = (double)iAnalogData[index] / (double)10; });
                                 break;
                             case 7: //Voltage
                                 v = (double)iAnalogData[index] / (double)10;
                                 Dispatcher.Invoke(() => tbVolt.Text = v.ToString("0.0 V"));
                                 Dispatcher.Invoke(() => tbTopVoltage.Text = v.ToString("0.0 V"));
                                 Dispatcher.Invoke(() => pbTopVoltage.Value = v);
                                 if (v - _dLipoVMin < 1 | v < _dThresholdVoltageWarn)
+                                {
                                     if (v == _dVoltLast)
-                                        if(_iVoltJitter < 20) _iVoltJitter++;
+                                        if (_iVoltJitter < 20) _iVoltJitter++;
-                                    else
+                                        else
-                                    {
+                                        {
-                                        _iVoltJitter = 0;
+                                            _iVoltJitter = 0;
-                                        _dVoltLast = v;
+                                            _dVoltLast = v;
-                                    }
+                                        }
                                     if (_iVoltJitter == 20)
+                                    {
                                         Dispatcher.Invoke(() => pbTopVoltage.Foreground = Brushes.Orange);
                                 Dispatcher.Invoke((Action)(() => tbI2C.Text = sAnalogData[index]));
                                 break;
                             case 20: //Earthmagnet field
                                 Dispatcher.Invoke((Action)(() => tbMagF.Text = sAnalogData[index] + "%"));
                                 Dispatcher.Invoke((Action)(() => tbTopEarthMag.Text = sAnalogData[index] + "%"));
                                 if (Math.Abs(100 - iAnalogData[index]) < _iThresholdMagField)
+                                {
                                     Dispatcher.Invoke(() => imageEarthMag.Source = new BitmapImage(new Uri("Images/EarthMag.png", UriKind.Relative)));
                                     _iMagneticFieldJitter = 0; _bVoiceMagneticFieldActive = false;
                                     if (stbMagneticFieldAnim != null && _bAnimMagneticFieldActive)
+                                    }
+                                }
                                 else
+                                {
                                     Dispatcher.Invoke(() => imageEarthMag.Source = new BitmapImage(new Uri("Images/EarthMag_R.png", UriKind.Relative)));
-                                    if(_iMagneticFieldLast >= Math.Abs(100 - iAnalogData[index]))
+                                    if (_iMagneticFieldLast >= Math.Abs(100 - iAnalogData[index]))
+                                    {
                                         if (_iMagneticFieldJitter < 20)
                                             _iMagneticFieldJitter++;
+                                    }
                                     else
+                                    {
                                         _iMagneticFieldJitter = 0;
                                         _iMagneticFieldLast = Math.Abs(100 - iAnalogData[index]);
+                                    }
-                                    if(_iMagneticFieldJitter == 20)
+                                    if (_iMagneticFieldJitter == 20)
+                                    {
                                         if (stbMagneticFieldAnim != null && !_bAnimMagneticFieldActive)
+                                        {
                                             Dispatcher.Invoke(() => stbMagneticFieldAnim.Begin());
                                             _bAnimMagneticFieldActive = true;
+                                        }
+                                    }
+                                }
                                 break;
                             case 21: //GroundSpeed
-                                     Dispatcher.Invoke((Action)(() => tbSpeed.Text = ((double)iAnalogData[index] / (double)100).ToString("0.00 m/s")));
+                                Dispatcher.Invoke((Action)(() => tbSpeed.Text = ((double)iAnalogData[index] / (double)100).ToString("0.00 m/s")));
-                                    if (!_Simulate)
+                                if (!_Simulate)
-                                        Dispatcher.Invoke((Action)(() => tbTopSpeed.Text = ((double)iAnalogData[index] / (double)100).ToString("0.00 m/s")));
+                                    Dispatcher.Invoke((Action)(() => tbTopSpeed.Text = ((double)iAnalogData[index] / (double)100).ToString("0.00 m/s")));
                                 break;
                             ///**********   needs testing --> not sure what position this is  ***************
                             case 28: //Distance East from saved home position -> calculate distance with distance N + height
-                                    dTemp = Math.Pow((double)iAnalogData[index], 2) + Math.Pow((double)iAnalogData[index - 1], 2);
+                                dTemp = Math.Pow((double)iAnalogData[index], 2) + Math.Pow((double)iAnalogData[index - 1], 2);
-                                    dTemp = Math.Sqrt(dTemp) / (double)10; //'flat' distance from HP with N/E
+                                dTemp = Math.Sqrt(dTemp) / (double)10; //'flat' distance from HP with N/E
-                                                                           //  lblNCDist.Invoke((Action)(() => lblNCDist.Text = dTemp.ToString("0.00")));
+                                                                       //  lblNCDist.Invoke((Action)(() => lblNCDist.Text = dTemp.ToString("0.00")));
-                                    dTemp = Math.Pow(dTemp, 2) + Math.Pow(((double)iAnalogData[4] / (double)10), 2); //adding 'height' into calculation
+                                dTemp = Math.Pow(dTemp, 2) + Math.Pow(((double)iAnalogData[4] / (double)10), 2); //adding 'height' into calculation
-                                    dTemp = Math.Sqrt(dTemp) / (double)10;
+                                dTemp = Math.Sqrt(dTemp) / (double)10;
-                               //     Dispatcher.Invoke((Action)(() => tbTopDistanceHP.Text = dTemp.ToString("0.0 m")));
+                                //     Dispatcher.Invoke((Action)(() => tbTopDistanceHP.Text = dTemp.ToString("0.0 m")));
-                                    Dispatcher.Invoke((Action)(() => tbHP1.Text = dTemp.ToString("0.0 m")));
+                                Dispatcher.Invoke((Action)(() => tbHP1.Text = dTemp.ToString("0.0 m")));
                                 break;
                             case 31: //Sats used
-                                     Dispatcher.Invoke((Action)(() => tbSats.Text = sAnalogData[index]));
+                                Dispatcher.Invoke((Action)(() => tbSats.Text = sAnalogData[index]));
-                                    // Dispatcher.Invoke((Action)(() => tbTopSats.Text = sAnalogData[index]));
+                                // Dispatcher.Invoke((Action)(() => tbTopSats.Text = sAnalogData[index]));
                                 break;
+                        }
+                    }
                     Log(LogMsgType.Incoming, "BL-Firmware: V" + (data[8] / 100).ToString() + "." + (data[8] % 100).ToString());
+                }
                 if (data[5] > 0) //error0
+                {
                     if (adr == 1)
-                        ErrorLog(LogMsgType.Error, " FC - HW-Error " + data[5].ToString() + ": " + ((FC_HWError0)data[5]).ToString(),"","");
+                        ErrorLog(LogMsgType.Error, " FC - HW-Error " + data[5].ToString() + ": " + ((FC_HWError0)data[5]).ToString(), "", "");
                     if (adr == 2)
-                        ErrorLog(LogMsgType.Error, " NC - HW-Error " + data[5].ToString() + ": " + ((NC_HWError0)data[5]).ToString(),"","");
+                        ErrorLog(LogMsgType.Error, " NC - HW-Error " + data[5].ToString() + ": " + ((NC_HWError0)data[5]).ToString(), "", "");
+                }
                 if (data[6] > 0) //error1
+                {
                     if (adr == 1)
-                        ErrorLog(LogMsgType.Error, " FC - HW-Error " + data[6].ToString() + ": " + ((FC_HWError1)data[6]).ToString(),"","");
+                        ErrorLog(LogMsgType.Error, " FC - HW-Error " + data[6].ToString() + ": " + ((FC_HWError1)data[6]).ToString(), "", "");
                     if (adr == 2)
-                        ErrorLog(LogMsgType.Error, " NC - Unknown HW-ERROR: " + data[6].ToString(),"",""); //@moment NC has only one error field
+                        ErrorLog(LogMsgType.Error, " NC - Unknown HW-ERROR: " + data[6].ToString(), "", ""); //@moment NC has only one error field
+                }
                 //if ((data[5] + data[6] == 0) && _bErrorLog)
                 //    _clearErrorLog(adr == 1 ? "FC - HW-Error" : "NC - HW-Error");
+            }
             check_HWError = false;
+        }
+        void _processLicense(byte[] data)
+        {
+            if (data.Length > 480)
+            {
+                Dispatcher.Invoke(() => {
+                    tbDataLicenseUser.Text = new string(ASCIIEncoding.ASCII.GetChars(data, 1, 127));
+                    tbDataLicenseMail.Text = new string(ASCIIEncoding.ASCII.GetChars(data, 129, 127));
+                    tbDataLicenseFeature.Text = new string(ASCIIEncoding.ASCII.GetChars(data, 257, 127));
+                    tbDataLicenseExpire.Text = new string(ASCIIEncoding.ASCII.GetChars(data, 385, 11));
+                    tbDataLicenseLicense.Text = new string(ASCIIEncoding.ASCII.GetChars(data, 397, 16));
+                });
+            }
+        }
         /// <summary>
         /// BL-Ctrl data 'K'
         /// for FC you have to use a customized firmware
         /// </summary>
                 serialStream.Write(bytes, 0, bytes.Length);
                 Thread.Sleep(100);
                 _getVersion();
+                Thread.Sleep(100);
-                Thread.Sleep(100);
+                _getLic();
                // _OSDMenue(0);
+            }
             else
                 Log(LogMsgType.Error, "NOT CONNECTED!");
+        {
             byte interval = auto ? navctrlInterval : (byte)0;
             _sendControllerMessage('o', 2, new byte[1] { interval });
+        }
         /// <summary>
+        /// request the license info
+        /// </summary>
+        void _getLic()
+        {
+            if (serialPortCtrl.Port.IsOpen)
+            {
+                Stream serialStream = serialPortCtrl.Port.BaseStream;
+                byte[] bytes = FlightControllerMessage.CreateMessage('m', 2, new byte[1] { (byte)1 });
+                serialStream.Write(bytes, 0, bytes.Length);
+            }
+            else
+                Log(LogMsgType.Error, "NOT CONNECTED!");
+        }
+        /// <summary>
         /// get the errortext for pending NC error
         /// </summary>
         private void _readNCError()
+        {
             _sendControllerMessage('e', 2);
             string sIndex = wp.WPText.Substring(1, wp.WPText.Length - 1);
             int index = Convert.ToInt16(sIndex) -1;
             GMapMarker p = ((GMapMarker)wp.DataContext);
             if (p != null && index < dtWaypoints.Rows.Count)
+            {
-                //dtWaypoints.Rows[index][3] = p.Position.Lat;
-                //dtWaypoints.Rows[index][4] = p.Position.Lng;
                 //Dispatcher.Invoke(() => dgvWP.Items.Refresh());
                 if(wp.WPType == 0 | wp.WPType == 3)
                 {
+                    PointLatLng x = new PointLatLng((double)dtWaypoints.Rows[index][3], (double)dtWaypoints.Rows[index][4]);
+                    int wpListIndex = wpList.IndexOf(x);
+                    if (wpListIndex > -1)
+                    {
-                    wpList[index] = p.Position;
+                        wpList[wpListIndex] = p.Position;
-                    MainMap.Markers.Remove(mRouteWP);
+                        MainMap.Markers.Remove(mRouteWP);
-                    _routeUpdate();
+                        _routeUpdate();
+                    }
+                }
+                dtWaypoints.Rows[index][3] = p.Position.Lat;
+                dtWaypoints.Rows[index][4] = p.Position.Lng;
+            }
+        }
         void _updateDTWPPosFin(CustomMarkerWP wp)
+        {
             string sIndex = wp.WPText.Substring(1, wp.WPText.Length - 1);
                 dtWaypoints.Rows[index][2] = dtWaypoints.Rows[index][2].ToString().Substring(0, 1) + (index+1).ToString();
                 ((CustomMarkerWP)m2.Shape).text.Text = dtWaypoints.Rows[index][2].ToString();
                 dgvWP.Items.Refresh();
                 dgvWP.SelectedIndex = index - 1;
                 _dgvWPselectEditRow();
+                if (((int)dtWaypoints.Rows[index][1] == 0 | (int)dtWaypoints.Rows[index][1] == 3) && ((int)dtWaypoints.Rows[index - 1][1] == 0 | (int)dtWaypoints.Rows[index - 1][1] == 3))// && wpList.Count > index)
+                {
+                    PointLatLng x = new PointLatLng((double)dtWaypoints.Rows[index][3], (double)dtWaypoints.Rows[index][4]);
-                PointLatLng p = wpList[index];
+                    int wpListIndex = wpList.IndexOf(x);
+                    if (wpListIndex > 0)
+                    {
-                wpList.RemoveAt(index);
+                        wpList.RemoveAt(wpListIndex);
-                wpList.Insert(index - 1, p);
+                        wpList.Insert(wpListIndex - 1, x);
-                MainMap.Markers.Remove(mRouteWP);
+                        MainMap.Markers.Remove(mRouteWP);
-                _routeUpdate();
+                        _routeUpdate();
+                    }
+                }
+            }
+        }
         private void btnWPEditmoveDown_Click(object sender, RoutedEventArgs e)
                 dtWaypoints.Rows[index][2] = dtWaypoints.Rows[index][2].ToString().Substring(0, 1) + (index+1).ToString();
                 ((CustomMarkerWP)m2.Shape).text.Text = dtWaypoints.Rows[index][2].ToString();
                 dgvWP.Items.Refresh();
                 dgvWP.SelectedIndex = index + 1;
                 _dgvWPselectEditRow();
+                if (((int)dtWaypoints.Rows[index][1] == 0 | (int)dtWaypoints.Rows[index][1] == 3) && ((int)dtWaypoints.Rows[index+1][1] == 0 | (int)dtWaypoints.Rows[index+1][1] == 3))// && wpList.Count > index)
+                {
+                    PointLatLng x = new PointLatLng((double)dtWaypoints.Rows[index][3], (double)dtWaypoints.Rows[index][4]);
-                PointLatLng p = wpList[index];
+                    int wpListIndex = wpList.IndexOf(x);
+                    if (wpListIndex > -1)
+                    {
-                wpList.RemoveAt(index);
+                        wpList.RemoveAt(wpListIndex);
+                        if (wpList.Count > wpListIndex)
-                wpList.Insert(index + 1, p);
+                            wpList.Insert(wpListIndex + 1, x);
+                        else
+                            wpList.Add(x);
-                MainMap.Markers.Remove(mRouteWP);
+                        MainMap.Markers.Remove(mRouteWP);
-                _routeUpdate();
+                        _routeUpdate();
+                    }
+                }
+            }
+        }

Subversion Repositories Projects

(root)/MKLiveView/v1.0/Source/MainWindow.xaml.cs - Rev 2421 → 2424