利用simuliink中的S函数编写倒立摆轨迹跟踪控制的实例,控制倒立摆角度到5°的情况