aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Visual_Studio/MachineStudio/Tango.MachineStudio.Common/Diagnostics/DefaultDiagnosticsFrameProvider.cs
blob: 477332ad9344ff179c5ffbc667b0759e7c4ad5cb (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using Tango.Core;
using Tango.Integration.Operation;
using Tango.Integration.ExternalBridge;
using Tango.MachineStudio.Common.StudioApplication;
using Tango.PMR.Diagnostics;
using System.Diagnostics;

namespace Tango.MachineStudio.Common.Diagnostics
{
    /// <summary>
    /// Represents the default diagnostics frame provider.
    /// </summary>
    /// <seealso cref="Tango.MachineStudio.Common.Diagnostics.IDiagnosticsFrameProvider" />
    public class DefaultDiagnosticsFrameProvider : ExtendedObject, IDiagnosticsFrameProvider
    {
        private IStudioApplicationManager _application;
        private Stopwatch _watch;
        private List<double> _rates;
        private DateTime _last_measure;
        private const int _min_rate_change = 4;

        private bool _disable;
        /// <summary>
        /// Disables the frame delivery from the current connected machine and enables the manual push frame method.
        /// </summary>
        public bool Disable
        {
            get { return _disable; }
            set
            {
                _disable = value;
            }
        }

        private double _frameRate;
        /// <summary>
        /// Gets the current diagnostics frame rate.
        /// </summary>
        public double FrameRate
        {
            get
            {
                return _frameRate;
            }
            private set
            {
                _frameRate = value;
                RaisePropertyChangedAuto();
            }
        }

        /// <summary>
        /// Occurs when a new data frame is available.
        /// </summary>
        public event EventHandler<StartDiagnosticsResponse> FrameReceived;

        /// <summary>
        /// Initializes a new instance of the <see cref="DefaultDiagnosticsFrameProvider"/> class.
        /// </summary>
        /// <param name="applicationManager">The application manager.</param>
        public DefaultDiagnosticsFrameProvider(IStudioApplicationManager applicationManager)
        {
            _rates = new List<double>();
            _watch = new Stopwatch();
            _application = applicationManager;
            applicationManager.ConnectedMachineChanged += ApplicationManager_ConnectedMachineChanged;
        }

        /// <summary>
        /// Applications the manager connected machine changed.
        /// </summary>
        /// <param name="sender">The sender.</param>
        /// <param name="machine">The machine.</param>
        private void ApplicationManager_ConnectedMachineChanged(object sender, IExternalBridgeClient machine)
        {
            if (machine != null)
            {
                _last_measure = DateTime.Now;
                _rates = new List<double>();
                _watch = new Stopwatch();
                machine.DiagnosticsDataAvailable += DefaultDiagnosticsFrameProvider_DiagnosticsDataAvailable;
            }
        }

        /// <summary>
        /// Defaults the diagnostics frame provider diagnostics data available.
        /// </summary>
        /// <param name="sender">The sender.</param>
        /// <param name="frame">The frame.</param>
        private void DefaultDiagnosticsFrameProvider_DiagnosticsDataAvailable(object sender, StartDiagnosticsResponse frame)
        {
            if (!Disable)
            {
                OnFrameReceived(frame);
            }
        }

        /// <summary>
        /// Push frames manual. (Only when Disable = true)
        /// </summary>
        /// <param name="frame">The frame.</param>
        public void PushFrame(StartDiagnosticsResponse frame)
        {
            if (Disable)
            {
                OnFrameReceived(frame);
            }
        }

        /// <summary>
        /// Raises the <see cref="FrameReceived"/> event.
        /// </summary>
        /// <param name="frame">The frame.</param>
        protected virtual void OnFrameReceived(StartDiagnosticsResponse frame)
        {
            if (DateTime.Now > _last_measure.AddSeconds(1) && _rates.Count > 0)
            {
                _last_measure = DateTime.Now;

                var rate = Math.Round(1000d / _rates.Average(), 2);

                if (rate > FrameRate + _min_rate_change || rate < FrameRate - _min_rate_change)
                {
                    FrameRate = rate;
                }

                _rates.Clear();
            }

            _rates.Add(_watch.ElapsedMilliseconds);

            _watch.Restart();

            FrameReceived?.Invoke(this, frame);
        }
    }
}
ss="n">Base::values(); int n = Base::inputs(); eigen_assert(n == uv.size()); eigen_assert(fjac.rows() == m); eigen_assert(fjac.cols() == n); int half = n/2; VectorBlock<const VectorType> u(uv, 0, half); VectorBlock<const VectorType> v(uv, half, half); for (int j = 0; j < m; j++) { for (int i = 0; i < half; i++) { fjac.coeffRef(j,i) = -std::exp(-(m_x(j)-i)*(m_x(j)-i)/(v(i)*v(i))); fjac.coeffRef(j,i+half) = -2.*u(i)*(m_x(j)-i)*(m_x(j)-i)/(std::pow(v(i),3)) * std::exp(-(m_x(j)-i)*(m_x(j)-i)/(v(i)*v(i))); } } return 0; } VectorType m_x, m_y; //Data Points }; template<typename FunctorType, typename VectorType> int test_minimizeLM(FunctorType& functor, VectorType& uv) { LevenbergMarquardt<FunctorType> lm(functor); LevenbergMarquardtSpace::Status info; info = lm.minimize(uv); VERIFY_IS_EQUAL(info, 1); //FIXME Check other parameters return info; } template<typename FunctorType, typename VectorType> int test_lmder(FunctorType& functor, VectorType& uv) { typedef typename VectorType::Scalar Scalar; LevenbergMarquardtSpace::Status info; LevenbergMarquardt<FunctorType> lm(functor); info = lm.lmder1(uv); VERIFY_IS_EQUAL(info, 1); //FIXME Check other parameters return info; } template<typename FunctorType, typename VectorType> int test_minimizeSteps(FunctorType& functor, VectorType& uv) { LevenbergMarquardtSpace::Status info; LevenbergMarquardt<FunctorType> lm(functor); info = lm.minimizeInit(uv); if (info==LevenbergMarquardtSpace::ImproperInputParameters) return info; do { info = lm.minimizeOneStep(uv); } while (info==LevenbergMarquardtSpace::Running); VERIFY_IS_EQUAL(info, 1); //FIXME Check other parameters return info; } template<typename T> void test_denseLM_T() { typedef Matrix<T,Dynamic,1> VectorType; int inputs = 10; int values = 1000; DenseLM<T> dense_gaussian(inputs, values); VectorType uv(inputs),uv_ref(inputs); VectorType x(values); // Generate the reference solution uv_ref << -2, 1, 4 ,8, 6, 1.8, 1.2, 1.1, 1.9 , 3; //Generate the reference data points x.setRandom(); x = 10*x; x.array() += 10; dense_gaussian.initPoints(uv_ref, x); // Generate the initial parameters VectorBlock<VectorType> u(uv, 0, inputs/2); VectorBlock<VectorType> v(uv, inputs/2, inputs/2); // Solve the optimization problem //Solve in one go u.setOnes(); v.setOnes(); test_minimizeLM(dense_gaussian, uv); //Solve until the machine precision u.setOnes(); v.setOnes(); test_lmder(dense_gaussian, uv); // Solve step by step v.setOnes(); u.setOnes(); test_minimizeSteps(dense_gaussian, uv); } void test_denseLM() { CALL_SUBTEST_2(test_denseLM_T<double>()); // CALL_SUBTEST_2(test_sparseLM_T<std::complex<double>()); }