Rotate Inverted Pendulum with Swing up control in Matlab simulink