One-level straight inverted pendulum matlab program