This example demonstrates how to design pole placement controller to balance an inverted double pendulum. For controller design a linearized model of a (simple) physical system model is used. The controller is applied to the physical model in Moldelica_Controller library.
It is also shown how to linearize a modelica model. The linear model is used as a base for control design
function designInverseDoublePendulumControllerWithObserver import Modelica.Utilities.Streams; import MatricesMSL = Modelica.Math.Matrices; import Modelica.ComplexMath.j; import Modelica_LinearSystems2.ComplexMathAdds; import Modelica_LinearSystems2; import Modelica_LinearSystems2.StateSpace; input String modelName = "Modelica_LinearSystems2.Controllers.Examples.Components.InverseDoublePendulum" "name of the model to linearize"; input Complex pa[6] = {Complex(-1, 0), Complex(-1, 0), Complex(-12, -0.2), Complex(-12, 0.2), Complex(-15, -0), Complex(-15, 0)} "assigned poles"; input Complex pob[6] = cat(1, fill(-15 + 0*j, 4), fill(-20 + 0*j, 2)) "assigned observer poles"; input String fileName = DataDir + "inverseDoublePendulumControllerO.mat" "file name for results"; input Boolean makeAnalysis = false; output Real K_pa[:, :] "feedback matrix pole assignment controller"; output Real M_pa[:, :] "pre filter LQ controller"; output Real K_ob[:, :] "feedback matrix pole assignment controller"; end designInverseDoublePendulumControllerWithObserver;