自己写的一个控制器，在gazebo里面的模型运行一会就塌下来了。也不报错，自己实在是不知道什么原因，能帮忙分析一下吗?