SinCosResolver

model SinCosResolver "Sin-Cos-Resolver"
    import Modelica.Constants.pi;

    extends Modelica.Mechanics.Rotational.Interfaces.PartialElementaryOneFlangeAndSupport2;

    parameter Integer p(final min = 1, start = 2) "Number of pole pairs";
    parameter Real amplitude = 1 "Amplitude of signals";
    parameter Real offset = 1.5 "Offset of signals";
    parameter SI.Angle phi0 = -pi / p "Initial mechanical angle";
    Modelica.Blocks.Interfaces.RealOutput y[4] "Track signals"
        annotation (Placement(transformation(extent = {
            {-100, -10}, 
            {-120, 10}})));
equation
    y[1] = offset + amplitude * cos(p * (flange.phi - phi_support - phi0));
    y[2] = offset - amplitude * cos(p * (flange.phi - phi_support - phi0));
    y[3] = offset + amplitude * sin(p * (flange.phi - phi_support - phi0));
    y[4] = offset - amplitude * sin(p * (flange.phi - phi_support - phi0));
    flange.tau = 0;

    annotation (
        Icon(
            coordinateSystem(preserveAspectRatio = false),
            graphics = {
                Ellipse(
                    extent = {
                        {-70, 70}, 
                        {70, -70}},
                    lineColor = {95, 95, 95},
                    fillColor = {215, 215, 215},
                    fillPattern = FillPattern.Solid), 
                Line(
                    points = {
                        {-70, 0}, 
                        {-100, 0}},
                    color = {95, 95, 95}), 
                Line(
                    points = {
                        {100, 0}, 
                        {70, 0}},
                    color = {95, 95, 95}), 
                Text(
                    extent = {
                        {-150, 120}, 
                        {150, 80}},
                    textColor = {0, 0, 255},
                    fillColor = {255, 255, 255},
                    textString = "%name"), 
                Ellipse(
                    extent = {
                        {-20, 20}, 
                        {20, -20}},
                    lineColor = {95, 95, 95},
                    fillColor = {255, 255, 255},
                    fillPattern = FillPattern.Solid), 
                Line(
                    points = {
                        {-80, 0}, 
                        {-68.7, 34.2}, 
                        {-61.5, 53.1}, 
                        {-55.1, 66.4}, 
                        {-49.4, 74.6}, 
                        {-43.8, 79.1}, 
                        {-38.2, 79.8}, 
                        {-32.6, 76.6}, 
                        {-26.9, 69.7}, 
                        {-21.3, 59.4}, 
                        {-14.9, 44.1}, 
                        {-6.83, 21.2}, 
                        {10.1, -30.8}, 
                        {17.3, -50.2}, 
                        {23.7, -64.2}, 
                        {29.3, -73.1}, 
                        {35, -78.4}, 
                        {40.6, -80}, 
                        {46.2, -77.6}, 
                        {51.9, -71.5}, 
                        {57.5, -61.9}, 
                        {63.9, -47.2}, 
                        {72, -24.8}, 
                        {80, 0}},
                    smooth = Smooth.Bezier), 
                Line(
                    points = {
                        {-80, 80}, 
                        {-76.2, 79.8}, 
                        {-70.6, 76.6}, 
                        {-64.9, 69.7}, 
                        {-59.3, 59.4}, 
                        {-52.9, 44.1}, 
                        {-44.83, 21.2}, 
                        {-27.9, -30.8}, 
                        {-20.7, -50.2}, 
                        {-14.3, -64.2}, 
                        {-8.7, -73.1}, 
                        {-3, -78.4}, 
                        {2.6, -80}, 
                        {8.2, -77.6}, 
                        {13.9, -71.5}, 
                        {19.5, -61.9}, 
                        {25.9, -47.2}, 
                        {34, -24.8}, 
                        {42, 0}},
                    smooth = Smooth.Bezier), 
                Line(
                    points = {
                        {84, 80}, 
                        {80.2, 79.8}, 
                        {74.6, 76.6}, 
                        {68.9, 69.7}, 
                        {63.3, 59.4}, 
                        {56.9, 44.1}, 
                        {48.83, 21.2}, 
                        {31.9, -30.8}, 
                        {24.7, -50.2}, 
                        {18.3, -64.2}, 
                        {12.7, -73.1}, 
                        {7, -78.4}, 
                        {1.4, -80}, 
                        {-4.2, -77.6}, 
                        {-9.9, -71.5}, 
                        {-15.5, -61.9}, 
                        {-21.9, -47.2}, 
                        {-30, -24.8}, 
                        {-38, 0}},
                    smooth = Smooth.Bezier)}),
        Documentation(info = "<html>\n<p>\nSimple model of a sin-cos-resolver, i.e. sensing the angle of the flange <code>phi</code> (w.r.t. the optional support) and multiplied by <code>p</code>, providing 4 signals:\n</p>\n<ul>\n<li><code>y[1] = offset + amplitude*cos(p*(phi - phi0))</code></li>\n<li><code>y[2] = offset - amplitude*cos(p*(phi - phi0))</code></li>\n<li><code>y[3] = offset + amplitude*sin(p*(phi - phi0))</code></li>\n<li><code>y[4] = offset - amplitude*sin(p*(phi - phi0))</code></li>\n</ul>\n<p>\nThus the sine and cosine signals have <code>p</code> periods per mechanical revolution.\nAdding an <code>offset</code> &gt; <code>amplitude</code>, the loss of one track can be determined.\nSubtracting the negated signal from the signal, the offset is removed and a cosine and a sine with doubled amplitude are accessible.\nFrom this signal, the angle within one pole pair of a machine can be determined for field oriented control.\nBlock <a href=\"modelica://Modelica.Electrical.Machines.Utilities.SinCosEvaluation\">SinCosEvaluation</a> can be used.\n</p>\n<p>\nThis model can be used to export FMUs of drives to develop control strategies in other environments.\nWhen switching to a real drive, the same inputs as from the FMU can be used.\n</p>\n<p>\nNote that <code>phi0</code> has to be set that way, that in shaft position <code>phi0</code> the flux linkage of phase 1 is a maximum.\nIn order to sense the mechanical angle of the shaft <code>p = 1</code> has to be set.\n</p>\n</html>"));
end SinCosResolver;